36 lines
571 B
C++
36 lines
571 B
C++
#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;
|
|
// }
|