safety feature for energy_ctrl

adjustment of v_ctl_climb_setpoint to assure safe airspeed i case of a deficiency in energy