Changeset 12252

Timestamp:

10/23/11 19:43:03 (13 years ago)

Author:

tbretz

Message:

Added commands to set LED brightness.

File:

• trunk/FACT++/src/drivectrl.cc (modified) (3 diffs)

trunk/FACT++/src/drivectrl.cc

@@ -307 +307 @@
             tpoint.fRealMag = mag;
 
+            UpdteTPoint(t1, tpoint);
+
             return;
         }
@@ -661 +663 @@
         return SendCommand(command);
     }
+
+    int SetLedBrightness(const EventImp &evt)
+    {
+        if (!CheckEventSize(evt.GetSize(), "SetLedBrightness", 8))
+            return T::kSM_FatalError;
+
+        const uint32_t *led = evt.Ptr<uint32_t>();
+
+        ostringstream cmd;
+        cmd << "LEDS " << led[0] << " " << led[1];
+        return SendCommand(cmd.str());
+    }
+
 
     int SetVerbosity(const EventImp &evt)
@@ -800 +815 @@
         T::AddEvent("TPOINT")
             (bind(&StateMachineDrive::SendCommand, this, "TPOIN FACT 0"))
+            ("");
+
+        T::AddEvent("SET_LED_BRIGHTNESS", "I:2")
+            (bind(&StateMachineDrive::SetLedBrightness, this, placeholders::_1))
+            ("");
+
+        T::AddEvent("LEDS_OFF")
+            (bind(&StateMachineDrive::SendCommand, this, "LEDS 0 0"))
             ("");