From 3d2764b55fe9016c6e71ea56c77ac33d8d59711b Mon Sep 17 00:00:00 2001
From: Milanka Ringwald <mila@ringwald.ch>
Date: Tue, 13 Jul 2021 11:31:53 +0200
Subject: [PATCH] hfp_demo: enable Echo Canceling and Noise reduction

---
 example/hfp_ag_demo.c | 13 +++++++++++++
 example/hfp_hf_demo.c | 13 +++++++++++++
 2 files changed, 26 insertions(+)

diff --git a/example/hfp_ag_demo.c b/example/hfp_ag_demo.c
index cd02fee18..fd831120c 100644
--- a/example/hfp_ag_demo.c
+++ b/example/hfp_ag_demo.c
@@ -446,6 +446,14 @@ static void stdin_process(char cmd){
 }
 #endif
 
+static void report_status(uint8_t status, const char * message){
+    if (status != ERROR_CODE_SUCCESS){
+        printf("%s command failed, status 0x%02x\n", message, status);
+    } else {
+        printf("%s command successful\n", message);
+    }
+}
+
 static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * event, uint16_t event_size){
     UNUSED(channel);
     bd_addr_t addr;
@@ -636,6 +644,10 @@ static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * even
                         break;
                     }
                     printf("\nEnhanced Voice recognition: AG SEND MSG \'%s\'\n\n", msg.text);   
+
+                case HFP_SUBEVENT_ECHO_CANCELING_AND_NOISE_REDUCTION_DEACTIVATE:
+                    status = hfp_subevent_echo_canceling_and_noise_reduction_deactivate_get_status(event);
+                    report_status(status, "Echo Canceling and Noise Reduction Deactivate");
                     break;
 
                 default:
@@ -690,6 +702,7 @@ int btstack_main(int argc, const char * argv[]){
         (1<<HFP_AGSF_IN_BAND_RING_TONE)           |
         (1<<HFP_AGSF_VOICE_RECOGNITION_FUNCTION)  |
         (1<<HFP_AGSF_ENHANCED_VOICE_RECOGNITION_STATUS) |
+        (1<<HFP_AGSF_EC_NR_FUNCTION) |
         (1<<HFP_AGSF_THREE_WAY_CALLING);
     int wide_band_speech = 1;
 
diff --git a/example/hfp_hf_demo.c b/example/hfp_hf_demo.c
index 48b0b6548..d196b627b 100644
--- a/example/hfp_hf_demo.c
+++ b/example/hfp_hf_demo.c
@@ -162,6 +162,14 @@ static void show_usage(void){
     printf("\n");
 }
 
+static void report_status(uint8_t status, const char * message){
+    if (status != ERROR_CODE_SUCCESS){
+        printf("%s command failed, status 0x%02x\n", message, status);
+    } else {
+        printf("%s command successful\n", message);
+    }
+}
+
 static void stdin_process(char c){
     uint8_t status = ERROR_CODE_SUCCESS;
 
@@ -618,6 +626,10 @@ static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * even
                             
                             break;
 
+                        case HFP_SUBEVENT_ECHO_CANCELING_AND_NOISE_REDUCTION_DEACTIVATE:
+                            status = hfp_subevent_echo_canceling_and_noise_reduction_deactivate_get_status(event);
+                            report_status(status, "Echo Canceling and Noise Reduction Deactivate");
+                            break;
                         default:
                             break;
                     }
@@ -666,6 +678,7 @@ int btstack_main(int argc, const char * argv[]){
         (1<<HFP_HFSF_ENHANCED_CALL_STATUS)  |
         (1<<HFP_HFSF_VOICE_RECOGNITION_FUNCTION)  |
         (1<<HFP_HFSF_ENHANCED_VOICE_RECOGNITION_STATUS) |
+        (1<<HFP_HFSF_EC_NR_FUNCTION) |
         (1<<HFP_HFSF_REMOTE_VOLUME_CONTROL);
     int wide_band_speech = 1;