x and y should be changed to represent the valid inputs. Takes a setpoint x,y and transfers it to required motor angles

Dependencies:   MODSERIAL mbed