-
Notifications
You must be signed in to change notification settings - Fork 3
/
StepperBoxEvaporator.py
170 lines (149 loc) · 5.12 KB
/
StepperBoxEvaporator.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
# Copyright []
#
# This program is free software: you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation, either version 2 of the License, or
# (at your option) any later version.
#
# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
# GNU General Public License for more details.
#
# You should have received a copy of the GNU General Public License
# along with this program. If not, see <http://www.gnu.org/licenses/>.
"""
### BEGIN NODE INFO
[info]
name = Stepper Motor Controllers
version = 1.0
description = ACBOX control
[startup]
cmdline = %PYTHON% %FILE%
timeout = 20
[shutdown]
message = 987654321
timeout = 20
### END NODE INFO
"""
import platform
global serial_server_name
serial_server_name = (platform.node() + '_serial_server').replace('-','_').lower()
from labrad.server import setting
from labrad.devices import DeviceServer,DeviceWrapper
from twisted.internet.defer import inlineCallbacks, returnValue
import labrad.units as units
from labrad.types import Value
import time
TIMEOUT = Value(5,'s')
BAUD = 9600
BYTESIZE = 8
STOPBITS = 1
PARITY = 0
class StepperWrapper(DeviceWrapper):
@inlineCallbacks
def connect(self, server, port):
"""Connect to a device."""
print 'connecting to "%s" on port "%s"...' % (server.name, port),
self.server = server
self.ctx = server.context()
self.port = port
p = self.packet()
p.open(port)
p.baudrate(BAUD)
p.bytesize(BYTESIZE)
p.stopbits(STOPBITS)
p.setParity = PARITY
p.read() # clear out the read buffer
p.timeout(TIMEOUT)
p.timeout(None)
print(" CONNECTED ")
yield p.send()
def packet(self):
"""Create a packet in our private context"""
return self.server.packet(context=self.ctx)
def shutdown(self):
"""Disconnect from the serial port when we shut down"""
return self.packet().close().send()
@inlineCallbacks
def write(self, code):
"""Write a data value to the device"""
yield self.packet().write(code).send()
@inlineCallbacks
def read(self):
"""Read a response line from the device"""
p=self.packet()
p.read_line()
ans=yield p.send()
returnValue(ans.read_line)
@inlineCallbacks
def query(self, code):
""" Write, then read. """
p = self.packet()
p.write_line(code)
p.read_line()
ans = yield p.send()
returnValue(ans.read_line)
class StepperServer(DeviceServer):
name = 'Stepper_Server'
deviceName = 'Stepper Motor Controller'
deviceWrapper = StepperWrapper
@inlineCallbacks
def initServer(self):
print 'loading config info...',
self.reg = self.client.registry()
yield self.loadConfigInfo()
print 'done.'
print self.serialLinks
yield DeviceServer.initServer(self)
@inlineCallbacks
def loadConfigInfo(self):
reg = self.reg
#THIS STILL NEEDS TO BE ADDED TO THE REGISTRY
yield reg.cd(['', 'Servers', 'Evaporator Stepper', 'Links'], True)
dirs, keys = yield reg.dir()
p = reg.packet()
print "Created packet"
print "printing all the keys",keys
for k in keys:
print "k=",k
p.get(k, key=k)
ans = yield p.send()
print "ans=",ans
self.serialLinks = dict((k, ans[k]) for k in keys)
@inlineCallbacks
def findDevices(self):
devs = []
for name, (serServer, port) in self.serialLinks.items():
if serServer not in self.client.servers:
print serServer
print self.client.servers
continue
server = self.client[serServer]
ports = yield server.list_serial_ports()
if port not in ports:
continue
devName = '%s - %s' % (serServer, port)
devs += [(devName, (server, port))]
returnValue(devs)
@setting(505,stepper = 's',degrees = 's', direction = 's', returns='s')
def rot(self,c,stepper, degrees, direction):
"""Rotates stepper motor by the number of degrees in the specified direction. The shutter blade
stepper motor is motor 'A'. The cryostat stepper motor is motor 'B'. Use C to move clockwise and
A to move anti-clockwise. Example command: A150C. This will turn stepper motor A 150 degrees
clockwise."""
dev=self.selectedDevice(c)
yield dev.write(stepper+degrees+direction+"r")
ans = yield dev.read()
returnValue(ans)
@setting(506, returns='s')
def iden(self,c):
"""Identifies the stepper controller device."""
dev=self.selectedDevice(c)
yield dev.write("ir")
ans = yield dev.read()
returnValue(ans)
__server__ = StepperServer()
if __name__ == '__main__':
from labrad import util
util.runServer(__server__)