Bladeren bron

l298: python examples for l298 dual-H bridge DC motor and stepper motor

Signed-off-by: Zion Orent <zorent@ics.com>
Signed-off-by: Mihai Tudor Panu <mihai.tudor.panu@intel.com>
Zion Orent 9 jaren geleden
bovenliggende
commit
57bab4f9df
2 gewijzigde bestanden met toevoegingen van 132 en 0 verwijderingen
  1. 67
    0
      examples/python/l298-stepper.py
  2. 65
    0
      examples/python/l298.py

+ 67
- 0
examples/python/l298-stepper.py Bestand weergeven

@@ -0,0 +1,67 @@
1
+#!/usr/bin/python
2
+# Author: Zion Orent <zorent@ics.com>
3
+# Copyright (c) 2015 Intel Corporation.
4
+#
5
+# Permission is hereby granted, free of charge, to any person obtaining
6
+# a copy of this software and associated documentation files (the
7
+# "Software"), to deal in the Software without restriction, including
8
+# without limitation the rights to use, copy, modify, merge, publish,
9
+# distribute, sublicense, and/or sell copies of the Software, and to
10
+# permit persons to whom the Software is furnished to do so, subject to
11
+# the following conditions:
12
+#
13
+# The above copyright notice and this permission notice shall be
14
+# included in all copies or substantial portions of the Software.
15
+#
16
+# THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
17
+# EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
18
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
19
+# NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
20
+# LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
21
+# OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
22
+# WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
23
+
24
+
25
+import time, sys, signal, atexit
26
+import pyupm_l298 as upmL298
27
+
28
+# Instantiate a Stepper motor on a L298 Dual H-Bridge.
29
+# This was tested with the NEMA-17 12V, 350mA, with 200 steps per rev.
30
+myHBridge = upmL298.L298(200, 3, 4, 7, 8, 9)
31
+
32
+
33
+## Exit handlers ##
34
+# This stops python from printing a stacktrace when you hit control-C
35
+def SIGINTHandler(signum, frame):
36
+	raise SystemExit
37
+
38
+# This lets you run code on exit,
39
+# including functions from myHBridge
40
+def exitHandler():
41
+	print "Exiting"
42
+	sys.exit(0)
43
+
44
+# Register exit handlers
45
+atexit.register(exitHandler)
46
+signal.signal(signal.SIGINT, SIGINTHandler)
47
+
48
+
49
+myHBridge.setSpeed(10) # 10 RPMs
50
+myHBridge.setDirection(upmL298.L298.DIR_CW)
51
+myHBridge.enable(True)
52
+
53
+print "Rotating 1 full revolution at 10 RPM speed."
54
+# move 200 steps, a full rev
55
+myHBridge.stepperSteps(200)
56
+
57
+print "Sleeping for 2 seconds..."
58
+time.sleep(2)
59
+
60
+print "Rotating 1/2 revolution in opposite direction at 10 RPM speed."
61
+myHBridge.setDirection(upmL298.L298.DIR_CCW)
62
+myHBridge.stepperSteps(100)
63
+
64
+# release
65
+myHBridge.enable(False)
66
+
67
+# exitHandler is called automatically

+ 65
- 0
examples/python/l298.py Bestand weergeven

@@ -0,0 +1,65 @@
1
+#!/usr/bin/python
2
+# Author: Zion Orent <zorent@ics.com>
3
+# Copyright (c) 2015 Intel Corporation.
4
+#
5
+# Permission is hereby granted, free of charge, to any person obtaining
6
+# a copy of this software and associated documentation files (the
7
+# "Software"), to deal in the Software without restriction, including
8
+# without limitation the rights to use, copy, modify, merge, publish,
9
+# distribute, sublicense, and/or sell copies of the Software, and to
10
+# permit persons to whom the Software is furnished to do so, subject to
11
+# the following conditions:
12
+#
13
+# The above copyright notice and this permission notice shall be
14
+# included in all copies or substantial portions of the Software.
15
+#
16
+# THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
17
+# EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
18
+# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
19
+# NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
20
+# LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
21
+# OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
22
+# WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
23
+
24
+
25
+import time, sys, signal, atexit
26
+import pyupm_l298 as upmL298
27
+
28
+# Instantiate one of the 2 possible DC motors on a L298 Dual
29
+# H-Bridge.  For controlling a stepper motor, see the l298-stepper
30
+# example.
31
+myHBridge = upmL298.L298(3, 4, 7)
32
+
33
+
34
+## Exit handlers ##
35
+# This stops python from printing a stacktrace when you hit control-C
36
+def SIGINTHandler(signum, frame):
37
+	raise SystemExit
38
+
39
+# This lets you run code on exit,
40
+# including functions from myHBridge
41
+def exitHandler():
42
+	print "Exiting"
43
+	sys.exit(0)
44
+
45
+# Register exit handlers
46
+atexit.register(exitHandler)
47
+signal.signal(signal.SIGINT, SIGINTHandler)
48
+
49
+
50
+print "Starting motor at 50% for 3 seconds..."
51
+myHBridge.setSpeed(50)
52
+myHBridge.setDirection(upmL298.L298.DIR_CW)
53
+myHBridge.enable(True)
54
+
55
+time.sleep(3)
56
+
57
+print "Reversing direction..."
58
+myHBridge.setDirection(upmL298.L298.DIR_NONE) # fast stop
59
+myHBridge.setDirection(upmL298.L298.DIR_CCW)
60
+time.sleep(3);
61
+
62
+myHBridge.setSpeed(0)
63
+myHBridge.enable(False)
64
+
65
+# exitHandler is called automatically