Fixed the gimbal lock now using quaternion to rotation vector. Also modified the axis directions