Diff: main.cpp

Revision:

8:5f1b4151c9e4

Parent:

7:e30d35831e6c

Child:

9:fd46a7024326

--- a/main.cpp	Wed Feb 01 06:45:54 2017 +0000
+++ b/main.cpp	Wed Feb 01 09:30:48 2017 +0000
@@ -11,7 +11,7 @@
 
 int main()
 {   
-   int status;
+   int status,i,add,ds[12];
    uint32_t distance;
    pc.baud(115200);
 
@@ -21,11 +21,26 @@
 
    status=board->InitBoard();
    if(status) { printf("Failed to init board!\n\r"); return 0; }
+   
+   for(i = 0; i <= 10; i++) {
+       ds[i] = 0;
+    }
 
    while(1)
    {
+       for(i = 0; i <= 9; i++) {
+           ds[i] = ds [i+1];
+           }
        status = board->sensor_centre->GetDistance(&distance);
-           printf("%ld\n\r", distance);
+       ds[9] = distance;
+       if(ds[9] == 0){
+           ds[9] = ds[8];
+           }
+       for(i = 0; i <= 9; i++) {
+           add = ds[i] + add;
+           }
+       add = add/10;
+       printf("%d\n\r", add);
    }
 
 }