Changed the rotation library to not always check quaternions passed as arguments. This allows the arguments to be declared const and the functions are inline rather than static.
Added the full PTAM to NED transform. Tested and works well