switch-controller: resolve #21

SwitchController/src/SwitchController.cpp

@@ -25,13 +25,51 @@ SwitchController::~SwitchController ()
 void
 SwitchController::listen ()
 {
-  if (b->read ())
+  int timer = t->getCounter ();
+  /** Button is pressed for the first time*/
+  if (b->read () && !b_state)
     {
+      t->resetCounter ();
       b_state = true;
     }
-  if (!b->read () && b_state)
+  /** Button is released before 2 seconds*/
+  if (!b->read () && b_state && timer < 2000)
     {
       h->HandleState (Event (Event::eKey, b_mode));
       b_state = false;
+      t->resetCounter ();
     }
-}
+  /** Button is pressed after 2 seconds*/
+  if (b->read () && b_state && timer >= 2000)
+    {
+      buttonOnHold ();
+    }
+}
+
+void
+SwitchController::buttonOnHold ()
+{
+  t->resetCounter ();
+  while (b->read ())
+    {
+      buttonInLoop ();
+    }
+  if (b_mode == BUTTON_CONTROL_TOG_MODE)
+    {
+      h->HandleState (Event (Event::eKey, b_mode));
+    }
+  b_state = false;
+  t->resetCounter ();
+}
+
+void
+SwitchController::buttonInLoop ()
+{
+  if (t->getCounter () > 50 && b_mode != BUTTON_CONTROL_TOG_MODE)
+    {
+      h->HandleState (Event (Event::eKey, b_mode));
+      h->HandleState (Event (Event::eTick));
+      t->resetCounter ();
+    }
+  t->tickCounter (2);
+}