1717
1818"""Driver for 2 TB6612FNG DC motors mounted to a single chassis."""
1919import sys
20+ import os
2021from os .path import dirname
2122sys .path .append (dirname (__file__ ))
2223
2829class MotorDriver (GPIO_Manager ):
2930 """Interface with 2 TB6612FNG DC Motor drivers."""
3031 # Configure motor 1
31- _m1_dir1_pin = 6
32- _m1_dir2_pin = 12
33- _m1_pwm_pin_annex = 5 # solve error mapping (Vers.01)
34- _m1_pwm_pin = 18
32+ _m1_dir1_pin = 19
33+ _m1_dir2_pin = 16
34+ _m1_pwm_pin = 12
3535
3636 # Configure motor 2
37- _m2_dir1_pin = 19
38- _m2_dir2_pin = 16
39- _m2_pwm_pin_annex = 26 # solve error mapping (Vers.01)
37+ _m2_dir1_pin = 26
38+ _m2_dir2_pin = 20
4039 _m2_pwm_pin = 13
4140
42- _standby_pin = 20
41+ _standby_pin = 21
4342
4443 PWM_OUTPUTS = [_m1_pwm_pin , _m2_pwm_pin ]
4544
46- INPUT_PINS = [_m1_pwm_pin_annex , _m2_pwm_pin_annex ]
47-
4845 OUTPUT_PINS = [_m1_dir1_pin , _m1_dir2_pin ,
4946 _m2_dir1_pin , _m2_dir2_pin ,
5047 _standby_pin ]
51- _pins = PWM_OUTPUTS + INPUT_PINS + OUTPUT_PINS
48+ _pins = PWM_OUTPUTS + OUTPUT_PINS
5249
5350 @staticmethod
5451 def to_dc (dc ):
@@ -64,11 +61,6 @@ def __init__(self):
6461 for pin in self .PWM_OUTPUTS :
6562 wiringpi .pinMode (pin , wiringpi .PWM_OUTPUT )
6663
67- for pin in self .INPUT_PINS :
68- wiringpi .pinMode (pin , wiringpi .INPUT )
69- # Make sure all annex_pin are set LOW
70- wiringpi .pullUpDnControl (pin , wiringpi .PUD_DOWN )
71-
7264 def right_forward (self ):
7365 """Drive right motor forward."""
7466 wiringpi .digitalWrite (self ._m1_dir1_pin , wiringpi .LOW )
@@ -138,28 +130,28 @@ def __exit__(self, *args):
138130 with MotorDriver () as tb6612fng :
139131 while True :
140132 print ("forward" )
141- tb6612fng .forward ()
133+ tb6612fng .forward (50 )
142134 time .sleep (3 )
143135
144136 tb6612fng .stop ()
145137 time .sleep (3 )
146138
147139 print ("reverse" )
148- tb6612fng .reverse ()
140+ tb6612fng .reverse (50 )
149141 time .sleep (3 )
150142
151143 tb6612fng .stop ()
152144 time .sleep (3 )
153145
154146 print ("left" )
155- tb6612fng .left ()
147+ tb6612fng .left (50 )
156148 time .sleep (3 )
157149
158150 tb6612fng .stop ()
159151 time .sleep (3 )
160152
161153 print ("right" )
162- tb6612fng .right ()
154+ tb6612fng .right (50 )
163155 time .sleep (3 )
164156
165157 tb6612fng .stop ()
0 commit comments