usrp2: implementation of timed commands working

1 files changed, 16 insertions, 4 deletions

diff --git a/host/lib/usrp/multi_usrp.cpp b/host/lib/usrp/multi_usrp.cpp
index 42c654e6b..fd556c9f8 100644
--- a/host/lib/usrp/multi_usrp.cpp
+++ b/host/lib/usrp/multi_usrp.cpp
@@ -356,12 +356,24 @@ public:
         return true;
     }
 
-    void set_command_time(const time_spec_t &, size_t){
-        throw uhd::not_implemented_error("Not implemented yet, but we have a very good idea of how to do it.");
+    void set_command_time(const time_spec_t &time_spec, size_t mboard){
+        if (mboard != ALL_MBOARDS){
+            _tree->access<time_spec_t>(mb_root(mboard) / "time/cmd").set(time_spec);
+            return;
+        }
+        for (size_t m = 0; m < get_num_mboards(); m++){
+            set_command_time(time_spec, m);
+        }
     }
 
-    void clear_command_time(size_t){
-        throw uhd::not_implemented_error("Not implemented yet, but we have a very good idea of how to do it.");
+    void clear_command_time(size_t mboard){
+        if (mboard != ALL_MBOARDS){
+            _tree->access<time_spec_t>(mb_root(mboard) / "time/cmd").set(time_spec_t(0.0));
+            return;
+        }
+        for (size_t m = 0; m < get_num_mboards(); m++){
+            clear_command_time(m);
+        }
     }
 
     void issue_stream_cmd(const stream_cmd_t &stream_cmd, size_t chan){