seesaw_motor.h

#ifndef _SEESAW_MOTOR_H
#define _SEESAW_MOTOR_H

#include "Adafruit_seesaw.h"

/**************************************************************************/
/**************************************************************************/
class seesaw_Motor {
public:
  /**************************************************************************/
  /**************************************************************************/
  seesaw_Motor(Adafruit_seesaw *ss) {
    _ss = ss;
    _pina = -1;
    _pinb = -1;
    _throttle = 0;
  }

  ~seesaw_Motor() {}

  /**************************************************************************/
  /**************************************************************************/
  void attach(int pina, int pinb) {
    _pina = pina;
    _pinb = pinb;
  }

  /**************************************************************************/
  /**************************************************************************/
  void throttle(float value) {
    if (_pina < 0 || _pinb < 0)
      return;

    value = constrain(value, -1.0, 1.0);
    _throttle = value;
    uint16_t absolute = fabs(value) * 65535;

    if (value > 0) {
      _ss->analogWrite(_pina, 0);
      _ss->analogWrite(_pinb, absolute);
    } else if (value < 0) {
      _ss->analogWrite(_pina, absolute);
      _ss->analogWrite(_pinb, 0);
    } else {
      // both are off
      _ss->analogWrite(_pina, 0);
      _ss->analogWrite(_pinb, 0);
    }
  }

  /**************************************************************************/
  /**************************************************************************/
  float getThrottle() { return _throttle; }

private:
  Adafruit_seesaw *_ss;
  int8_t _pina, _pinb;
  float _throttle;
};

#endif