l1_pos_control: prevent NaNs for roll setpoint