Changed to reduced-complexity robot model
Adding fwd kinematics

--HG--
extra : amend_source : 6ba2a2c31e48c269366b8c32a14b98de3c109a08