[module] add option to digital cam to send second DC_SHOT message (#2299)

This commit is contained in:
Gautier Hattenberger
2018-07-24 13:35:53 +02:00
committed by GitHub
parent f3f0c7c043
commit a8f2d10411
2 changed files with 20 additions and 0 deletions
+1
View File
@@ -23,6 +23,7 @@
<define name="DC_AUTOSHOOT_DISTANCE_INTERVAL" value="50" description="distance interval for DC_AUTOSHOOT_DISTANCE in meters"/>
<define name="DC_AUTOSHOOT_SURVEY_INTERVAL" value="50" description="distance interval for DC_AUTOSHOOT_SURVEY in meters"/>
<define name="DC_SHOT_SYNC_SEND" value="TRUE|FALSE" description="send DC_SHOT message when photo was taken (default: TRUE)"/>
<define name="DC_SHOT_EXTRA_DL" value="TRUE|FALSE" description="send DC_SHOT message other extra datalink like companion CPU (default: FALSE, requires DC_SHOT_SYNC_SEND)"/>
</doc>
<settings>
<dl_settings name="control">
+19
View File
@@ -92,6 +92,9 @@ uint16_t dc_photo_nr = 0;
#include "subsystems/datalink/downlink.h"
#include "state.h"
#include "subsystems/gps.h"
#if DC_SHOT_EXTRA_DL
#include "modules/datalink/extra_pprz_dl.h"
#endif
void dc_send_shot_position(void)
{
@@ -110,6 +113,22 @@ void dc_send_shot_position(void)
photo_nr = dc_photo_nr;
}
#if DC_SHOT_EXTRA_DL
// send a message on second datalink first
// (for instance an embedded CPU)
DOWNLINK_SEND_DC_SHOT(extra_pprz_tp, EXTRA_DOWNLINK_DEVICE,
&photo_nr,
&stateGetPositionLla_i()->lat,
&stateGetPositionLla_i()->lon,
&stateGetPositionLla_i()->alt,
&gps.hmsl,
&phi,
&theta,
&psi,
&course,
&speed,
&gps.tow);
#endif
DOWNLINK_SEND_DC_SHOT(DefaultChannel, DefaultDevice,
&photo_nr,
&stateGetPositionLla_i()->lat,