From 19ea16784ca88952b9110410444077c061dd5ca0 Mon Sep 17 00:00:00 2001
From: Matt <lawrence.matt@gmail.com>
Date: Sat, 16 Dec 2017 11:02:16 -0500
Subject: [PATCH] GOPRO: Add photo logging output for Solex GCS app

The Solex GCS app has a photo logging function for missions and geo
tagging.  This sends the applicable data from the Solo to the app.
---
 shotmanager/GoProManager.py | 33 +++++++++++++++++++++++++++++++++
 shotmanager/app_packet.py   |  1 +
 2 files changed, 34 insertions(+)

diff --git a/shotmanager/GoProManager.py b/shotmanager/GoProManager.py
index ce8f473..0da2a5a 100644
--- a/shotmanager/GoProManager.py
+++ b/shotmanager/GoProManager.py
@@ -352,6 +352,11 @@ class GoProManager():
 
         self.queueMsg(msg)
 
+        if self.captureMode == CAPTURE_MODE_PHOTO:
+            if command == mavutil.mavlink.GOPRO_COMMAND_SHUTTER:
+                if value[0] == 1:
+                    self.sendPhotoEvent()
+
         # Follow up with a get request if notification of change is required
         if command in REQUERY_COMMANDS:
             self.sendGoProRequest(command)
@@ -472,6 +477,34 @@ class GoProManager():
             (command, value1, value2, value3, value4, ) = struct.unpack("<HBBBB", data)
             self.sendGoProCommand(command, (value1, value2, value3, value4))
 
+    # Send a photo event with current time and location.
+    def sendPhotoEvent(self): 
+        now = monotonic.monotonic()
+        logger.log("[gopro]: send photo event.  now is %d"%now)
+
+        if self.shotMgr.vehicle.location.global_relative_frame is not None:
+            pkt = struct.pack("<IIddfI", app_packet.GOPRO_PHOTO, 24, 
+                self.shotMgr.vehicle.location.global_relative_frame.lat, 
+                self.shotMgr.vehicle.location.global_relative_frame.lon, 
+                self.shotMgr.vehicle.location.global_relative_frame.alt, 
+                monotonic.monotonic())
+
+            self.addPhotoLog(
+                self.shotMgr.vehicle.location.global_relative_frame.lat, 
+                self.shotMgr.vehicle.location.global_relative_frame.lon, 
+                self.shotMgr.vehicle.location.global_relative_frame.alt, 
+                monotonic.monotonic())
+        else:
+            pkt = struct.pack("<IIddfI", app_packet.GOPRO_PHOTO, 24, 0, 0, 0, monotonic.monotonic())
+
+        self.shotMgr.appMgr.sendPacket(pkt)
+
+    # Add an entry to /log/photo.log
+    def addPhotoLog(self, lat, lon, alt, time):
+        f = open("/log/photo.log", "a")
+        f.write("%.6f,%.6f,%.3f,%d\n" % (lat, lon, alt, time))
+        f.close();
+
 
     # packages up our entire current state and sends it to the app
     def sendState(self):
diff --git a/shotmanager/app_packet.py b/shotmanager/app_packet.py
index bb08a87..00925cc 100755
--- a/shotmanager/app_packet.py
+++ b/shotmanager/app_packet.py
@@ -82,6 +82,7 @@ GOPRO_V1_STATE = 5005
 GOPRO_V2_STATE = 5006
 GOPRO_REQUEST_STATE = 5007
 GOPRO_SET_EXTENDED_REQUEST = 5009
+GOPRO_PHOTO = 5020 # Added to Open Solo for solex app photo logging
 
 
 # enums for packet types