Diff: main.cpp

Revision:

1:01d1c2c9ddb1

Parent:

0:7eded57f1445

--- a/main.cpp	Wed Sep 04 14:32:43 2013 +0000
+++ b/main.cpp	Tue Sep 22 07:46:13 2015 +0000
@@ -1,44 +1,35 @@
 #include "mbed.h"
+#include "stdlib.h"  //For rand function 
+#include "Servo.h"   
 #include "HCSR04.h"
-#include "LCD40x2.h"
 
-DigitalOut led(LED_RED);
-DigitalOut led2(LED_GREEN);
-
-HCSR04 sensor(PTA12, PTD4);
-
-TextLCD lcd(PTC12, PTC16, PTC13, PTC11, PTC10, PTC6, PTC5);
-//TextLCD(PinName rs, PinName rw, PinName e, PinName d0, PinName d1, PinName d2, PinName d3, LCDType type = LCD16x2);
+HCSR04 sensor(D11, D12); //(Trig Pin, Echo Pin)
+Servo myservo(D6);
 
 
 int main()
 {
+  
+    int number = 0;
+    
     while(1){
-                long d = sensor.distance(1);
-                lcd.printf("Distance:%d ",sensor.distance(1));
-                                
-                if(d<=10)
-                {
-                led = 0;
-                led2 = 1;
-                }       
-                         
-                if(d>=200)
-                {
-                led2 = 0;
-                led = 1;
-                }
-                if(d>=11 && d<=39)
-                {
-                led2 = 0;
-                led=0;
-                }
-                
-                
-              }
-         }
-                
-                
+        long d = sensor.distance(1);
+        printf("d = %d\r\n",d);    
+        myservo = 0.5;  
+
+       if(d<=20)    //20cm
+        {
+                number = rand()%11;  //0~10
+                double a = number*0.1;
+                printf("%d = %3f\r\n",number,a);                 
+                myservo = number*0.1;
+          
+        }      
+        wait(0.2); 
+    }
+}
+            
+            
                 
                 
                 
\ No newline at end of file