#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));
}