ソースを参照

fix hfp_ag demo audio not sine_v4.4

jincheng 4 年 前
コミット
ea4f069b45

+ 9 - 9
examples/bluetooth/bluedroid/classic_bt/hfp_ag/main/bt_app_hf.c

@@ -105,7 +105,8 @@ const char *c_codec_mode_str[] = {
 };
 
 #if CONFIG_BT_HFP_AUDIO_DATA_PATH_HCI
-#define TABLE_SIZE   100
+#define TABLE_SIZE         100
+#define TABLE_SIZE_BYTE    200
 // Produce a sine audio
 static const int16_t sine_int16[TABLE_SIZE] = {
      0,    2057,    4107,    6140,    8149,   10126,   12062,   13952,   15786,   17557,
@@ -179,14 +180,13 @@ static void bt_app_hf_incoming_cb(const uint8_t *buf, uint32_t sz)
 
 static uint32_t bt_app_hf_create_audio_data(uint8_t *p_buf, uint32_t sz)
 {
-    static int sine_phase = 0;
-
-    for (int i = 0; i * 2 + 1 < sz; i++) {
-        p_buf[i * 2]     = sine_int16[sine_phase];
-        p_buf[i * 2 + 1] = sine_int16[sine_phase];
-        ++sine_phase;
-        if (sine_phase >= TABLE_SIZE) {
-            sine_phase -= TABLE_SIZE;
+    static int index = 0;
+    uint8_t *data = (uint8_t *)sine_int16;
+
+    for (uint32_t i = 0; i < sz; i++) {
+        p_buf[i] = data[index++];
+        if (index >= TABLE_SIZE_BYTE) {
+            index -= TABLE_SIZE_BYTE;
         }
     }
     return sz;