From 4a96141edb35ad5d0ef5d71d4b2400f03aa51262 Mon Sep 17 00:00:00 2001
From: Matthias Ringwald <matthias@ringwald.ch>
Date: Thu, 16 Jun 2016 11:43:40 +0200
Subject: [PATCH] examples/sco: show send/received packets

---
 example/sco_demo_util.c | 25 +++++++++++++++++--------
 1 file changed, 17 insertions(+), 8 deletions(-)

diff --git a/example/sco_demo_util.c b/example/sco_demo_util.c
index fe8968d82..0ff514e11 100644
--- a/example/sco_demo_util.c
+++ b/example/sco_demo_util.c
@@ -85,7 +85,10 @@ static const uint8_t sine[] = {
 #endif
 
 static int phase;
+static int count_sent = 0;
+static int count_received = 0;
 
+#if SCO_DEMO_MODE == SCO_DEMO_MODE_SINE
 #ifdef SCO_WAV_FILENAME
 
 static FILE * wav_file;
@@ -146,7 +149,7 @@ static void write_wav_data_uint8(FILE * file, unsigned long num_samples, uint8_t
 }
 
 #endif
-
+#endif
 
 void sco_demo_init(void){
 
@@ -165,6 +168,7 @@ void sco_demo_init(void){
 	printf("SCO Demo: Sending counter value, hexdump received data.\n");
 #endif
 
+#if SCO_DEMO_MODE == SCO_DEMO_MODE_SINE
 #ifdef SCO_WAV_FILENAME
     wav_file = wav_init(SCO_WAV_FILENAME);
     const int sample_rate = 8000;
@@ -174,6 +178,7 @@ void sco_demo_init(void){
     write_wav_header(wav_file, sample_rate, num_channels, num_samples, bytes_per_sample);
     num_samples_to_write = num_samples;
 #endif
+#endif
 
 #ifdef USE_PORTAUDIO
     int err;
@@ -213,6 +218,9 @@ void sco_demo_init(void){
 #endif
 }
 
+static void sco_report(void){
+    printf("SCO: sent %u, received %u\n", count_sent, count_received);
+}
 
 void sco_demo_send(hci_con_handle_t sco_handle){
 
@@ -252,9 +260,8 @@ void sco_demo_send(hci_con_handle_t sco_handle){
     // request another send event
     hci_request_sco_can_send_now_event();
 
-    static int count = 0;
-    count++;
-    if ((count % SCO_REPORT_PERIOD) == 0) printf("SCO: sent %u\n", count);
+    count_sent++;
+    if ((count_sent % SCO_REPORT_PERIOD) == 0) sco_report();
 }
 
 /**
@@ -265,6 +272,11 @@ void sco_demo_receive(uint8_t * packet, uint16_t size){
 
     int dump_data = 1;
 
+    count_received++;
+    // if ((count_received % SCO_REPORT_PERIOD) == 0) sco_report();
+
+
+#if SCO_DEMO_MODE == SCO_DEMO_MODE_SINE
 #ifdef SCO_WAV_FILENAME
     if (num_samples_to_write){
         const int num_samples = size - 3;
@@ -282,6 +294,7 @@ void sco_demo_receive(uint8_t * packet, uint16_t size){
         }
         dump_data = 0;
     }
+#endif
 #endif
 
     if (packet[1] & 0xf0){
@@ -315,8 +328,4 @@ void sco_demo_receive(uint8_t * packet, uint16_t size){
         printf_hexdump(&packet[3], size-3);
 #endif
     }
-
-    static int count = 0;
-    count++;
-    if ((count % SCO_REPORT_PERIOD) == 0) printf("SCO: received %u\n", count);
 }