Update yaw_ctrl.c