aries-common: libcamera: Send GPS info to CE147

1 files changed, 56 insertions, 1 deletions

diff --git a/libcamera/SecCamera.cpp b/libcamera/SecCamera.cpp
index cb6ad10..7ea19e8 100755
--- a/libcamera/SecCamera.cpp
+++ b/libcamera/SecCamera.cpp
@@ -1208,7 +1208,20 @@ int SecCamera::setSnapshotCmd(void)
     CHECK(ret);
 
     // Additional calls needed for CE147
-    // TODO: GPS
+
+    // GPS
+    ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_GPS_LATITUDE, &gpsInfoLatitude);
+    CHECK(ret);
+    ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_GPS_LONGITUDE, &gpsInfoLongitude);
+    CHECK(ret);
+    ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_GPS_ALTITUDE, &gpsInfoAltitude);
+    CHECK(ret);
+    ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_GPS_PROCESSINGMETHOD,
+        mExifInfo.gps_processing_method);
+    CHECK(ret);
+    unsigned long temp = m_gps_timestamp;
+    ret = fimc_v4l2_s_ext_ctrl(m_cam_fd, V4L2_CID_CAMERA_GPS_TIMESTAMP, &temp);
+    CHECK(ret);
 
     // Time
     time_t rawtime;
@@ -2520,6 +2533,23 @@ int SecCamera::setGPSLatitude(const char *gps_latitude)
         m_gps_latitude = lround(strtod(gps_latitude, NULL) * 10000000);
     }
 
+    if (m_camera_id == CAMERA_ID_BACK) {
+        if (m_gps_enabled) {
+            long tmp = (m_gps_latitude >= 0) ? m_gps_latitude : -m_gps_latitude;
+            gpsInfoLatitude.north_south = m_gps_latitude < 0;
+            gpsInfoLatitude.dgree = tmp / 10000000;
+            tmp = (tmp % 10000000) * 60;
+            gpsInfoLatitude.minute = tmp / 10000000;
+            gpsInfoLatitude.second = (tmp % 10000000) * 60 / 10000000;
+        }
+        else {
+            gpsInfoLatitude.north_south = 0;
+            gpsInfoLatitude.dgree = 0;
+            gpsInfoLatitude.minute = 0;
+            gpsInfoLatitude.second = 0;
+        }
+    }
+
     LOGV("%s(m_gps_latitude(%ld))", __func__, m_gps_latitude);
     return 0;
 }
@@ -2534,6 +2564,23 @@ int SecCamera::setGPSLongitude(const char *gps_longitude)
         m_gps_longitude = lround(strtod(gps_longitude, NULL) * 10000000);
     }
 
+    if (m_camera_id == CAMERA_ID_BACK) {
+        if (m_gps_enabled) {
+            long tmp = (m_gps_longitude >= 0) ? m_gps_longitude : -m_gps_longitude;
+            gpsInfoLongitude.east_west = m_gps_longitude < 0;
+            gpsInfoLongitude.dgree = tmp / 10000000;
+            tmp = (tmp % 10000000) * 60;
+            gpsInfoLongitude.minute = tmp / 10000000;
+            gpsInfoLongitude.second = (tmp % 10000000) * 60 / 10000000;
+        }
+        else {
+            gpsInfoLongitude.east_west = 0;
+            gpsInfoLongitude.dgree = 0;
+            gpsInfoLongitude.minute = 0;
+            gpsInfoLongitude.second = 0;
+        }
+    }
+
     LOGV("%s(m_gps_longitude(%ld))", __func__, m_gps_longitude);
     return 0;
 }
@@ -2547,6 +2594,14 @@ int SecCamera::setGPSAltitude(const char *gps_altitude)
         m_gps_altitude = lround(strtod(gps_altitude, NULL) * 100);
     }
 
+    if (m_camera_id == CAMERA_ID_BACK) {
+        gpsInfoAltitude.plus_minus = (m_gps_altitude >= 0);
+        long tmp = gpsInfoAltitude.plus_minus ? m_gps_altitude : -m_gps_altitude;
+        gpsInfoAltitude.dgree = tmp / 100;
+        gpsInfoAltitude.minute = tmp % 100;
+        gpsInfoAltitude.second = 0;
+    }
+
     LOGV("%s(m_gps_altitude(%ld))", __func__, m_gps_altitude);
     return 0;
 }