fixed opening wring device

src/mainclass.cpp

@@ -8,7 +8,6 @@
 #include <pifacedigital.h>
 
 int MainClass::current_device_ = -1;
-uint8_t MainClass::pins_ = 0;
 
 MainClass::MainClass(int argc, char* argv[])
   : argc_(argc)
@@ -88,13 +87,12 @@ bool MainClass::build_actions_()
       actions_.push_back([arg, opt]() -> bool
           {
           if (get_current_device() == -1 &&
-            !set_current_device(arg))
+            !set_current_device(0))
             return false;
+          std::cout << "Setting pin " << arg << " " <<
+            (opt == 'u' ? "up" : "down") << std::endl;
           pifacedigital_write_bit(opt == 'u', arg, OUTPUT,
             get_current_device());
-          /*pifacedigital_write_reg(opt == 'u' ? up_pin(arg) : down_pin(arg),
-            OUTPUT, get_current_device());
-          std::cout << std::hex << (int)get_pins() << std::endl;*/
           return true;
           });
     }
@@ -104,6 +102,7 @@ bool MainClass::build_actions_()
         return bad_value_();
       actions_.push_back([arg]() -> bool
           {
+          std::cout << "Sleeping " << (arg * 1000) << " ms" << std::endl;
           usleep(arg * 1000);
           return true;
           });
@@ -143,27 +142,11 @@ int MainClass::get_current_device()
 
 bool MainClass::set_current_device(int c)
 {
+  std::cout << "Switching to device " << c << std::endl;
   if (pifacedigital_open((current_device_ = c)) == -1)
   {
     std::cerr << std::endl;
     return false;
   }
-  pifacedigital_enable_interrupts();
-  pins_ = pifacedigital_read_reg(c, OUTPUT);
   return true;
 }
-
-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

@@ -13,10 +13,6 @@ class MainClass
     static int get_current_device();
     static bool 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_();
@@ -25,6 +21,5 @@ class MainClass
     std::vector<std::function<bool()>> actions_;
 
     static int current_device_;
-    static uint8_t pins_;
 };
 #endif /* !MAINCLASS_HH */