#include "Arduino.h"
#include "sensor.h"
#include <Ultrasonic.h>
#include "hal.h"
#include "display.h"


RTC_DATA_ATTR int prevDistance = 0;

Ultrasonic ultrasonic(TRIGGER, ECHO);
int distance;

void sensorInit(void)
{
  sensorUpdateDistance();
  Serial.println("sensor Init done");
  displayWriteLine("Sensor Init Done");

}


void sensorUpdateDistance(void)
{
  distance = ultrasonic.read();
  Serial.printf("Distance = %i CM\n",distance);
}

int sensorGetDistance(void)
{
  return distance;
}

// int sensorGetPreviousDistance(void)
// {
//   return prevDistance;
// }