Oct 6 Added fov check, fixed calculation for yaw