ryo seki / Mbed 2 deprecated ver1_2_2_1

test

Dependencies:   HMC6352 PID mbed

Fork of ver1_2_2 by ryo seki

Diff: ultrasonic.cpp

Revision:
1:89408fff7cc9
Parent:
0:74bf4953c0d1
--- a/ultrasonic.cpp	Sat Mar 09 10:11:06 2013 +0000
+++ b/ultrasonic.cpp	Sun Mar 10 07:31:31 2013 +0000
@@ -6,7 +6,7 @@
 extern Timer timer2;
 extern Serial pc; // tx, rx 
 
-uint16_t ultrasonicVal[ALL_ULTRASONIC] = {0};
+double ultrasonicVal[ALL_ULTRASONIC] = {0};
 
 
 void Ultrasonic()
@@ -36,10 +36,10 @@
             }
         }
         if(flag == 0){
-            ultrasonicVal[i] = timer2.read_us();
+            ultrasonicVal[i] = timer2.read_us() / 1000000.0 / 2.0 * 340.0 * 1000.0; //cm
         }
-        //pc.printf("compass.sample = %f\n",compass.sample() / 1.0);
     }
-    pc.printf("%d\n",ultrasonicVal[0] + ultrasonicVal[2]);
+    //pc.printf("%f\n",ultrasonicVal[0] + ultrasonicVal[2]);
+    //pc.printf("compass.sample = %f\n",compass.sample() / 1.0);
     
 }