The motor angles/kinematics and inverse kinematics

Dependencies:   MODSERIAL mbed