From 48e230317537f1daa51a5387cb626db5524dbab0 Mon Sep 17 00:00:00 2001
From: chobits <chobits@itri.org.tw>
Date: Mon, 12 Aug 2019 15:00:30 +0800
Subject: [PATCH] flightdata: add system_time action

---
 GCSViews/FlightData.cs | 17 +++++++++++++++++
 1 file changed, 17 insertions(+)

diff --git a/GCSViews/FlightData.cs b/GCSViews/FlightData.cs
index 1e4d4ea1b5..4cb21f9e8f 100644
--- a/GCSViews/FlightData.cs
+++ b/GCSViews/FlightData.cs
@@ -263,6 +263,7 @@ public FlightData()
                 list.Add("MISSION_START");
                 list.Add("PREFLIGHT_REBOOT_SHUTDOWN");
                 list.Add("Trigger Camera NOW");
+                list.Add("SYSTEM_TIME");
                 //DO_SET_SERVO
                 //DO_REPEAT_SERVO
             }
@@ -1961,6 +1962,22 @@ private void BUTactiondo_Click(object sender, EventArgs e)
                 return;
             }
 
+            if (CMB_action.Text == "SYSTEM_TIME")
+            {
+                var now = DateTime.UtcNow;
+                var epoch = new DateTime(1970, 1, 1, 0, 0, 0, DateTimeKind.Utc);
+                ulong time_unix_us = Convert.ToUInt64((now - epoch).TotalMilliseconds * 1000);
+                try
+                {
+                    MainV2.comPort.sendPacket(new MAVLink.mavlink_system_time_t() { time_unix_usec = time_unix_us, time_boot_ms = 0 }, MainV2.comPort.sysidcurrent, MainV2.comPort.compidcurrent);
+                }
+                catch
+                {
+                    CustomMessageBox.Show(Strings.CommandFailed, Strings.ERROR);
+                }
+                return;
+            }
+
             if (
                 CustomMessageBox.Show("Are you sure you want to do " + CMB_action.Text + " ?", "Action",
                     MessageBoxButtons.YesNo) == (int)DialogResult.Yes)