code for getting angles from rotation matrix and conversion from camera to drone angles
removed small bugs, but no direct comparison rotation yet, and no translation check