forked from mxcube/HardwareObjects
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathMicrodiffZoom.py
81 lines (62 loc) · 3.29 KB
/
MicrodiffZoom.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
from MD2Motor import MD2Motor
import logging
import math
class MicrodiffZoom(MD2Motor):
def __init__(self, name):
MD2Motor.__init__(self, name)
def init(self):
self.motor_name = "Zoom"
self.motor_pos_attr_suffix = "Position"
self._last_position_name = None
MD2Motor.init(self)
self.predefined_position_attr = self.addChannel({"type":"exporter", "name":"predefined_position" }, "CoaxialCameraZoomValue")
self.predefinedPositions = { "Zoom 1": 1, "Zoom 2": 2, "Zoom 3": 3, "Zoom 4": 4, "Zoom 5": 5, "Zoom 6": 6, "Zoom 7": 7, "Zoom 8": 8, "Zoom 9": 9, "Zoom 10":10 }
self.sortPredefinedPositionsList()
def sortPredefinedPositionsList(self):
self.predefinedPositionsNamesList = self.predefinedPositions.keys()
self.predefinedPositionsNamesList.sort(lambda x, y: int(round(self.predefinedPositions[x] - self.predefinedPositions[y])))
def connectNotify(self, signal):
if signal == 'predefinedPositionChanged':
positionName = self.getCurrentPositionName()
try:
pos = self.predefinedPositions[positionName]
except KeyError:
self.emit(signal, ('', None))
else:
self.emit(signal, (positionName, pos))
else:
return MD2Motor.connectNotify.im_func(self, signal)
def getLimits(self):
return (1,10)
def getPredefinedPositionsList(self):
return self.predefinedPositionsNamesList
def motorPositionChanged(self, absolutePosition, private={}):
MD2Motor.motorPositionChanged.im_func(self, absolutePosition, private)
positionName = self.getCurrentPositionName(absolutePosition)
if self._last_position_name != positionName:
self._last_position_name = positionName
self.emit('predefinedPositionChanged', (positionName, positionName and absolutePosition or None, ))
def getCurrentPositionName(self, pos=None):
pos = self.predefined_position_attr.getValue()
for positionName in self.predefinedPositions:
if math.fabs(self.predefinedPositions[positionName] - pos) <= 1E-3:
return positionName
return ''
def moveToPosition(self, positionName):
#logging.getLogger().debug("%s: trying to move %s to %s:%f", self.name(), self.motor_name, positionName,self.predefinedPositions[positionName])
try:
self.predefined_position_attr.setValue(self.predefinedPositions[positionName])
except:
logging.getLogger("HWR").exception('Cannot move motor %s: invalid position name.', str(self.userName()))
def setNewPredefinedPosition(self, positionName, positionOffset):
raise NotImplementedError
def zoom_in(self):
position_name = self.getCurrentPositionName()
position_index = self.predefinedPositionsNamesList.index(position_name)
if position_index < len(self.predefinedPositionsNamesList) - 1:
self.moveToPosition(self.predefinedPositionsNamesList[position_index + 1])
def zoom_out(self):
position_name = self.getCurrentPositionName()
position_index = self.predefinedPositionsNamesList.index(position_name)
if position_index > 0:
self.moveToPosition(self.predefinedPositionsNamesList[position_index - 1])