![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
HOme Sheriff And Lamp
Dependencies: CameraC328 HCSR04 SDFileSystem WIZnetInterface mbed
Fork of HoSAL by
Diff: main.cpp
- Revision:
- 0:35211a622a44
- Child:
- 2:3c7526a1893a
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Aug 11 16:05:02 2015 +0000 @@ -0,0 +1,75 @@ +#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 + } +} + +