Python code to read servo position & write to robot