RotaryButton.cpp

/*******************************************************************************
 * Copyright (c) 2020 Rooi.
 *
 *******************************************************************************/

/*
   This is the polling version of the rotary button decoder.
   The polling period is now 5ms.
   The client of this encoder receives a M_UP message at the
   rising edge of A end a M_DOWN message at the falling edge of B.
 */

#include "RotaryButton.h"

#include "Controller.h"

// #define ROTARYBUTTON_DEBUG 1
#ifdef ROTARYBUTTON_DEBUG
#define blog(fmt, args...)    printf(fmt, ## args)
#else
#define blog(fmt, args...)    /* Don't do anything in release builds */
#endif

/*!
   Constructor for Button.
 */
RotaryButton::RotaryButton() : controller(NULL),
   buttonA(PC_0), 
   buttonB(PC_1),
   led(LED1),
   red(PC_8),
   green(PC_6),
   blue(PC_5),
   buttonP(PC_4),
   count(0),
   stateA(0xffff),
   lastA(1),
   stateB(0xffff),
   lastB(1),
   stateP(0xfe00),
   lastP(0)
{
}

/*!
   Set the client of this decoder.
 */
void RotaryButton::setController(Controller *cnt)
{
   controller = cnt;
}

void RotaryButton::setRed(uint8_t v)
{
   if (v != 0)
   {
      red = 0;
   }
   else
   {
      red = 1;
   }
}

void RotaryButton::setGreen(uint8_t v)
{
   if (v != 0)
   {
      green = 0;
   }
   else
   {
      green = 1;
   }
}

void RotaryButton::setBlue(uint8_t v)
{
   if (v != 0)
   {
      blue = 0;
   }
   else
   {
      blue = 1;
   }
}

void RotaryButton::setRGB(uint8_t r, uint8_t g, uint8_t b)
{
   setRed(r);
   setGreen(g);
   setBlue(b);
}

/*!
   At the start a callback is registered for the ticker
   and the thread is started.
 */
void RotaryButton::start()
{
   blog("RotaryButtonPoll::start()\r\n");

   red   = 1;
   green = 1;
   blue  = 1;
   timeout.attach_us(mbed::callback(this, &RotaryButton::timeHandler), 5000);
   
   Actor::start();
}

/*!
   This method is called every 5ms.
 */
void RotaryButton::timeHandler()
{
   // buttonA
   stateA = (stateA << 1) | (buttonA & 1) | 0xfe00;
   if (stateA == 0xff00)
   {
      // rising edge
      led = !led;
      count++;

      Msg *msg = alloc();
      if (msg != NULL)
      {
         msg->type = M_AUP;
         put(msg);
      }
   }
   else
   if (stateA == 0xfeff)
   {
      // falling edge
      Msg *msg = alloc();
      if (msg != NULL)
      {
         msg->type = M_ADN;
         put(msg);
      }
   }
   
   // buttonB
   stateB = (stateB << 1) | (buttonB & 1) | 0xfe00;
   if (stateB == 0xff00)
   {
      // rising edge
      Msg *msg = alloc();
      if (msg != NULL)
      {
         msg->type = M_BUP;
         put(msg);
      }
   }
   else
   if (stateB == 0xfeff)
   {
      // falling edge
      Msg *msg = alloc();
      if (msg != NULL)
      {
         msg->type = M_BDN;
         put(msg);
      }
   }

   // buttonP
   stateP = (stateP << 1) | (buttonP & 1) | 0xfe00;
   if (stateP == 0xff00)
   {
      // release
      //green = 0;
      //blue  = 1;
      send(M_REL);
   }
   else
   if (stateP == 0xfeff)
   {
      // push
      //green = 1;
      //blue  = 0;
      send(M_PUSH);
   }
}
 
 

/*!
   Read the A and B inputs.
 */
uint8_t RotaryButton::getButtons()
{
   return (buttonA.read() & 0x01) | ((buttonB.read() & 0x01) << 1 );
}

/*!
   Send the message to the client.
 */
void RotaryButton::send(MsgType t)
{
   if (controller != NULL)
   {
      controller->send(t);
   }
}

/*!
   This is the RotaryButton thread.
 */
void RotaryButton::run()
{
   blog("RotaryButton::run()\r\n");

   int     pos = 0;
   uint8_t v   = 3;
   uint8_t w   = v;
   MsgType t;
   while (true)
   {
      Msg *m = get();
      t = m->type;
      free(m);

      switch (t)
      {
      case M_AUP:
         w |= 1;
         break;
      case M_ADN:
         w &= ~1;
         break;
      case M_BUP:
         w |= 2;
         break;
      case M_BDN:
         w &= ~2;
         break;
      }

      switch (v)
      {
      case 0:
         if (w == 1)
         {
            pos++;
            send(M_DOWN);
         }
         else
         if (w == 2)
         {
            pos--;
            send(M_UP);
         }
         break;
      case 1:
         if (w == 0)
         {
            //pos--;
            //send(M_DOWN);
         }
         else
         if (w == 3)
         {
            //pos++;
            //send(M_UP);
         }
         break;
      case 2:
         if (w == 0)
         {
            //pos++;
            //send(M_UP);
         }
         else
         if (w == 3)
         {
            //pos--;
            //send(M_DOWN);
         }
         break;
      case 3:
         if (w == 1)
         {
            //pos--;
            //send(M_DOWN);
         }
         else
         if (w == 2)
         {
            //pos++;
            //send(M_UP);
         }
         break;
      }

      /*
      switch (pos % 3)
      {
      case 0:
         red   = 1;
         green = 0;
         blue  = 0;
         break;
      case 1:
         red   = 0;
         green = 1;
         blue  = 0;
         break;
      case 2:
         red   = 0;
         green = 0;
         blue  = 1;
         break;
      }
       */
      uint8_t pb = buttonP.read() & 1;   
      blog("%d %c: %d->%d - %d - pb <%d>\r\n", count, t, v, w, pos, pb);
      v = w;
   }
}