Adds NaN checks and setpoint resets for offboard posctl