HOme Sheriff And Lamp

Dependencies:   CameraC328 HCSR04 SDFileSystem WIZnetInterface mbed

Fork of HoSAL by pi bae

Committer:
uasonice
Date:
Tue Aug 11 16:05:02 2015 +0000
Revision:
0:35211a622a44
Child:
2:3c7526a1893a
Initial: Home Sheriff and Lamp project

Who changed what in which revision?

UserRevisionLine numberNew contents of line
uasonice 0:35211a622a44 1 #include "mbed.h"
uasonice 0:35211a622a44 2 #include "hcsr04.h"
uasonice 0:35211a622a44 3 #include "rev_Hcsr04.h"
uasonice 0:35211a622a44 4
uasonice 0:35211a622a44 5 #define DEBUG_TYPE 1
uasonice 0:35211a622a44 6 #define P_ uart.printf
uasonice 0:35211a622a44 7 #include "rev_config.h"
uasonice 0:35211a622a44 8
uasonice 0:35211a622a44 9
uasonice 0:35211a622a44 10 #define CHECK_DISTANCE 1000
uasonice 0:35211a622a44 11
uasonice 0:35211a622a44 12 #if 0
uasonice 0:35211a622a44 13 int sum_dist[3] = {0,}; //ryuhs74@20150712 -
uasonice 0:35211a622a44 14 int avg_dist = 0; //ryuhs74@20150712 -
uasonice 0:35211a622a44 15 int index_dist = 0; //ryuhs74@20150712 -
uasonice 0:35211a622a44 16 #endif
uasonice 0:35211a622a44 17
uasonice 0:35211a622a44 18 Serial uart(USBTX, USBRX); // tx, rx
uasonice 0:35211a622a44 19
uasonice 0:35211a622a44 20 HCSR04 sensor(D12, D11);
uasonice 0:35211a622a44 21
uasonice 0:35211a622a44 22 DigitalOut led1(LED1); //server listning status
uasonice 0:35211a622a44 23 DigitalOut led2(LED2); //socket connecting status
uasonice 0:35211a622a44 24
uasonice 0:35211a622a44 25 //////////////////////////////////////////////////////////////////////////
uasonice 0:35211a622a44 26 Ticker ledTick;
uasonice 0:35211a622a44 27
uasonice 0:35211a622a44 28 //////////////////////////////////////////////////////////////////////////
uasonice 0:35211a622a44 29 void ledTickfunc()
uasonice 0:35211a622a44 30 {
uasonice 0:35211a622a44 31 led1 = !led1;
uasonice 0:35211a622a44 32 }
uasonice 0:35211a622a44 33
uasonice 0:35211a622a44 34 //////////////////////////////////////////////////////////////////////////
uasonice 0:35211a622a44 35 int main()
uasonice 0:35211a622a44 36 {
uasonice 0:35211a622a44 37 ledTick.attach(&ledTickfunc,0.5);
uasonice 0:35211a622a44 38
uasonice 0:35211a622a44 39 uart.baud(115200);
uasonice 0:35211a622a44 40 DM_fLN("Start ----> HCSR04");
uasonice 0:35211a622a44 41
uasonice 0:35211a622a44 42 while(1) {
uasonice 0:35211a622a44 43 #if 0
uasonice 0:35211a622a44 44 long distance = sensor.distance();
uasonice 0:35211a622a44 45
uasonice 0:35211a622a44 46 //ryuhs74@20150712 START -
uasonice 0:35211a622a44 47 if( index_dist < 3){
uasonice 0:35211a622a44 48 sum_dist[index_dist] = distance;
uasonice 0:35211a622a44 49 DM_fLN("sum_dist[%d] = %d", index_dist, sum_dist[index_dist]);
uasonice 0:35211a622a44 50 index_dist ++;
uasonice 0:35211a622a44 51 wait_ms(200);
uasonice 0:35211a622a44 52 } else {
uasonice 0:35211a622a44 53 avg_dist = 0;
uasonice 0:35211a622a44 54 index_dist = 0;
uasonice 0:35211a622a44 55
uasonice 0:35211a622a44 56 for(int i =0; i<3;i++){
uasonice 0:35211a622a44 57 avg_dist += sum_dist[i];
uasonice 0:35211a622a44 58 }
uasonice 0:35211a622a44 59
uasonice 0:35211a622a44 60 avg_dist /= 3;
uasonice 0:35211a622a44 61 DM_fLN("average: %d", avg_dist);
uasonice 0:35211a622a44 62
uasonice 0:35211a622a44 63 if( avg_dist <= CHECK_DISTANCE ){
uasonice 0:35211a622a44 64
uasonice 0:35211a622a44 65 }
uasonice 0:35211a622a44 66 wait_ms(1000);
uasonice 0:35211a622a44 67 }
uasonice 0:35211a622a44 68 #else
uasonice 0:35211a622a44 69 get_distance();
uasonice 0:35211a622a44 70 wait_ms(1000);
uasonice 0:35211a622a44 71 #endif
uasonice 0:35211a622a44 72 }
uasonice 0:35211a622a44 73 }
uasonice 0:35211a622a44 74
uasonice 0:35211a622a44 75