Forward Kinematics

Dependencies:   MODSERIAL Matrix mbed