HOme Sheriff And Lamp
Dependencies: CameraC328 HCSR04 SDFileSystem WIZnetInterface mbed
Fork of HoSAL by
main.cpp
- Committer:
- uasonice
- Date:
- 2015-08-11
- Revision:
- 0:35211a622a44
- Child:
- 2:3c7526a1893a
File content as of revision 0:35211a622a44:
#include "mbed.h"
#include "hcsr04.h"
#include "rev_Hcsr04.h"
#define DEBUG_TYPE 1
#define P_ uart.printf
#include "rev_config.h"
#define CHECK_DISTANCE 1000
#if 0
int sum_dist[3] = {0,}; //ryuhs74@20150712 -
int avg_dist = 0; //ryuhs74@20150712 -
int index_dist = 0; //ryuhs74@20150712 -
#endif
Serial uart(USBTX, USBRX); // tx, rx
HCSR04 sensor(D12, D11);
DigitalOut led1(LED1); //server listning status
DigitalOut led2(LED2); //socket connecting status
//////////////////////////////////////////////////////////////////////////
Ticker ledTick;
//////////////////////////////////////////////////////////////////////////
void ledTickfunc()
{
led1 = !led1;
}
//////////////////////////////////////////////////////////////////////////
int main()
{
ledTick.attach(&ledTickfunc,0.5);
uart.baud(115200);
DM_fLN("Start ----> HCSR04");
while(1) {
#if 0
long distance = sensor.distance();
//ryuhs74@20150712 START -
if( index_dist < 3){
sum_dist[index_dist] = distance;
DM_fLN("sum_dist[%d] = %d", index_dist, sum_dist[index_dist]);
index_dist ++;
wait_ms(200);
} else {
avg_dist = 0;
index_dist = 0;
for(int i =0; i<3;i++){
avg_dist += sum_dist[i];
}
avg_dist /= 3;
DM_fLN("average: %d", avg_dist);
if( avg_dist <= CHECK_DISTANCE ){
}
wait_ms(1000);
}
#else
get_distance();
wait_ms(1000);
#endif
}
}
