HapticBelt.cpp

#include "HapticBelt.h"
#include <Arduino.h>


HapticBelt::HapticBelt(int haptics[8])
{
    for (int i = 0; i < 8; i++)
    {
        haptic_pins_[i] = haptics[i];
        pinMode(haptic_pins_[i], OUTPUT);
    }
    
}

bool HapticBelt::isDirectionValid(int direction)
{
    return direction >= 0 && direction < 360 && direction % 45 == 0;
}

void HapticBelt::on(int direction, int power)
{
    if (!isDirectionValid(direction))
    {
        // Error condition
        return;
    }

    int position = direction / 45;

 
    if (power >= 255){
      digitalWrite(haptic_pins_[position], HIGH);
    } else {
      analogWrite(haptic_pins_[position], power);
    }
}

void HapticBelt::off()
{
  for (int i = 0; i < 8; i++)
  {
      digitalWrite(haptic_pins_[i], LOW);
  }
}

void HapticBelt::off(int direction)
{
    if (!isDirectionValid(direction))
    {
        // Error condition
        return;
    }

    int position = direction / 45;
    
    digitalWrite(haptic_pins_[position], LOW);
}