- fixed yaw calculation issue by re-introducing the yaw calculation code.