Adjust i-term yaw zeroing.

See fe5a864 and b9e5a37.