Merge pull request #54 from twiniars/master

irp6otm kinematics
irp6ot m kinematics