1 /*
2  * Copyright 2016 The Android Open Source Project
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16 
17 #define LOG_TAG "a2dp_vendor_aptx_hd_encoder"
18 
19 #include "a2dp_vendor_aptx_hd_encoder.h"
20 
21 #include <dlfcn.h>
22 #include <inttypes.h>
23 #include <stdio.h>
24 #include <string.h>
25 
26 #include "a2dp_vendor.h"
27 #include "a2dp_vendor_aptx_hd.h"
28 #include "bt_common.h"
29 #include "common/time_util.h"
30 #include "osi/include/log.h"
31 #include "osi/include/osi.h"
32 
33 //
34 // Encoder for aptX-HD Source Codec
35 //
36 
37 //
38 // The aptX-HD encoder shared library, and the functions to use
39 //
40 static const char* APTX_HD_ENCODER_LIB_NAME = "libaptXHD_encoder.so";
41 static void* aptx_hd_encoder_lib_handle = NULL;
42 
43 static const char* APTX_HD_ENCODER_INIT_NAME = "aptxhdbtenc_init";
44 typedef int (*tAPTX_HD_ENCODER_INIT)(void* state, short endian);
45 
46 static const char* APTX_HD_ENCODER_ENCODE_STEREO_NAME =
47     "aptxhdbtenc_encodestereo";
48 typedef int (*tAPTX_HD_ENCODER_ENCODE_STEREO)(void* state, void* pcmL,
49                                               void* pcmR, void* buffer);
50 
51 static const char* APTX_HD_ENCODER_SIZEOF_PARAMS_NAME = "SizeofAptxhdbtenc";
52 typedef int (*tAPTX_HD_ENCODER_SIZEOF_PARAMS)(void);
53 
54 static tAPTX_HD_ENCODER_INIT aptx_hd_encoder_init_func;
55 static tAPTX_HD_ENCODER_ENCODE_STEREO aptx_hd_encoder_encode_stereo_func;
56 static tAPTX_HD_ENCODER_SIZEOF_PARAMS aptx_hd_encoder_sizeof_params_func;
57 
58 // offset
59 #if (BTA_AV_CO_CP_SCMS_T == TRUE)
60 #define A2DP_APTX_HD_OFFSET (AVDT_MEDIA_OFFSET + 1)
61 #else
62 #define A2DP_APTX_HD_OFFSET AVDT_MEDIA_OFFSET
63 #endif
64 
65 #define A2DP_APTX_HD_MAX_PCM_BYTES_PER_READ 4096
66 
67 typedef struct {
68   uint64_t sleep_time_ns;
69   uint32_t pcm_reads;
70   uint32_t pcm_bytes_per_read;
71   uint32_t aptx_hd_bytes;
72   uint32_t frame_size_counter;
73 } tAPTX_HD_FRAMING_PARAMS;
74 
75 typedef struct {
76   uint64_t session_start_us;
77 
78   size_t media_read_total_expected_packets;
79   size_t media_read_total_expected_reads_count;
80   size_t media_read_total_expected_read_bytes;
81 
82   size_t media_read_total_dropped_packets;
83   size_t media_read_total_actual_reads_count;
84   size_t media_read_total_actual_read_bytes;
85 } a2dp_aptx_hd_encoder_stats_t;
86 
87 typedef struct {
88   a2dp_source_read_callback_t read_callback;
89   a2dp_source_enqueue_callback_t enqueue_callback;
90 
91   bool use_SCMS_T;
92   bool is_peer_edr;          // True if the peer device supports EDR
93   bool peer_supports_3mbps;  // True if the peer device supports 3Mbps EDR
94   uint16_t peer_mtu;         // MTU of the A2DP peer
95   uint32_t timestamp;        // Timestamp for the A2DP frames
96 
97   tA2DP_FEEDING_PARAMS feeding_params;
98   tAPTX_HD_FRAMING_PARAMS framing_params;
99   void* aptx_hd_encoder_state;
100   a2dp_aptx_hd_encoder_stats_t stats;
101 } tA2DP_APTX_HD_ENCODER_CB;
102 
103 static tA2DP_APTX_HD_ENCODER_CB a2dp_aptx_hd_encoder_cb;
104 
105 static void a2dp_vendor_aptx_hd_encoder_update(
106     uint16_t peer_mtu, A2dpCodecConfig* a2dp_codec_config,
107     bool* p_restart_input, bool* p_restart_output, bool* p_config_updated);
108 static void aptx_hd_init_framing_params(
109     tAPTX_HD_FRAMING_PARAMS* framing_params);
110 static void aptx_hd_update_framing_params(
111     tAPTX_HD_FRAMING_PARAMS* framing_params);
112 static size_t aptx_hd_encode_24bit(tAPTX_HD_FRAMING_PARAMS* framing_params,
113                                    size_t* data_out_index, uint32_t* data32_in,
114                                    uint8_t* data_out);
115 
A2DP_VendorLoadEncoderAptxHd(void)116 bool A2DP_VendorLoadEncoderAptxHd(void) {
117   if (aptx_hd_encoder_lib_handle != NULL) return true;  // Already loaded
118 
119   // Open the encoder library
120   aptx_hd_encoder_lib_handle = dlopen(APTX_HD_ENCODER_LIB_NAME, RTLD_NOW);
121   if (aptx_hd_encoder_lib_handle == NULL) {
122     LOG_ERROR("%s: cannot open aptX-HD encoder library %s: %s", __func__,
123               APTX_HD_ENCODER_LIB_NAME, dlerror());
124     return false;
125   }
126 
127   aptx_hd_encoder_init_func = (tAPTX_HD_ENCODER_INIT)dlsym(
128       aptx_hd_encoder_lib_handle, APTX_HD_ENCODER_INIT_NAME);
129   if (aptx_hd_encoder_init_func == NULL) {
130     LOG_ERROR("%s: cannot find function '%s' in the encoder library: %s",
131               __func__, APTX_HD_ENCODER_INIT_NAME, dlerror());
132     A2DP_VendorUnloadEncoderAptxHd();
133     return false;
134   }
135 
136   aptx_hd_encoder_encode_stereo_func = (tAPTX_HD_ENCODER_ENCODE_STEREO)dlsym(
137       aptx_hd_encoder_lib_handle, APTX_HD_ENCODER_ENCODE_STEREO_NAME);
138   if (aptx_hd_encoder_encode_stereo_func == NULL) {
139     LOG_ERROR("%s: cannot find function '%s' in the encoder library: %s",
140               __func__, APTX_HD_ENCODER_ENCODE_STEREO_NAME, dlerror());
141     A2DP_VendorUnloadEncoderAptxHd();
142     return false;
143   }
144 
145   aptx_hd_encoder_sizeof_params_func = (tAPTX_HD_ENCODER_SIZEOF_PARAMS)dlsym(
146       aptx_hd_encoder_lib_handle, APTX_HD_ENCODER_SIZEOF_PARAMS_NAME);
147   if (aptx_hd_encoder_sizeof_params_func == NULL) {
148     LOG_ERROR("%s: cannot find function '%s' in the encoder library: %s",
149               __func__, APTX_HD_ENCODER_SIZEOF_PARAMS_NAME, dlerror());
150     A2DP_VendorUnloadEncoderAptxHd();
151     return false;
152   }
153 
154   return true;
155 }
156 
A2DP_VendorUnloadEncoderAptxHd(void)157 void A2DP_VendorUnloadEncoderAptxHd(void) {
158   aptx_hd_encoder_init_func = NULL;
159   aptx_hd_encoder_encode_stereo_func = NULL;
160   aptx_hd_encoder_sizeof_params_func = NULL;
161 
162   if (aptx_hd_encoder_lib_handle != NULL) {
163     dlclose(aptx_hd_encoder_lib_handle);
164     aptx_hd_encoder_lib_handle = NULL;
165   }
166 }
167 
a2dp_vendor_aptx_hd_encoder_init(const tA2DP_ENCODER_INIT_PEER_PARAMS * p_peer_params,A2dpCodecConfig * a2dp_codec_config,a2dp_source_read_callback_t read_callback,a2dp_source_enqueue_callback_t enqueue_callback)168 void a2dp_vendor_aptx_hd_encoder_init(
169     const tA2DP_ENCODER_INIT_PEER_PARAMS* p_peer_params,
170     A2dpCodecConfig* a2dp_codec_config,
171     a2dp_source_read_callback_t read_callback,
172     a2dp_source_enqueue_callback_t enqueue_callback) {
173   memset(&a2dp_aptx_hd_encoder_cb, 0, sizeof(a2dp_aptx_hd_encoder_cb));
174 
175   a2dp_aptx_hd_encoder_cb.stats.session_start_us =
176       bluetooth::common::time_get_os_boottime_us();
177 
178   a2dp_aptx_hd_encoder_cb.read_callback = read_callback;
179   a2dp_aptx_hd_encoder_cb.enqueue_callback = enqueue_callback;
180   a2dp_aptx_hd_encoder_cb.is_peer_edr = p_peer_params->is_peer_edr;
181   a2dp_aptx_hd_encoder_cb.peer_supports_3mbps =
182       p_peer_params->peer_supports_3mbps;
183   a2dp_aptx_hd_encoder_cb.peer_mtu = p_peer_params->peer_mtu;
184   a2dp_aptx_hd_encoder_cb.timestamp = 0;
185 
186   /* aptX-HD encoder config */
187   a2dp_aptx_hd_encoder_cb.use_SCMS_T = false;  // TODO: should be a parameter
188 #if (BTA_AV_CO_CP_SCMS_T == TRUE)
189   a2dp_aptx_hd_encoder_cb.use_SCMS_T = true;
190 #endif
191 
192   a2dp_aptx_hd_encoder_cb.aptx_hd_encoder_state =
193       osi_malloc(aptx_hd_encoder_sizeof_params_func());
194   if (a2dp_aptx_hd_encoder_cb.aptx_hd_encoder_state != NULL) {
195     aptx_hd_encoder_init_func(a2dp_aptx_hd_encoder_cb.aptx_hd_encoder_state, 0);
196   } else {
197     LOG_ERROR("%s: Cannot allocate aptX-HD encoder state", __func__);
198     // TODO: Return an error?
199   }
200 
201   // NOTE: Ignore the restart_input / restart_output flags - this initization
202   // happens when the connection is (re)started.
203   bool restart_input = false;
204   bool restart_output = false;
205   bool config_updated = false;
206   a2dp_vendor_aptx_hd_encoder_update(a2dp_aptx_hd_encoder_cb.peer_mtu,
207                                      a2dp_codec_config, &restart_input,
208                                      &restart_output, &config_updated);
209 }
210 
updateEncoderUserConfig(const tA2DP_ENCODER_INIT_PEER_PARAMS * p_peer_params,bool * p_restart_input,bool * p_restart_output,bool * p_config_updated)211 bool A2dpCodecConfigAptxHd::updateEncoderUserConfig(
212     const tA2DP_ENCODER_INIT_PEER_PARAMS* p_peer_params, bool* p_restart_input,
213     bool* p_restart_output, bool* p_config_updated) {
214   a2dp_aptx_hd_encoder_cb.is_peer_edr = p_peer_params->is_peer_edr;
215   a2dp_aptx_hd_encoder_cb.peer_supports_3mbps =
216       p_peer_params->peer_supports_3mbps;
217   a2dp_aptx_hd_encoder_cb.peer_mtu = p_peer_params->peer_mtu;
218   a2dp_aptx_hd_encoder_cb.timestamp = 0;
219 
220   if (a2dp_aptx_hd_encoder_cb.peer_mtu == 0) {
221     LOG_ERROR(
222         "%s: Cannot update the codec encoder for %s: "
223         "invalid peer MTU",
224         __func__, name().c_str());
225     return false;
226   }
227 
228   a2dp_vendor_aptx_hd_encoder_update(a2dp_aptx_hd_encoder_cb.peer_mtu, this,
229                                      p_restart_input, p_restart_output,
230                                      p_config_updated);
231   return true;
232 }
233 
234 // Update the A2DP aptX-HD encoder.
235 // |peer_mtu| is the peer MTU.
236 // |a2dp_codec_config| is the A2DP codec to use for the update.
a2dp_vendor_aptx_hd_encoder_update(uint16_t peer_mtu,A2dpCodecConfig * a2dp_codec_config,bool * p_restart_input,bool * p_restart_output,bool * p_config_updated)237 static void a2dp_vendor_aptx_hd_encoder_update(
238     uint16_t peer_mtu, A2dpCodecConfig* a2dp_codec_config,
239     bool* p_restart_input, bool* p_restart_output, bool* p_config_updated) {
240   uint8_t codec_info[AVDT_CODEC_SIZE];
241 
242   *p_restart_input = false;
243   *p_restart_output = false;
244   *p_config_updated = false;
245   if (!a2dp_codec_config->copyOutOtaCodecConfig(codec_info)) {
246     LOG_ERROR(
247         "%s: Cannot update the codec encoder for %s: "
248         "invalid codec config",
249         __func__, a2dp_codec_config->name().c_str());
250     return;
251   }
252   const uint8_t* p_codec_info = codec_info;
253 
254   // The feeding parameters
255   tA2DP_FEEDING_PARAMS* p_feeding_params =
256       &a2dp_aptx_hd_encoder_cb.feeding_params;
257   p_feeding_params->sample_rate =
258       A2DP_VendorGetTrackSampleRateAptxHd(p_codec_info);
259   p_feeding_params->bits_per_sample =
260       a2dp_codec_config->getAudioBitsPerSample();
261   p_feeding_params->channel_count =
262       A2DP_VendorGetTrackChannelCountAptxHd(p_codec_info);
263   LOG_DEBUG("%s: sample_rate=%u bits_per_sample=%u channel_count=%u", __func__,
264             p_feeding_params->sample_rate, p_feeding_params->bits_per_sample,
265             p_feeding_params->channel_count);
266   a2dp_vendor_aptx_hd_feeding_reset();
267 }
268 
a2dp_vendor_aptx_hd_encoder_cleanup(void)269 void a2dp_vendor_aptx_hd_encoder_cleanup(void) {
270   osi_free(a2dp_aptx_hd_encoder_cb.aptx_hd_encoder_state);
271   memset(&a2dp_aptx_hd_encoder_cb, 0, sizeof(a2dp_aptx_hd_encoder_cb));
272 }
273 
274 //
275 // Initialize the framing parameters, and set those that don't change
276 // while streaming (e.g., 'sleep_time_ns').
277 //
aptx_hd_init_framing_params(tAPTX_HD_FRAMING_PARAMS * framing_params)278 static void aptx_hd_init_framing_params(
279     tAPTX_HD_FRAMING_PARAMS* framing_params) {
280   framing_params->sleep_time_ns = 0;
281   framing_params->pcm_reads = 0;
282   framing_params->pcm_bytes_per_read = 0;
283   framing_params->aptx_hd_bytes = 0;
284   framing_params->frame_size_counter = 0;
285 
286   framing_params->sleep_time_ns = 9000000;
287 
288   LOG_DEBUG("%s: sleep_time_ns = %" PRIu64, __func__,
289             framing_params->sleep_time_ns);
290 }
291 
292 //
293 // Set frame size and transmission interval needed to stream the required
294 // sample rate using 2-DH5 packets for aptX and 2-DH3 packets for aptX-LL.
295 // With SCMS-T enabled we need to reserve room for extra headers added later.
296 // Packets are always sent at equals time intervals but to achieve the
297 // required sample rate, the frame size needs to change on occasion.
298 //
299 // Also need to specify how many of the required PCM samples are read at a
300 // time:
301 //     aptx_bytes = pcm_reads * pcm_bytes_per_read / 4
302 // and
303 //     number of aptX samples produced = pcm_bytes_per_read / 16
304 //
aptx_hd_update_framing_params(tAPTX_HD_FRAMING_PARAMS * framing_params)305 static void aptx_hd_update_framing_params(
306     tAPTX_HD_FRAMING_PARAMS* framing_params) {
307   if (a2dp_aptx_hd_encoder_cb.feeding_params.sample_rate == 48000) {
308     framing_params->aptx_hd_bytes = 648;
309     framing_params->pcm_bytes_per_read = 24;
310     framing_params->pcm_reads = 108;
311   } else {
312     // Assume the sample rate is 44100
313 
314     //
315     // Total of 80 iterations:
316     // - Iteration 80: packet size 648, with 108 reads of 24 PCM bytes
317     // - Iterations 20, 40, 60: packet size 612, with 102 reads of 24 PCM bytes
318     // - All other iterations: packet size 594, with 99 reads of 24 PCM bytes
319     //
320     if (framing_params->frame_size_counter + 1 == 80) {
321       framing_params->aptx_hd_bytes = 648;
322       framing_params->pcm_bytes_per_read = 24;
323       framing_params->pcm_reads = 108;
324     } else if (((framing_params->frame_size_counter + 1) % 20) == 0) {
325       framing_params->aptx_hd_bytes = 612;
326       framing_params->pcm_bytes_per_read = 24;
327       framing_params->pcm_reads = 102;
328     } else {
329       framing_params->aptx_hd_bytes = 594;
330       framing_params->pcm_bytes_per_read = 24;
331       framing_params->pcm_reads = 99;
332     }
333     framing_params->frame_size_counter++;
334     if (framing_params->frame_size_counter == 80)
335       framing_params->frame_size_counter = 0;
336   }
337 
338   LOG_VERBOSE("%s: sleep_time_ns = %" PRIu64
339               " aptx_hd_bytes = %u "
340               "pcm_bytes_per_read = %u pcm_reads = %u frame_size_counter = %u",
341               __func__, framing_params->sleep_time_ns,
342               framing_params->aptx_hd_bytes, framing_params->pcm_bytes_per_read,
343               framing_params->pcm_reads, framing_params->frame_size_counter);
344 }
345 
a2dp_vendor_aptx_hd_feeding_reset(void)346 void a2dp_vendor_aptx_hd_feeding_reset(void) {
347   aptx_hd_init_framing_params(&a2dp_aptx_hd_encoder_cb.framing_params);
348 }
349 
a2dp_vendor_aptx_hd_feeding_flush(void)350 void a2dp_vendor_aptx_hd_feeding_flush(void) {
351   aptx_hd_init_framing_params(&a2dp_aptx_hd_encoder_cb.framing_params);
352 }
353 
a2dp_vendor_aptx_hd_get_encoder_interval_ms(void)354 uint64_t a2dp_vendor_aptx_hd_get_encoder_interval_ms(void) {
355   return a2dp_aptx_hd_encoder_cb.framing_params.sleep_time_ns / (1000 * 1000);
356 }
357 
a2dp_vendor_aptx_hd_send_frames(uint64_t timestamp_us)358 void a2dp_vendor_aptx_hd_send_frames(uint64_t timestamp_us) {
359   tAPTX_HD_FRAMING_PARAMS* framing_params =
360       &a2dp_aptx_hd_encoder_cb.framing_params;
361 
362   // Prepare the packet to send
363   BT_HDR* p_buf = (BT_HDR*)osi_malloc(BT_DEFAULT_BUFFER_SIZE);
364   p_buf->offset = A2DP_APTX_HD_OFFSET;
365   p_buf->len = 0;
366   p_buf->layer_specific = 0;
367 
368   uint8_t* encoded_ptr = (uint8_t*)(p_buf + 1);
369   encoded_ptr += p_buf->offset;
370 
371   aptx_hd_update_framing_params(framing_params);
372 
373   //
374   // Read the PCM data and encode it
375   //
376   uint32_t
377       read_buffer32[A2DP_APTX_HD_MAX_PCM_BYTES_PER_READ / sizeof(uint32_t)];
378   uint32_t expected_read_bytes =
379       framing_params->pcm_reads * framing_params->pcm_bytes_per_read;
380   size_t encoded_ptr_index = 0;
381   size_t pcm_bytes_encoded = 0;
382   uint32_t bytes_read = 0;
383 
384   a2dp_aptx_hd_encoder_cb.stats.media_read_total_expected_packets++;
385   a2dp_aptx_hd_encoder_cb.stats.media_read_total_expected_reads_count++;
386   a2dp_aptx_hd_encoder_cb.stats.media_read_total_expected_read_bytes +=
387       expected_read_bytes;
388 
389   LOG_VERBOSE("%s: PCM read of size %u", __func__, expected_read_bytes);
390   bytes_read = a2dp_aptx_hd_encoder_cb.read_callback((uint8_t*)read_buffer32,
391                                                      expected_read_bytes);
392   a2dp_aptx_hd_encoder_cb.stats.media_read_total_actual_read_bytes +=
393       bytes_read;
394   if (bytes_read < expected_read_bytes) {
395     LOG_WARN("%s: underflow at PCM reading: read %u bytes instead of %u",
396              __func__, bytes_read, expected_read_bytes);
397     a2dp_aptx_hd_encoder_cb.stats.media_read_total_dropped_packets++;
398     osi_free(p_buf);
399     return;
400   }
401   a2dp_aptx_hd_encoder_cb.stats.media_read_total_actual_reads_count++;
402 
403   for (uint32_t reads = 0, offset = 0; reads < framing_params->pcm_reads;
404        reads++, offset +=
405                 framing_params->pcm_bytes_per_read / sizeof(uint32_t)) {
406     pcm_bytes_encoded +=
407         aptx_hd_encode_24bit(framing_params, &encoded_ptr_index,
408                              read_buffer32 + offset, encoded_ptr);
409   }
410 
411   // Compute the number of encoded bytes
412   const int COMPRESSION_RATIO = 4;
413   size_t encoded_bytes = pcm_bytes_encoded / COMPRESSION_RATIO;
414   p_buf->len += encoded_bytes;
415   LOG_VERBOSE("%s: encoded %zu PCM bytes to %zu", __func__, pcm_bytes_encoded,
416               encoded_bytes);
417 
418   // Update the RTP timestamp
419   *((uint32_t*)(p_buf + 1)) = a2dp_aptx_hd_encoder_cb.timestamp;
420   const uint8_t BYTES_PER_FRAME = 3;
421   uint32_t rtp_timestamp =
422       (pcm_bytes_encoded /
423        a2dp_aptx_hd_encoder_cb.feeding_params.channel_count) /
424       BYTES_PER_FRAME;
425   a2dp_aptx_hd_encoder_cb.timestamp += rtp_timestamp;
426 
427   if (p_buf->len > 0) {
428     a2dp_aptx_hd_encoder_cb.enqueue_callback(p_buf, 1, bytes_read);
429   } else {
430     a2dp_aptx_hd_encoder_cb.stats.media_read_total_dropped_packets++;
431     osi_free(p_buf);
432   }
433 }
434 
aptx_hd_encode_24bit(tAPTX_HD_FRAMING_PARAMS * framing_params,size_t * data_out_index,uint32_t * data32_in,uint8_t * data_out)435 static size_t aptx_hd_encode_24bit(tAPTX_HD_FRAMING_PARAMS* framing_params,
436                                    size_t* data_out_index, uint32_t* data32_in,
437                                    uint8_t* data_out) {
438   size_t pcm_bytes_encoded = 0;
439   const uint8_t* p = (const uint8_t*)(data32_in);
440 
441   for (size_t aptx_hd_samples = 0;
442        aptx_hd_samples < framing_params->pcm_bytes_per_read / 24;
443        aptx_hd_samples++) {
444     uint32_t pcmL[4];
445     uint32_t pcmR[4];
446     uint32_t encoded_sample[2];
447 
448     // Expand from AUDIO_FORMAT_PCM_24_BIT_PACKED data (3 bytes per sample)
449     // into AUDIO_FORMAT_PCM_8_24_BIT (4 bytes per sample).
450     for (size_t i = 0; i < 4; i++) {
451       pcmL[i] = ((p[0] << 0) | (p[1] << 8) | (((int8_t)p[2]) << 16));
452       p += 3;
453       pcmR[i] = ((p[0] << 0) | (p[1] << 8) | (((int8_t)p[2]) << 16));
454       p += 3;
455     }
456 
457     aptx_hd_encoder_encode_stereo_func(
458         a2dp_aptx_hd_encoder_cb.aptx_hd_encoder_state, &pcmL, &pcmR,
459         &encoded_sample);
460 
461     uint8_t* encoded_ptr = (uint8_t*)&encoded_sample[0];
462     data_out[*data_out_index + 0] = *(encoded_ptr + 2);
463     data_out[*data_out_index + 1] = *(encoded_ptr + 1);
464     data_out[*data_out_index + 2] = *(encoded_ptr + 0);
465     data_out[*data_out_index + 3] = *(encoded_ptr + 6);
466     data_out[*data_out_index + 4] = *(encoded_ptr + 5);
467     data_out[*data_out_index + 5] = *(encoded_ptr + 4);
468 
469     pcm_bytes_encoded += 24;
470     *data_out_index += 6;
471   }
472 
473   return pcm_bytes_encoded;
474 }
475 
encoderIntervalMs() const476 uint64_t A2dpCodecConfigAptxHd::encoderIntervalMs() const {
477   return a2dp_vendor_aptx_hd_get_encoder_interval_ms();
478 }
479 
getEffectiveMtu() const480 int A2dpCodecConfigAptxHd::getEffectiveMtu() const {
481   return a2dp_aptx_hd_encoder_cb.peer_mtu;
482 }
483 
debug_codec_dump(int fd)484 void A2dpCodecConfigAptxHd::debug_codec_dump(int fd) {
485   a2dp_aptx_hd_encoder_stats_t* stats = &a2dp_aptx_hd_encoder_cb.stats;
486 
487   A2dpCodecConfig::debug_codec_dump(fd);
488 
489   dprintf(fd,
490           "  Packet counts (expected/dropped)                        : %zu / "
491           "%zu\n",
492           stats->media_read_total_expected_packets,
493           stats->media_read_total_dropped_packets);
494 
495   dprintf(fd,
496           "  PCM read counts (expected/actual)                       : %zu / "
497           "%zu\n",
498           stats->media_read_total_expected_reads_count,
499           stats->media_read_total_actual_reads_count);
500 
501   dprintf(fd,
502           "  PCM read bytes (expected/actual)                        : %zu / "
503           "%zu\n",
504           stats->media_read_total_expected_read_bytes,
505           stats->media_read_total_actual_read_bytes);
506 }
507