irp6otm kinematics
Merge pull request #54 from twiniars/master

irp6otm kinematics