extern "C" {
  #include "speedometer.h"
  #include "speedometer2d.h"
  #include "speedometer3d.h"
}

void setup() {
  Serial.begin(115200);

  speedometer_t speedo = {0};

  speedo_clear(&speedo);

  for (int i = 0; i < 5; i++) {
    bool valid;
    Serial.print("pos : ");
    Serial.print(speedo_getPosition(&speedo, micros(), &valid));
    Serial.print(" spd : ");
    Serial.print(speedo_getSpeed(&speedo));
    Serial.print(" acc : ");
    Serial.print(speedo_getAcc(&speedo));
    Serial.print(" valid : ");
    Serial.println(valid);

    speedo_ingest(&speedo, 0, micros());
  }
}

void loop() {
  // put your main code here, to run repeatedly:

}