leds.cpp

Go to the documentation of this file.

#include "leds.h"
#include <Bela.h>
#include <iostream>
using namespace std;
 
Leds::Leds(BelaContext* ctx) {
  dT = ctx->digitalFrames/ctx->digitalSampleRate;
  pinMode(ctx, 0, LED_PIN_WRIST, OUTPUT);
  pinMode(ctx, 0, LED_PIN_THUMB, OUTPUT);
  pinMode(ctx, 0, VIBRATOR_PIN, OUTPUT);
  pinMode(ctx, 0, LED_PIN_CONTROLBOX, OUTPUT);
}
 
bool Leds::processLed(Led _led) {
  int ledno = (int) _led;
  LedState ledstate = _ledstate[ledno];
  switch(ledstate) {
    case off:
      return false;
      break;
    case on:
      return true;
      break;
    case blink_permanent: 
      {
        bool state = false;
        float bp = _blinkPeriod[ledno];
        float *time  = &(_timer[ledno]);
        float dc = _blinkDutyCycle[ledno];
        if(*time > bp) {(*time) -= bp;}
        state = (*time < dc*bp) ? true : false;
 
        *time += dT;
        return state;
      }
    case blink_once:
      {
        bool state = false;
        float bp = _blinkPeriod[ledno];
        float *time  = &(_timer[ledno]);
        state = (*time < bp) ? true : false;
        if(*time > bp) {
          (*time) = 0;
          _ledstate[ledno] = off;
        }
 
        *time += dT;
        return state;
 
      }
 
  }
  return false;
 
}
 
void Leds::processBuf(BelaContext* ctx) {
 
  _on[(int) wrist] = processLed(wrist);
  _on[(int) thumb] = processLed(thumb);
  _on[(int) vibrator] = processLed(vibrator);
  _on[(int) controlbox] = processLed(controlbox);
 
  /* pinMode(ctx, 0, LED_PIN_WRIST, OUTPUT); */
  /* pinMode(ctx, 0, LED_PIN_THUMB, OUTPUT); */
  /* pinMode(ctx, 0, VIBRATOR_PIN, OUTPUT); */
  /* pinMode(ctx, 0, LED_PIN_CONTROLBOX, OUTPUT); */
 
}
 
void Leds::processFrame(BelaContext* ctx, const us frameno) {
  digitalWrite(ctx, frameno, LED_PIN_WRIST, _on[(int) wrist]);
  digitalWrite(ctx, frameno, LED_PIN_THUMB, _on[(int) thumb]);
  digitalWrite(ctx, frameno, VIBRATOR_PIN, _on[(int) vibrator]);
  digitalWrite(ctx, frameno, LED_PIN_CONTROLBOX, _on[(int) controlbox]);
}
 
 
void Leds::setState(Led led,LedState ledstate, float period, float dutycycle) {
 
  _ledstate[(int) led] = ledstate;
  _timer[(int) led] = 0.0f;
  _blinkPeriod[(int) led] = period;
  _blinkDutyCycle[(int) led] = dutycycle;
 
}