Added readTP and motor control to arduino.py