return int(integer).to_bytes(n, byteorder='little', signed=signed)
protocol = {
'read_data': b'\x01',
'reset': b'\x02',
'torque': b'\x04',
}
bus = CAN_Bus(interface='can1')
device_id = 0x01
sens = Sensors(can_bus=bus)
try:
sens.calibration_torque()
print(sens.torque_cd['bias'])
while True:
sens.read_torque()
print(sens.torque_voltage, sens.torque)
# message = protocol['torque'] + 7*b'\x00'
# bus.send_bytes(device_id, message)
# canid, dlc, reply = bus.recive_frame()
# # print(reply)
# (x,) = unpack('f',reply[2:6])
# print(x)
# message = protocol['read_data'] + 7*b'\x00'
# bus.send_bytes(device_id, message)
