aboutsummaryrefslogtreecommitdiff
path: root/MotionControl/Action.py
blob: f0653a5d550272dd29c3b35aab3d814a7b20ed91 (plain)
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
# -*- coding: utf8 -*-

class Action(object):
	def __init__(self):
		self.aborted = False
		self.started = False

	def execute(self):
		self.aborted = False
		self.started = True
		self.do_execute()
	
	def ended(self):
		if not self.started:
			False
		if self.aborted:
			return True
		return self.do_ended()

	def abort(self):
		self.aborted = True
		self.do_abort()
	
	def do_execute(self):
		raise NotImplementedError

	def do_ended(self):
		raise NotImplementedError
	
	def do_abort(self):
		pass

class NullAction(Action):
	def do_execute(self):
		pass
	
	def do_ended(self):
		return True

class Initiate(Action):
	def __init__(self, axes):
		Action.__init__(self)
		self.axes = axes
	
	def do_execute(self):
		for axis in self.axes:
			axis.initiate()

	def do_ended(self):
		all_stopped = not (True in [axis.running for axis in self.axes])
		if all_stopped and False in [axis.initialized for axis in self.axes]:
			raise CycleAbort()
		return all_stopped
	
	def do_abort(self):
		for axis in self.axes:
			axis.halt()

class GotoAbsolute(Action):
	def __init__(self, axes, target, speed = None):
		Action.__init__(self)
		if len(axes) != len(target):
			raise ValueError()
		if speed and len(speed) != len(axes):
			raise ValueError()

		self.axes = axes
		self.target = target
		self.speed = speed

	def do_execute(self):
		for i, axis in enumerate(self.axes):
			speed = None
			if self.speed:
				speed = self.speed[i]
			axis.goto_absolute(self.target[i], speed)

	def do_abort(self):
		for axis in self.axes:
			axis.halt()

	def do_ended(self):
		return not (True in [axis.running for axis in self.axes])
		

class EmergencyStop(Action):
	def __init__(self, axes):
		Action.__init__(self)
		self.axes = axes
	
	def do_execute(self):
		for a in self.axes:
			a.emergency_stop()

	def do_ended(self):
		return not (True in [axis.running for axis in self.axes])