Tidied up the rotation library. May have a bug with the r_check_q() file.
Changed main program to include the PTAM init and transform to NED. Still some bugs to remove.
Added a quaternion multiplication function