Add port to OsTime to set the current time (#3607)

Author: celskeggs

Svc/OsTime/OsTime.cpp

@@ -33,6 +33,19 @@ void OsTime::set_epoch(const Fw::Time& fw_time, const Os::RawTime& os_time) {
     m_epoch_valid = true;
 }
 
+void OsTime::SetCurrentTime_cmdHandler(FwOpcodeType opCode, U32 cmdSeq, U32 seconds_now) {
+    Os::RawTime time_now;
+    Os::RawTime::Status stat = time_now.now();
+    if (stat != Os::RawTime::OP_OK) {
+        this->log_WARNING_HI_SetCurrentTimeError(stat);
+        return;
+    }
+    Os::ScopeLock lock(m_epoch_lock);
+    m_epoch_fw_time = Fw::Time(seconds_now, 0);
+    m_epoch_os_time = time_now;
+    m_epoch_valid = true;
+}
+
 // ----------------------------------------------------------------------
 // Handler implementations for user-defined typed input ports
 // ----------------------------------------------------------------------

Svc/OsTime/OsTime.fpp

@@ -5,5 +5,34 @@ module Svc {
         include "../Interfaces/TimeInterface.fppi"
 
         sync input port setEpoch: OsTimeEpoch
+
+        @ Port for receiving commands
+        command recv port CmdDisp
+
+        @ Port for sending command registration requests
+        command reg port CmdReg
+
+        @ Port for sending command responses
+        command resp port CmdStatus
+
+        @ Event port
+        event port EventOut
+
+        @ Text event port
+        text event port LogText
+
+        @ Time get port
+        time get port timeCaller
+
+        sync command SetCurrentTime(seconds_now: U32) opcode 0x00
+
+        @ An error occurred while attempting to set the current time
+        event SetCurrentTimeError(
+                            status: U32 @< The error status
+                            ) \
+        severity warning high \
+        id 0x00 \
+        format "Could not set current time due to RawTime error status {}"
+
     }
 }

Svc/OsTime/OsTime.hpp

@@ -49,6 +49,12 @@ class OsTime final : public OsTimeComponentBase {
                           const Fw::Time& fw_time,
                           const Os::RawTime& os_time) override;
 
+    
+    //! Handler implementation for command SetCurrentTime
+    void SetCurrentTime_cmdHandler(FwOpcodeType opCode, //!< The opcode
+                                   U32 cmdSeq, //!< The command sequence number
+                                   U32 seconds_now) override;
+
     Fw::Time m_epoch_fw_time;
     Os::RawTime m_epoch_os_time;
     bool m_epoch_valid;