- fixed variable display

This commit is contained in:
jens
2021-08-11 16:24:42 +01:00
parent 7a8368d9b9
commit 89112777e3
+13 -12
View File
@@ -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")