Robot kinematics model fully working

Dependencies:   mbed

unknown revision 'shortlog'