|
|
|
@ -466,11 +466,16 @@ void Copter::zr_mission_flow_mode()
@@ -466,11 +466,16 @@ void Copter::zr_mission_flow_mode()
|
|
|
|
|
else{ |
|
|
|
|
real_alt= gps.location().alt + gps.get_gps_delt_alt();
|
|
|
|
|
} |
|
|
|
|
flow_measure.flow_auto_measure(flow_measure.flow_start_sw, real_alt, measure_time); |
|
|
|
|
if(control_mode != Mode::Number::AUTO){ |
|
|
|
|
flow_measure.set_reach_flow_wp(false); |
|
|
|
|
get_mindist_flow_wp(); |
|
|
|
|
}else{ |
|
|
|
|
if(flow_measure.flow_start_sw){ |
|
|
|
|
flow_measure.flow_start_sw = false; |
|
|
|
|
gcs().send_text(MAV_SEVERITY_NOTICE, "NOTICE:自动测流模式,关闭手动测流"); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
flow_measure.flow_auto_measure(flow_measure.flow_start_sw, real_alt, measure_time); |
|
|
|
|
|
|
|
|
|
// flow_measure.flow_auto_measure(1,1, real_alt, measure_time);
|
|
|
|
|
} |
|
|
|
|