Esempio n. 1
0
def readMotorPosition():
    m1Pos = -1
    m2Pos = -1
    SerialCom.send2IntToArduino(Constant.MOTOR_1_READ_POS, 0)
    m1Pos = SerialCom.readIntFromArduino()

    SerialCom.send2IntToArduino(Constant.MOTOR_2_READ_POS, 0)
    m2Pos = SerialCom.readIntFromArduino()

    return (m1Pos, m2Pos)