yaw, pitch, roll code transcribed from arduino code to use glm