Inverse kinematics

Dependencies:   Matrix mbed