PDF] COORDINATE CONVERSION BETWEEN THE CARTESIAN FRAME AND AN ARBITRARY ... http://graphics.idav.ucdavis.edu/education/GraphicsNotes/Frame-to-Cartesian-Frame/Frame-to-Cartesian-Frame.html -- from graphics course
http://cisstweb.cs.jhu.edu/resources/software/cisst/
Arun K et al paper