mirror of
https://github.com/mudita/MuditaOS.git
synced 2026-04-19 22:49:06 -04:00
e8dd8aacbe
Adapted both codec and HFP profile to be able to work together. Now it's possible to stream 2-way audio via HFP profile, but it has to be integrated properly with EGD-7405
35 lines
1.1 KiB
C++
35 lines
1.1 KiB
C++
// Copyright (c) 2017-2021, Mudita Sp. z.o.o. All rights reserved.
|
|
// For licensing, see https://github.com/mudita/MuditaOS/LICENSE.md
|
|
|
|
#include "ScoUtils.hpp"
|
|
#include <algorithm>
|
|
|
|
extern "C"
|
|
{
|
|
#include <module-bluetooth/lib/btstack/src/btstack_defines.h>
|
|
#include <module-bluetooth/lib/btstack/src/hci.h>
|
|
}
|
|
|
|
namespace bluetooth::sco::utils
|
|
{
|
|
void sendZeros(hci_con_handle_t scoHandle)
|
|
{
|
|
if (scoHandle == HCI_CON_HANDLE_INVALID) {
|
|
return;
|
|
}
|
|
constexpr auto offset = 3;
|
|
constexpr auto lengthPosition = 2;
|
|
const auto scoPacketLength = hci_get_sco_packet_length();
|
|
const auto scoPayloadLength = scoPacketLength - offset;
|
|
|
|
hci_reserve_packet_buffer();
|
|
auto *scoPacket = hci_get_outgoing_packet_buffer();
|
|
std::fill(scoPacket + offset, scoPacket + sizeof(scoPacket), 0);
|
|
|
|
little_endian_store_16(scoPacket, 0, scoHandle);
|
|
scoPacket[lengthPosition] = scoPayloadLength;
|
|
hci_send_sco_packet_buffer(scoPacketLength);
|
|
hci_request_sco_can_send_now_event();
|
|
}
|
|
} // namespace bluetooth::sco::utils
|