pifacedigital lib function use

src/mainclass.cpp

@@ -4,6 +4,11 @@
 #include <sysexits.h>
 #include <climits>
 #include <getopt.h>
+#include <unistd.h>
+#include <pifacedigital.h>
+
+int MainClass::current_device_ = -1;
+uint8_t MainClass::pins_ = 0;
 
 MainClass::MainClass(int argc, char* argv[])
   : argc_(argc)
@@ -71,23 +76,40 @@ bool MainClass::build_actions_()
         return bad_value_();
       actions_.push_back([arg]() -> bool
           {
-          return true;
+          if (get_current_device() != -1)
+            pifacedigital_close(get_current_device());
+          return pifacedigital_open(set_current_device(arg)) != -1;
           });
     }
     else if (opt == 'u')
     {
       if (arg > 7)
         return bad_value_();
+      actions_.push_back([arg]() -> bool
+          {
+          pifacedigital_write_reg(up_pin(arg), OUTPUT, get_current_device());
+          return true;
+          });
     }
     else if (opt == 'd')
     {
       if (arg > 7)
         return bad_value_();
+      actions_.push_back([arg]() -> bool
+          {
+          pifacedigital_write_reg(down_pin(arg), OUTPUT, get_current_device());
+          return true;
+          });
     }
     else if (opt == 's')
     {
       if (arg > UINT_MAX)
         return bad_value_();
+      actions_.push_back([arg]() -> bool
+          {
+          usleep(arg * 1000);
+          return true;
+          });
     }
     else
       return false;
@@ -104,3 +126,28 @@ int MainClass::execute()
       return 1;
   return 0;
 }
+
+int MainClass::get_current_device()
+{
+  return current_device_;
+}
+
+int MainClass::set_current_device(int c)
+{
+  return (current_device_ = c);
+}
+
+uint8_t MainClass::get_pins()
+{
+  return pins_;
+}
+
+uint8_t MainClass::up_pin(uint8_t pin)
+{
+  return (pins_ |= (1 << pin));
+}
+
+uint8_t MainClass::down_pin(uint8_t pin)
+{
+  return (pins_ &= ~(1 << pin));
+}

src/mainclass.hh

@@ -10,11 +10,21 @@ class MainClass
     int usage();
     int execute();
 
+    static int get_current_device();
+    static int set_current_device(int c);
+
+    static uint8_t get_pins();
+    static uint8_t up_pin(uint8_t pin);
+    static uint8_t down_pin(uint8_t pin);
+
   private:
     bool build_actions_();
     bool bad_value_();
     int argc_;
     char** argv_;
     std::vector<std::function<bool()>> actions_;
+
+    static int current_device_;
+    static uint8_t pins_;
 };
 #endif /* !MAINCLASS_HH */