diff --git a/components/actor/Pololu1376.py b/components/actor/Pololu1376.py index da391f4..a549403 100644 --- a/components/actor/Pololu1376.py +++ b/components/actor/Pololu1376.py @@ -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")