#include <multiMap.h>
#include <mechButton.h>

multiMap      mapI;
multiMap      mapJ;
mechButton    trigger(2);
unsigned long startTime;

void setup() {

  mapI.addPoint(0,0);
  mapI.addPoint(50,127);
  mapI.addPoint(100,0);

  mapJ.addPoint(0,0);
  mapJ.addPoint(0+40,0);
  mapJ.addPoint(50+40,127);
  mapJ.addPoint(100+40,0);

  trigger.setCallback(gotClk);
  pinMode(9,OUTPUT);
  pinMode(10,OUTPUT);
}


void gotClk(void) {

  if (!trigger.getState()) {
    startTime = micros();
  }
}


void loop() {

  unsigned long now;

  idle();
  now = micros() - startTime;
  analogWrite(9,mapI.map(now));
  analogWrite(10,mapJ.map(now));
}