Add A2D signaling

diff --git a/yue/main.cpp b/yue/main.cpp
index 0fdb8660bd56340e275e4284919ab19b6408c560..e580188dcce225a1caf375fed709594a5b036c5b 100644 (file)
--- a/yue/main.cpp
+++ b/yue/main.cpp
@@ -15,9 +15,9 @@
          (x) > (max) ? (max) : (x))\r
 \r
 #define MMA8451_I2C_ADDRESS (0x1d<<1)   // acc sensor address\r
-#define TIME_ACCURACY     0.01\r
+#define TIME_ACCURACY     0.001\r
 \r
-#define ACC_SNS_DEFAULT   0.1   // default collecting interval in seconds\r
+#define ACC_SNS_DEFAULT   0.01 // default collecting interval in seconds\r
 #define MAG_SNS_DEFAULT   0.1\r
 #define LGT_SNS_DEFAULT   0.1\r
 #define TCH_SNS_DEFAULT   0.1\r
@@ -89,6 +89,8 @@ TSISensor  tchSensor;
 AnalogIn   lgtSensor(PTE22);\r
 AnalogIn   a2dSensor(A0);\r
 \r
+AnalogOut  a2dOutput(PTE30);\r
+\r
 DigitalOut led1(LED1);\r
 DigitalOut led2(LED2);\r
 \r
@@ -104,11 +106,11 @@ float lgtTmr = LGT_SNS_DEFAULT;
 float a2dTmr = A2D_SNS_DEFAULT;\r
 float ledTmr = LED_OUT_DEFAULT;\r
 \r
-bool accEnable = true;\r
+bool accEnable = false;\r
 bool magEnable = false;\r
 bool lgtEnable = false;\r
 bool tchEnable = false;\r
-bool a2dEnable = false;\r
+bool a2dEnable = true;\r
 bool ledEnable = true;\r
 \r
 bool useStr = false;\r
@@ -218,6 +220,9 @@ void clock1_interrupt(void){
     a2dCnt++;\r
     ledCnt++;\r
 \r
+    // Write A2D output sine wave\r
+    a2dOutput.write(sin(a2dCnt * TIME_ACCURACY * (2*PI) * 0.1));\r
+\r
     // Send data through Serial\r
     if (accEnable && (accCnt<0 || accCnt>=accTmr/TIME_ACCURACY)){\r
         sendAccInfo();\r
@@ -362,7 +367,7 @@ void sendTchInfo(void){
 \r
 void sendA2dInfo(void){\r
     float a2dData[6];\r
-    a2dData[0] = 0;\r
+    a2dData[0] = a2dSensor.read();\r
     a2dData[1] = 0;\r
     a2dData[2] = 0;\r
     a2dData[3] = 0;\r