blob: c6c05823d9231c6c7d8c3d3c023bb48d25e9f7d1 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
|
#include "distance_sensor.h"
//-----------------------------------------------------------------------------
float Distance_Sensor::GetDistance()
{
uint32 result = 0;
//Generate pulse
*hardwareDDR |= pin;//Set pin output
*hardwarePort |= pin;//Activate port
usleep(10);//Wait for 10µs
*hardwarePort &= ~pin;//Deactivate port
*hardwareDDR &= ~pin;//Set pin input
//Wait for response
while(!(*hardwarePin & pin));
//Calculate duration of response
while(*hardwarePin & pin)
{
result++;
asm volatile("nop");
}
return (float(result) * DISTANCE_PER_VALUE);
}
|