-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmotor_velocity_example.py
48 lines (37 loc) · 1.25 KB
/
motor_velocity_example.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
import brickpi
import time
interface=brickpi.Interface()
interface.initialize()
motors = [0,1]
speed = 6.0
interface.motorEnable(motors[0])
interface.motorEnable(motors[1])
leftParam = interface.MotorAngleControllerParameters()
rightParam = interface.MotorAngleControllerParameters()
leftParam.maxRotationAcceleration = 6.0
leftParam.maxRotationSpeed = 12.0
leftParam.feedForwardGain = 255/20.0
leftParam.minPWM = 18.0
leftParam.pidParameters.minOutput = -255
leftParam.pidParameters.maxOutput = 255
leftParam.pidParameters.k_p = 100.0
leftParam.pidParameters.k_i = 0.0
leftParam.pidParameters.k_d = 0.0
rightParam.maxRotationAcceleration = 6.0
rightParam.maxRotationSpeed = 12.0
rightParam.feedForwardGain = 255/20.0
rightParam.minPWM = 18.0
rightParam.pidParameters.minOutput = -255
rightParam.pidParameters.maxOutput = 255
rightParam.pidParameters.k_p = 100.0
rightParam.pidParameters.k_i = 0.0
rightParam.pidParameters.k_d = 0.0
interface.setMotorAngleControllerParameters(motors[0],leftParam)
interface.setMotorAngleControllerParameters(motors[1],rightParams)
interface.setMotorRotationSpeedReferences(motors,[speed,speed])
interface.startLogging("./logfile.txt")
print "Press Ctrl+C to exit"
while True:
time.sleep(1)
interface.stopLogging()
interface.terminate()