Using optical tracking for kinematic testing of medical robots
Closed-form solution of absolute orientation using unit quaternions