|
|
|
@ -1172,8 +1172,11 @@ Location ModeAuto::loc_from_cmd(const AP_Mission::Mission_Command& cmd) const
@@ -1172,8 +1172,11 @@ Location ModeAuto::loc_from_cmd(const AP_Mission::Mission_Command& cmd) const
|
|
|
|
|
void ModeAuto::do_nav_wp(const AP_Mission::Mission_Command& cmd) |
|
|
|
|
{ |
|
|
|
|
Location target_loc = loc_from_cmd(cmd); |
|
|
|
|
AP::camera()->cameras_take_enable = AP::camera()->cameras_take_enable_new; |
|
|
|
|
AP::camera()->cameras_take_enable_new = cmd.content.location.cams_enable_bit; |
|
|
|
|
AP_Camera *camera = AP::camera(); |
|
|
|
|
if (camera != nullptr) { |
|
|
|
|
camera->cameras_take_enable = AP::camera()->cameras_take_enable_new; |
|
|
|
|
camera->cameras_take_enable_new = cmd.content.location.cams_enable_bit; |
|
|
|
|
} |
|
|
|
|
//gcs().send_text(MAV_SEVERITY_INFO,"NOTICE:WP:%d,p3:%d",cmd.index,AP::camera()->cameras_take_enable_new); //TODO DEBUG!!!
|
|
|
|
|
// this will be used to remember the time in millis after we reach or pass the WP.
|
|
|
|
|
loiter_time = 0; |
|
|
|
|