| /****************************************************************************** |
| * |
| * Copyright 2003-2012 Broadcom Corporation |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| * |
| ******************************************************************************/ |
| |
| /****************************************************************************** |
| * |
| * Interface to AVRCP optional commands |
| * |
| ******************************************************************************/ |
| #include <base/logging.h> |
| #include <string.h> |
| |
| #include "avrc_api.h" |
| #include "avrc_int.h" |
| #include "internal_include/bt_target.h" |
| #include "osi/include/allocator.h" |
| #include "stack/include/bt_hdr.h" |
| |
| /****************************************************************************** |
| * |
| * Function avrc_vendor_msg |
| * |
| * Description Compose a VENDOR DEPENDENT command according to p_msg |
| * |
| * Input Parameters: |
| * p_msg: Pointer to VENDOR DEPENDENT message structure. |
| * |
| * Output Parameters: |
| * None. |
| * |
| * Returns pointer to a valid GKI buffer if successful. |
| * NULL if p_msg is NULL. |
| * |
| *****************************************************************************/ |
| static BT_HDR* avrc_vendor_msg(tAVRC_MSG_VENDOR* p_msg) { |
| BT_HDR* p_cmd; |
| uint8_t* p_data; |
| |
| /* |
| An AVRC cmd consists of at least of: |
| - A BT_HDR, plus |
| - AVCT_MSG_OFFSET, plus |
| - 3 bytes for ctype, subunit_type and op_vendor, plus |
| - 3 bytes for company_id |
| */ |
| #define AVRC_MIN_VENDOR_CMD_LEN (sizeof(BT_HDR) + AVCT_MSG_OFFSET + 3 + 3) |
| |
| if (p_msg == nullptr || |
| AVRC_META_CMD_BUF_SIZE < AVRC_MIN_VENDOR_CMD_LEN + p_msg->vendor_len) { |
| return nullptr; |
| } |
| |
| p_cmd = (BT_HDR*)osi_calloc(AVRC_META_CMD_BUF_SIZE); |
| |
| p_cmd->offset = AVCT_MSG_OFFSET; |
| p_data = (uint8_t*)(p_cmd + 1) + p_cmd->offset; |
| *p_data++ = (p_msg->hdr.ctype & AVRC_CTYPE_MASK); |
| *p_data++ = |
| (p_msg->hdr.subunit_type << AVRC_SUBTYPE_SHIFT) | p_msg->hdr.subunit_id; |
| *p_data++ = AVRC_OP_VENDOR; |
| AVRC_CO_ID_TO_BE_STREAM(p_data, p_msg->company_id); |
| if (p_msg->vendor_len && p_msg->p_vendor_data) |
| memcpy(p_data, p_msg->p_vendor_data, p_msg->vendor_len); |
| p_cmd->len = (uint16_t)(p_data + p_msg->vendor_len - (uint8_t*)(p_cmd + 1) - |
| p_cmd->offset); |
| p_cmd->layer_specific = AVCT_DATA_CTRL; |
| |
| return p_cmd; |
| } |
| |
| /****************************************************************************** |
| * |
| * Function AVRC_UnitCmd |
| * |
| * Description Send a UNIT INFO command to the peer device. This |
| * function can only be called for controller role connections. |
| * Any response message from the peer is passed back through |
| * the tAVRC_MSG_CBACK callback function. |
| * |
| * Input Parameters: |
| * handle: Handle of this connection. |
| * |
| * label: Transaction label. |
| * |
| * Output Parameters: |
| * None. |
| * |
| * Returns AVRC_SUCCESS if successful. |
| * AVRC_BAD_HANDLE if handle is invalid. |
| * |
| *****************************************************************************/ |
| uint16_t AVRC_UnitCmd(uint8_t handle, uint8_t label) { |
| BT_HDR* p_cmd = (BT_HDR*)osi_calloc(AVRC_CMD_BUF_SIZE); |
| uint8_t* p_data; |
| |
| p_cmd->offset = AVCT_MSG_OFFSET; |
| p_data = (uint8_t*)(p_cmd + 1) + p_cmd->offset; |
| *p_data++ = AVRC_CMD_STATUS; |
| /* unit & id ignore */ |
| *p_data++ = (AVRC_SUB_UNIT << AVRC_SUBTYPE_SHIFT) | AVRC_SUBID_IGNORE; |
| *p_data++ = AVRC_OP_UNIT_INFO; |
| memset(p_data, AVRC_CMD_OPRND_PAD, AVRC_UNIT_OPRND_BYTES); |
| p_cmd->len = |
| p_data + AVRC_UNIT_OPRND_BYTES - (uint8_t*)(p_cmd + 1) - p_cmd->offset; |
| p_cmd->layer_specific = AVCT_DATA_CTRL; |
| |
| return AVCT_MsgReq(handle, label, AVCT_CMD, p_cmd); |
| } |
| |
| /****************************************************************************** |
| * |
| * Function AVRC_SubCmd |
| * |
| * Description Send a SUBUNIT INFO command to the peer device. This |
| * function can only be called for controller role connections. |
| * Any response message from the peer is passed back through |
| * the tAVRC_MSG_CBACK callback function. |
| * |
| * Input Parameters: |
| * handle: Handle of this connection. |
| * |
| * label: Transaction label. |
| * |
| * page: Specifies which part of the subunit type table |
| * is requested. For AVRCP it is typically zero. |
| * Value range is 0-7. |
| * |
| * Output Parameters: |
| * None. |
| * |
| * Returns AVRC_SUCCESS if successful. |
| * AVRC_BAD_HANDLE if handle is invalid. |
| * |
| *****************************************************************************/ |
| uint16_t AVRC_SubCmd(uint8_t handle, uint8_t label, uint8_t page) { |
| BT_HDR* p_cmd = (BT_HDR*)osi_calloc(AVRC_CMD_BUF_SIZE); |
| uint8_t* p_data; |
| |
| p_cmd->offset = AVCT_MSG_OFFSET; |
| p_data = (uint8_t*)(p_cmd + 1) + p_cmd->offset; |
| *p_data++ = AVRC_CMD_STATUS; |
| /* unit & id ignore */ |
| *p_data++ = (AVRC_SUB_UNIT << AVRC_SUBTYPE_SHIFT) | AVRC_SUBID_IGNORE; |
| *p_data++ = AVRC_OP_SUB_INFO; |
| *p_data++ = |
| ((page & AVRC_SUB_PAGE_MASK) << AVRC_SUB_PAGE_SHIFT) | AVRC_SUB_EXT_CODE; |
| memset(p_data, AVRC_CMD_OPRND_PAD, AVRC_SUB_OPRND_BYTES); |
| p_cmd->len = |
| p_data + AVRC_SUB_OPRND_BYTES - (uint8_t*)(p_cmd + 1) - p_cmd->offset; |
| p_cmd->layer_specific = AVCT_DATA_CTRL; |
| |
| return AVCT_MsgReq(handle, label, AVCT_CMD, p_cmd); |
| } |
| |
| /****************************************************************************** |
| * |
| * Function AVRC_VendorCmd |
| * |
| * Description Send a VENDOR DEPENDENT command to the peer device. This |
| * function can only be called for controller role connections. |
| * Any response message from the peer is passed back through |
| * the tAVRC_MSG_CBACK callback function. |
| * |
| * Input Parameters: |
| * handle: Handle of this connection. |
| * |
| * label: Transaction label. |
| * |
| * p_msg: Pointer to VENDOR DEPENDENT message structure. |
| * |
| * Output Parameters: |
| * None. |
| * |
| * Returns AVRC_SUCCESS if successful. |
| * AVRC_BAD_HANDLE if handle is invalid. |
| * |
| *****************************************************************************/ |
| uint16_t AVRC_VendorCmd(uint8_t handle, uint8_t label, |
| tAVRC_MSG_VENDOR* p_msg) { |
| BT_HDR* p_buf = avrc_vendor_msg(p_msg); |
| if (p_buf) |
| return AVCT_MsgReq(handle, label, AVCT_CMD, p_buf); |
| else |
| return AVCT_NO_RESOURCES; |
| } |
| |
| /****************************************************************************** |
| * |
| * Function AVRC_VendorRsp |
| * |
| * Description Send a VENDOR DEPENDENT response to the peer device. This |
| * function can only be called for target role connections. |
| * This function must be called when a VENDOR DEPENDENT |
| * command message is received from the peer through the |
| * tAVRC_MSG_CBACK callback function. |
| * |
| * Input Parameters: |
| * handle: Handle of this connection. |
| * |
| * label: Transaction label. Must be the same value as |
| * passed with the command message in the callback |
| * function. |
| * |
| * p_msg: Pointer to VENDOR DEPENDENT message structure. |
| * |
| * Output Parameters: |
| * None. |
| * |
| * Returns AVRC_SUCCESS if successful. |
| * AVRC_BAD_HANDLE if handle is invalid. |
| * |
| *****************************************************************************/ |
| uint16_t AVRC_VendorRsp(uint8_t handle, uint8_t label, |
| tAVRC_MSG_VENDOR* p_msg) { |
| BT_HDR* p_buf = avrc_vendor_msg(p_msg); |
| if (p_buf) |
| return AVCT_MsgReq(handle, label, AVCT_RSP, p_buf); |
| else |
| return AVCT_NO_RESOURCES; |
| } |