- fixed variable display
This commit is contained in:
@@ -1,3 +1,4 @@
|
||||
|
||||
import time
|
||||
import serial
|
||||
import enum
|
||||
@@ -100,16 +101,16 @@ class Pololu1376:
|
||||
|
||||
|
||||
def print_vars(drv):
|
||||
print ("STATUS :", drv.get_variable(Varid.STATUS.value))
|
||||
print ("STATUS_ERROR_OCCURED :", drv.get_variable(Varid.STATUS_ERROR_OCCURED.value))
|
||||
print ("STATUS_LIMIT_STATUS :", drv.get_variable(Varid.STATUS_LIMIT_STATUS.value))
|
||||
print ("RC_RC1_SCALED_VALUE :", drv.get_variable(Varid.RC_RC1_SCALED_VALUE.value))
|
||||
print ("RC_RC2_SCALED_VALUE :", drv.get_variable(Varid.RC_RC2_SCALED_VALUE.value))
|
||||
print ("ANALOG_AN1_SCALED_VALUE :", drv.get_variable(Varid.ANALOG_AN1_SCALED_VALUE.value))
|
||||
print ("ANALOG_AN2_SCALED_VALUE :", drv.get_variable(Varid.ANALOG_AN2_SCALED_VALUE.value))
|
||||
print ("DIAGNOSTIC_TARGET_SPEED :", drv.get_variable(Varid.DIAGNOSTIC_TARGET_SPEED.value))
|
||||
print ("DIAGNOSTIC_SPEED :", drv.get_variable(Varid.DIAGNOSTIC_SPEED.value))
|
||||
print ("DIAGNOSTIC_TEMPERATURE :", drv.get_variable(Varid.DIAGNOSTIC_TEMPERATURE.value))
|
||||
print ("STATUS : {:04X}".format(int(drv.get_variable(Varid.STATUS.value[0]))))
|
||||
print ("STATUS_ERROR_OCCURED : {:04X}".format(int(drv.get_variable(Varid.STATUS_SERIAL_ERROR_OCCURED.value[0]))))
|
||||
print ("STATUS_LIMIT_STATUS : {:04X}".format(int(drv.get_variable(Varid.STATUS_LIMIT_STATUS.value[0]))))
|
||||
print ("RC_RC1_SCALED_VALUE : {:04X}".format(int(drv.get_variable(Varid.RC_RC1_SCALED_VALUE.value[0]))))
|
||||
print ("RC_RC2_SCALED_VALUE : {:04X}".format(int(drv.get_variable(Varid.RC_RC2_SCALED_VALUE.value[0]))))
|
||||
print ("ANALOG_AN1_SCALED_VALUE : {:04X}".format(int(drv.get_variable(Varid.ANALOG_AN1_SCALED_VALUE.value[0]))))
|
||||
print ("ANALOG_AN2_SCALED_VALUE : {:04X}".format(int(drv.get_variable(Varid.ANALOG_AN2_SCALED_VALUE.value[0]))))
|
||||
print ("DIAGNOSTIC_TARGET_SPEED : {:04X}".format(int(drv.get_variable(Varid.DIAGNOSTIC_TARGET_SPEED.value[0]))))
|
||||
print ("DIAGNOSTIC_SPEED : {:04X}".format(int(drv.get_variable(Varid.DIAGNOSTIC_SPEED.value[0]))))
|
||||
print ("DIAGNOSTIC_TEMPERATURE : {:04X}".format(int(drv.get_variable(Varid.DIAGNOSTIC_TEMPERATURE.value[0]))))
|
||||
|
||||
if __name__ == '__main__':
|
||||
ser = serial.Serial("/dev/ttyACM0", 115200)
|
||||
@@ -118,13 +119,13 @@ if __name__ == '__main__':
|
||||
drv.go()
|
||||
time.sleep(1)
|
||||
|
||||
for speed in range(60, 100, 10):
|
||||
for speed in range(0, 70, 5):
|
||||
print("Speed = {}".format(speed))
|
||||
drv.motor_forward(speed)
|
||||
for n in range (0, 10, 1):
|
||||
print_vars(drv)
|
||||
time.sleep(0.5)
|
||||
drv.motor_brake(50)
|
||||
drv.motor_brake(10)
|
||||
time.sleep(1)
|
||||
|
||||
print("End of program")
|
||||
|
||||
Reference in New Issue
Block a user