|
|
|
@ -455,10 +455,11 @@ void Rover::do_set_home(const AP_Mission::Mission_Command& cmd)
@@ -455,10 +455,11 @@ void Rover::do_set_home(const AP_Mission::Mission_Command& cmd)
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#if CAMERA == ENABLED |
|
|
|
|
|
|
|
|
|
// do_digicam_configure Send Digicam Configure message with the camera library
|
|
|
|
|
void Rover::do_digicam_configure(const AP_Mission::Mission_Command& cmd) |
|
|
|
|
{ |
|
|
|
|
#if CAMERA == ENABLED |
|
|
|
|
camera.configure(cmd.content.digicam_configure.shooting_mode, |
|
|
|
|
cmd.content.digicam_configure.shutter_speed, |
|
|
|
|
cmd.content.digicam_configure.aperture, |
|
|
|
@ -466,13 +467,11 @@ void Rover::do_digicam_configure(const AP_Mission::Mission_Command& cmd)
@@ -466,13 +467,11 @@ void Rover::do_digicam_configure(const AP_Mission::Mission_Command& cmd)
|
|
|
|
|
cmd.content.digicam_configure.exposure_type, |
|
|
|
|
cmd.content.digicam_configure.cmd_id, |
|
|
|
|
cmd.content.digicam_configure.engine_cutoff_time); |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// do_digicam_control Send Digicam Control message with the camera library
|
|
|
|
|
void Rover::do_digicam_control(const AP_Mission::Mission_Command& cmd) |
|
|
|
|
{ |
|
|
|
|
#if CAMERA == ENABLED |
|
|
|
|
if (camera.control(cmd.content.digicam_control.session, |
|
|
|
|
cmd.content.digicam_control.zoom_pos, |
|
|
|
|
cmd.content.digicam_control.zoom_step, |
|
|
|
@ -481,16 +480,13 @@ void Rover::do_digicam_control(const AP_Mission::Mission_Command& cmd)
@@ -481,16 +480,13 @@ void Rover::do_digicam_control(const AP_Mission::Mission_Command& cmd)
|
|
|
|
|
cmd.content.digicam_control.cmd_id)) { |
|
|
|
|
log_picture(); |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// do_take_picture - take a picture with the camera library
|
|
|
|
|
void Rover::do_take_picture() |
|
|
|
|
{ |
|
|
|
|
#if CAMERA == ENABLED |
|
|
|
|
camera.trigger_pic(true); |
|
|
|
|
log_picture(); |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// log_picture - log picture taken and send feedback to GCS
|
|
|
|
@ -508,6 +504,8 @@ void Rover::log_picture()
@@ -508,6 +504,8 @@ void Rover::log_picture()
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
void Rover::do_set_reverse(const AP_Mission::Mission_Command& cmd) |
|
|
|
|
{ |
|
|
|
|
if (cmd.p1 == 1) { |
|
|
|
|