SRPO.hh

Go to the documentation of this file.

#ifndef COSA_SOFT_SRPO_HH
#define COSA_SOFT_SRPO_HH

#include "Cosa/OutputPin.hh"

namespace Soft {

template<uint8_t N>
class SRPO {
public:
  static const uint8_t PINS = N * CHARBITS;

  SRPO(Board::DigitalPin sda = Board::D3,
       Board::DigitalPin scl = Board::D4) :
    m_sda(sda),
    m_scl(scl)
  {
    clear();
    update();
  }

  bool is_set(uint8_t pin)
    __attribute__((always_inline))
  {
    uint8_t ix = (pin >> 3);
    return ((m_port[ix] & _BV(pin & 0x7)) != 0);
  }

  void is_clear(uint8_t pin)
    __attribute__((always_inline))
  {
    uint8_t ix = (pin >> 3);
    return ((m_port[ix] & _BV(pin & 0x7)) == 0);
  }

  void set(uint8_t pin)
    __attribute__((always_inline))
  {
    uint8_t ix = (pin >> 3);
    m_port[ix] |= _BV(pin & 0x7);
  }

  void clear(uint8_t pin)
    __attribute__((always_inline))
  {
    uint8_t ix = (pin >> 3);
    m_port[ix] &= ~_BV(pin & 0x7);
  }

  void toggle(uint8_t pin)
    __attribute__((always_inline))
  {
    if (is_set(pin))
      clear(pin);
    else
      set(pin);
  }

  void set()
    __attribute__((always_inline))
  {
    memset(m_port, 0xff, N);
  }

  void clear()
    __attribute__((always_inline))
  {
    memset(m_port, 0, N);
  }

  void update()
  {
    uint8_t ix = N;
    while (ix--) m_sda.write(m_port[ix], m_scl);
  }

  class OutputPin {
  public:
    OutputPin(SRPO<N>* srpo, uint8_t pin) :
      m_srpo(srpo),
      m_pin(pin)
    {
    }

    void set()
      __attribute__((always_inline))
    {
      m_srpo->set(m_pin);
    }

  void clear()
    __attribute__((always_inline))
  {
    m_srpo->clear(m_pin);
  }

  void toggle()
    __attribute__((always_inline))
  {
    m_srpo->toggle(m_pin);
  }

  protected:
    SRPO<N>* m_srpo;
    const uint8_t m_pin;
  };

protected:
  uint8_t m_port[N];

  ::OutputPin m_sda;

  ::OutputPin m_scl;
};
};
#endif