存档

apps/earphone/xtell_Sensor/send_data.c

@@ -137,11 +137,13 @@ void ble_send_data(signed short *acc_gyro_input, float *Angle_output){
     send_data_to_ble_client(&buffer,len);
 }
 
+
 // 从环形缓冲区读取数据并发送
 void send_sensor_data_task(void) {
     // printf("xtell_ble_send\n");
 }
 
+#ifdef XTELL_TEST
 void test(){
     signed short acc_data_buf[3] = {0};
     signed short gyr_data_buf[3] = {0};
@@ -162,15 +164,9 @@ void test(){
     static int count = 0;
     if(count >=10){ 
         count = 0;
-        #ifdef XTELL_TEST
-        xlog("BLE_send_data_t:%d\n",sizeof(BLE_send_data_t));
-        xlog("ACC_X:%d, ACC_Y:%d, ACC_Z:%d, GYR_X:%.d, GYR_Y:%d, GYR_Z:%d", 
-            acc_data_buf[0],acc_data_buf[1],acc_data_buf[2],gyr_data_buf[0],gyr_data_buf[1],gyr_data_buf[2]
-            );
-        printf("State: %d, Speed: %d cm/s, Distance: %d cm\n",
-            BLE_send_data.skiing_state,
-            BLE_send_data.speed_cms,
-            BLE_send_data.distance_cm);
+        
+        char* division = "==========\n";
+        send_data_to_ble_client(division,strlen(division));
 
         char log_buffer[100]; // 100个字符应该足够了
 
@@ -178,18 +174,61 @@ void test(){
         int num_chars_written = snprintf(
             log_buffer,                      // 目标缓冲区
             sizeof(log_buffer),              // 目标缓冲区的最大容量
-            "State: %d, Speed: %d cm/s, Distance: %d cm\n", // 格式化字符串
+            "s %d, %dcm/s, %dcm\n", // 格式化字符串
             BLE_send_data.skiing_state,      // 第一个 %d 的参数
             BLE_send_data.speed_cms,         // 第二个 %d 的参数
             BLE_send_data.distance_cm        // 第三个 %d 的参数
         );
         send_data_to_ble_client(&log_buffer,strlen(log_buffer));
-        // xlog("Pitch:%.2f, Roll:%.2f, Yaw:%.2f\n",
-            // Angle_output[0],Angle_output[1],Angle_output[2]
-            // );
-        #else
-        send_data_to_ble_client(&data,sizeof(BLE_send_data_t)+4);
-        #endif
+
+        extern BLE_KS_send_data_t KS_data;
+        memset(&log_buffer, 0, 100);
+        num_chars_written = snprintf(
+            log_buffer,                      
+            sizeof(log_buffer),              
+            "Acc:%d, %d, %d\n", 
+            KS_data.acc_KS[0],KS_data.acc_KS[1],KS_data.acc_KS[2]       
+        );  // cm/s^2      
+        send_data_to_ble_client(&log_buffer,strlen(log_buffer));
+
+        memset(&log_buffer, 0, 100);
+        num_chars_written = snprintf(
+            log_buffer,                      
+            sizeof(log_buffer),              
+            "Gyr_dps:%d, %d, %d\n", 
+            KS_data.gyr_KS_dps[0],      
+            KS_data.gyr_KS_dps[1],      
+            KS_data.gyr_KS_dps[2]       
+        );
+        send_data_to_ble_client(&log_buffer,strlen(log_buffer));
+
+        memset(&log_buffer, 0, 100);
+        num_chars_written = snprintf(
+            log_buffer,                      
+            sizeof(log_buffer),              
+            "angle: %d, %d, %d\n", 
+            KS_data.angle_KS[0],      
+            KS_data.angle_KS[1],      
+            KS_data.angle_KS[2]       
+        );
+        send_data_to_ble_client(&log_buffer,strlen(log_buffer));
+
+        extern debug_t debug1;
+        extern debug_t debug2;
+        memset(&log_buffer, 0, 100);
+        num_chars_written = snprintf(
+            log_buffer,                      
+            sizeof(log_buffer),              
+            "debug:%.2f,%.2f,%.2f(%.2f),%.2f\n", 
+            debug1.acc_variance, 
+            debug1.gyr_variance, 
+            debug1.acc_magnitude,
+            debug2.acc_magnitude,   //滤波后的加速度
+            debug1.gyr_magnitude  
+        );
+        send_data_to_ble_client(&log_buffer,strlen(log_buffer));
+        
+       
     }
     count++;
 
@@ -197,6 +236,37 @@ void test(){
     memset(&data, 0, 50);
 
 }
+#else
+
+void BLE_send_data(){
+    signed short acc_data_buf[3] = {0};
+    signed short gyr_data_buf[3] = {0};
+    signed short acc_gyro_input[6] = {0};
+    float Angle_output[3] = {0};
+
+    SL_SC7U22_RawData_Read(acc_data_buf,gyr_data_buf);
+
+    BLE_send_data = sensor_processing_task(acc_data_buf, gyr_data_buf);
+    u8 data[50];
+    data[0] = 0xBB;
+    data[1] = 0xBE;
+    data[2] = 0x01;
+    data[3] = sizeof(BLE_send_data_t); //后续包的数据长度
+    // send_data_to_ble_client(&data,sizeof(BLE_send_data_t)+4);
+    memcpy(&data[4], &BLE_send_data, sizeof(BLE_send_data_t));
+
+    static int count = 0;
+    if(count >=10){ 
+        count = 0;
+        send_data_to_ble_client(&data,sizeof(BLE_send_data_t)+4);
+    }
+    count++;
+
+    memset(&BLE_send_data, 0, sizeof(BLE_send_data_t));
+    memset(&data, 0, 50);
+}
+#endif
+
 void gsensor_test(){
 
     sys_timer_del(gsensor_id);