#include <Plaquette.h>

const int trigPin = 9;
const int echoPin = 10;

DigitalIn echo(echoPin);
MinMaxScaler scaler;

Metronome metro(0.1f);
Chronometer chrono;

void ping() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
}

void pong() {
  chrono >> scaler;
  println(scaler);
}

void begin() {
  pinMode(trigPin, OUTPUT);
  digitalWrite(trigPin, LOW);
  ping();
  
  echo.off();

  metro.onBang(ping);
  echo.onRise([]() { chrono.start(); });
  echo.onFall(pong);
}

void step() {
}