| /****************************************************************************** |
| * |
| * Copyright 2006-2013 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. |
| * |
| ******************************************************************************/ |
| #include <string.h> |
| |
| #include "avrc_api.h" |
| #include "avrc_defs.h" |
| #include "avrc_int.h" |
| #include "bt_common.h" |
| #include "bt_utils.h" |
| #include "log/log.h" |
| #include "osi/include/osi.h" |
| |
| /***************************************************************************** |
| * Global data |
| ****************************************************************************/ |
| |
| #define MIN(x, y) ((x) < (y) ? (x) : (y)) |
| |
| /******************************************************************************* |
| * |
| * Function avrc_pars_vendor_rsp |
| * |
| * Description This function parses the vendor specific commands defined by |
| * Bluetooth SIG |
| * |
| * Returns AVRC_STS_NO_ERROR, if the message in p_data is parsed |
| * successfully. |
| * Otherwise, the error code defined by AVRCP 1.4 |
| * |
| ******************************************************************************/ |
| static tAVRC_STS avrc_pars_vendor_rsp(tAVRC_MSG_VENDOR* p_msg, |
| tAVRC_RESPONSE* p_result) { |
| tAVRC_STS status = AVRC_STS_NO_ERROR; |
| uint8_t* p; |
| uint16_t len; |
| #if (AVRC_ADV_CTRL_INCLUDED == TRUE) |
| uint8_t eventid = 0; |
| #endif |
| |
| /* Check the vendor data */ |
| if (p_msg->vendor_len == 0) return AVRC_STS_NO_ERROR; |
| if (p_msg->p_vendor_data == NULL) return AVRC_STS_INTERNAL_ERR; |
| |
| if (p_msg->vendor_len < 4) { |
| android_errorWriteLog(0x534e4554, "111450531"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least 4", |
| __func__, p_msg->vendor_len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| p = p_msg->p_vendor_data; |
| BE_STREAM_TO_UINT8(p_result->pdu, p); |
| p++; /* skip the reserved/packe_type byte */ |
| BE_STREAM_TO_UINT16(len, p); |
| AVRC_TRACE_DEBUG("%s ctype:0x%x pdu:0x%x, len:%d/0x%x vendor_len=0x%x", |
| __func__, p_msg->hdr.ctype, p_result->pdu, len, len, |
| p_msg->vendor_len); |
| if (p_msg->vendor_len < len + 4) { |
| android_errorWriteLog(0x534e4554, "111450531"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least %d", |
| __func__, p_msg->vendor_len, len + 4); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| if (p_msg->hdr.ctype == AVRC_RSP_REJ) { |
| if (len < 1) { |
| android_errorWriteLog(0x534e4554, "111450531"); |
| AVRC_TRACE_WARNING("%s: invalid parameter length %d: must be at least 1", |
| __func__, len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| p_result->rsp.status = *p; |
| return p_result->rsp.status; |
| } |
| |
| switch (p_result->pdu) { |
| /* case AVRC_PDU_REQUEST_CONTINUATION_RSP: 0x40 */ |
| /* case AVRC_PDU_ABORT_CONTINUATION_RSP: 0x41 */ |
| |
| #if (AVRC_ADV_CTRL_INCLUDED == TRUE) |
| case AVRC_PDU_SET_ABSOLUTE_VOLUME: /* 0x50 */ |
| if (len != 1) |
| status = AVRC_STS_INTERNAL_ERR; |
| else { |
| BE_STREAM_TO_UINT8(p_result->volume.volume, p); |
| } |
| break; |
| #endif /* (AVRC_ADV_CTRL_INCLUDED == TRUE) */ |
| |
| case AVRC_PDU_REGISTER_NOTIFICATION: /* 0x31 */ |
| #if (AVRC_ADV_CTRL_INCLUDED == TRUE) |
| if (len < 1) { |
| android_errorWriteLog(0x534e4554, "111450531"); |
| AVRC_TRACE_WARNING( |
| "%s: invalid parameter length %d: must be at least 1", __func__, |
| len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| BE_STREAM_TO_UINT8(eventid, p); |
| if (AVRC_EVT_VOLUME_CHANGE == eventid && |
| (AVRC_RSP_CHANGED == p_msg->hdr.ctype || |
| AVRC_RSP_INTERIM == p_msg->hdr.ctype || |
| AVRC_RSP_REJ == p_msg->hdr.ctype || |
| AVRC_RSP_NOT_IMPL == p_msg->hdr.ctype)) { |
| if (len < 2) { |
| android_errorWriteLog(0x534e4554, "111450531"); |
| AVRC_TRACE_WARNING( |
| "%s: invalid parameter length %d: must be at least 2", __func__, |
| len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| p_result->reg_notif.status = p_msg->hdr.ctype; |
| p_result->reg_notif.event_id = eventid; |
| BE_STREAM_TO_UINT8(p_result->reg_notif.param.volume, p); |
| } |
| AVRC_TRACE_DEBUG("%s PDU reg notif response:event %x, volume %x", |
| __func__, eventid, p_result->reg_notif.param.volume); |
| #endif /* (AVRC_ADV_CTRL_INCLUDED == TRUE) */ |
| break; |
| default: |
| status = AVRC_STS_BAD_CMD; |
| break; |
| } |
| |
| return status; |
| } |
| |
| tAVRC_STS avrc_parse_notification_rsp(uint8_t* p_stream, uint16_t len, |
| tAVRC_REG_NOTIF_RSP* p_rsp) { |
| uint16_t min_len = 1; |
| |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT8(p_rsp->event_id, p_stream); |
| switch (p_rsp->event_id) { |
| case AVRC_EVT_PLAY_STATUS_CHANGE: |
| min_len += 1; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT8(p_rsp->param.play_status, p_stream); |
| break; |
| |
| case AVRC_EVT_TRACK_CHANGE: |
| min_len += 8; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_ARRAY(p_stream, p_rsp->param.track, 8); |
| break; |
| |
| case AVRC_EVT_APP_SETTING_CHANGE: |
| min_len += 1; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT8(p_rsp->param.player_setting.num_attr, p_stream); |
| if (p_rsp->param.player_setting.num_attr > AVRC_MAX_APP_SETTINGS) { |
| android_errorWriteLog(0x534e4554, "73782082"); |
| p_rsp->param.player_setting.num_attr = AVRC_MAX_APP_SETTINGS; |
| } |
| min_len += p_rsp->param.player_setting.num_attr * 2; |
| if (len < min_len) goto length_error; |
| for (int index = 0; index < p_rsp->param.player_setting.num_attr; |
| index++) { |
| BE_STREAM_TO_UINT8(p_rsp->param.player_setting.attr_id[index], |
| p_stream); |
| BE_STREAM_TO_UINT8(p_rsp->param.player_setting.attr_value[index], |
| p_stream); |
| } |
| break; |
| |
| case AVRC_EVT_NOW_PLAYING_CHANGE: |
| break; |
| |
| case AVRC_EVT_AVAL_PLAYERS_CHANGE: |
| break; |
| |
| case AVRC_EVT_ADDR_PLAYER_CHANGE: |
| min_len += 4; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT16(p_rsp->param.addr_player.player_id, p_stream); |
| BE_STREAM_TO_UINT16(p_rsp->param.addr_player.uid_counter, p_stream); |
| break; |
| |
| case AVRC_EVT_PLAY_POS_CHANGED: |
| min_len += 4; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT32(p_rsp->param.play_pos, p_stream); |
| break; |
| |
| case AVRC_EVT_UIDS_CHANGE: |
| break; |
| |
| case AVRC_EVT_TRACK_REACHED_END: |
| case AVRC_EVT_TRACK_REACHED_START: |
| case AVRC_EVT_BATTERY_STATUS_CHANGE: |
| case AVRC_EVT_SYSTEM_STATUS_CHANGE: |
| default: |
| break; |
| } |
| |
| return AVRC_STS_NO_ERROR; |
| |
| length_error: |
| android_errorWriteLog(0x534e4554, "111450417"); |
| AVRC_TRACE_WARNING("%s: invalid parameter length %d: must be at least %d", |
| __func__, len, min_len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| static tAVRC_STS avrc_pars_browse_rsp(tAVRC_MSG_BROWSE* p_msg, |
| tAVRC_RESPONSE* p_rsp) { |
| tAVRC_STS status = AVRC_STS_NO_ERROR; |
| uint8_t pdu; |
| |
| if (p_msg->browse_len == 0) { |
| AVRC_TRACE_ERROR("%s length ", p_msg->browse_len); |
| return AVRC_STS_BAD_PARAM; |
| } |
| |
| uint8_t* p = p_msg->p_browse_data; |
| |
| /* read the pdu */ |
| if (p_msg->browse_len < 3) { |
| android_errorWriteLog(0x534e4554, "111451066"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least 3", |
| __func__, p_msg->browse_len); |
| return AVRC_STS_BAD_PARAM; |
| } |
| BE_STREAM_TO_UINT8(pdu, p); |
| uint16_t pkt_len; |
| int min_len = 0; |
| /* read the entire packet len */ |
| BE_STREAM_TO_UINT16(pkt_len, p); |
| |
| AVRC_TRACE_DEBUG("%s pdu:%d, pkt_len:%d", __func__, pdu, pkt_len); |
| |
| if (p_msg->browse_len < (pkt_len + 3)) { |
| android_errorWriteLog(0x534e4554, "111451066"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least %d", |
| __func__, p_msg->browse_len, pkt_len + 3); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| switch (pdu) { |
| case AVRC_PDU_GET_FOLDER_ITEMS: { |
| tAVRC_GET_ITEMS_RSP* get_item_rsp = &(p_rsp->get_items); |
| /* Copy back the PDU */ |
| get_item_rsp->pdu = pdu; |
| |
| min_len += 1; |
| if (pkt_len < min_len) goto browse_length_error; |
| /* read the status */ |
| BE_STREAM_TO_UINT8(get_item_rsp->status, p); |
| if (get_item_rsp->status != AVRC_STS_NO_ERROR) { |
| AVRC_TRACE_WARNING("%s returning error %d", __func__, |
| get_item_rsp->status); |
| return get_item_rsp->status; |
| } |
| |
| min_len += 4; |
| if (pkt_len < min_len) goto browse_length_error; |
| /* read the UID counter */ |
| BE_STREAM_TO_UINT16(get_item_rsp->uid_counter, p); |
| /* read the number of items */ |
| BE_STREAM_TO_UINT16(get_item_rsp->item_count, p); |
| |
| AVRC_TRACE_DEBUG( |
| "%s pdu %d status %d pkt_len %d uid counter %d item count %d", |
| __func__, get_item_rsp->pdu, get_item_rsp->status, pkt_len, |
| get_item_rsp->uid_counter, get_item_rsp->item_count); |
| |
| /* get each of the items */ |
| get_item_rsp->p_item_list = (tAVRC_ITEM*)osi_malloc( |
| get_item_rsp->item_count * (sizeof(tAVRC_ITEM))); |
| tAVRC_ITEM* curr_item = get_item_rsp->p_item_list; |
| for (int i = 0; i < get_item_rsp->item_count; i++) { |
| min_len += 1; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT8(curr_item->item_type, p); |
| AVRC_TRACE_DEBUG("%s item type %d", __func__, curr_item->item_type); |
| switch (curr_item->item_type) { |
| case AVRC_ITEM_PLAYER: { |
| /* Handle player */ |
| tAVRC_ITEM_PLAYER* player = &(curr_item->u.player); |
| uint8_t player_len; |
| min_len += 10 + AVRC_FEATURE_MASK_SIZE; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(player_len, p); |
| BE_STREAM_TO_UINT16(player->player_id, p); |
| BE_STREAM_TO_UINT8(player->major_type, p); |
| BE_STREAM_TO_UINT32(player->sub_type, p); |
| BE_STREAM_TO_UINT8(player->play_status, p); |
| BE_STREAM_TO_ARRAY(p, player->features, AVRC_FEATURE_MASK_SIZE); |
| |
| /* read str */ |
| min_len += 4; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(player->name.charset_id, p); |
| BE_STREAM_TO_UINT16(player->name.str_len, p); |
| min_len += player->name.str_len; |
| if (pkt_len < min_len) goto browse_length_error; |
| player->name.p_str = (uint8_t*)osi_malloc( |
| (player->name.str_len + 1) * sizeof(uint8_t)); |
| BE_STREAM_TO_ARRAY(p, player->name.p_str, player->name.str_len); |
| AVRC_TRACE_DEBUG( |
| "%s type %d id %d mtype %d stype %d ps %d cs %d name len %d", |
| __func__, curr_item->item_type, player->player_id, |
| player->major_type, player->sub_type, player->play_status, |
| player->name.charset_id, player->name.str_len); |
| } break; |
| |
| case AVRC_ITEM_FOLDER: { |
| tAVRC_ITEM_FOLDER* folder = &(curr_item->u.folder); |
| uint16_t folder_len; |
| min_len += 4 + AVRC_UID_SIZE; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(folder_len, p); |
| |
| BE_STREAM_TO_ARRAY(p, folder->uid, AVRC_UID_SIZE); |
| BE_STREAM_TO_UINT8(folder->type, p); |
| BE_STREAM_TO_UINT8(folder->playable, p); |
| |
| /* read str, encoding to be handled by upper layers */ |
| min_len += 4; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(folder->name.charset_id, p); |
| BE_STREAM_TO_UINT16(folder->name.str_len, p); |
| min_len += folder->name.str_len; |
| if (pkt_len < min_len) goto browse_length_error; |
| folder->name.p_str = (uint8_t*)osi_malloc( |
| (folder->name.str_len + 1) * sizeof(uint8_t)); |
| BE_STREAM_TO_ARRAY(p, folder->name.p_str, folder->name.str_len); |
| AVRC_TRACE_DEBUG("%s type %d playable %d cs %d name len %d", |
| __func__, folder->type, folder->playable, |
| folder->name.charset_id, folder->name.str_len); |
| } break; |
| |
| case AVRC_ITEM_MEDIA: { |
| tAVRC_ITEM_MEDIA* media = &(curr_item->u.media); |
| uint8_t media_len; |
| min_len += 3 + AVRC_UID_SIZE; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(media_len, p); |
| BE_STREAM_TO_ARRAY(p, media->uid, AVRC_UID_SIZE); |
| BE_STREAM_TO_UINT8(media->type, p); |
| |
| /* read str, encoding to be handled by upper layers */ |
| min_len += 4; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(media->name.charset_id, p); |
| BE_STREAM_TO_UINT16(media->name.str_len, p); |
| min_len += 1 + media->name.str_len; |
| if (pkt_len < min_len) goto browse_length_error; |
| media->name.p_str = |
| (uint8_t*)osi_malloc((media->name.str_len) * sizeof(uint8_t)); |
| BE_STREAM_TO_ARRAY(p, media->name.p_str, media->name.str_len); |
| |
| BE_STREAM_TO_UINT8(media->attr_count, p); |
| AVRC_TRACE_DEBUG("%s media type %d charset id %d len %d attr ct %d", |
| __func__, media->type, media->name.charset_id, |
| media->name.str_len, media->attr_count); |
| |
| media->p_attr_list = (tAVRC_ATTR_ENTRY*)osi_malloc( |
| media->attr_count * sizeof(tAVRC_ATTR_ENTRY)); |
| for (int jk = 0; jk < media->attr_count; jk++) { |
| tAVRC_ATTR_ENTRY* attr_entry = &(media->p_attr_list[jk]); |
| min_len += 8; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT32(attr_entry->attr_id, p); |
| |
| /* Parse the name now */ |
| BE_STREAM_TO_UINT16(attr_entry->name.charset_id, p); |
| BE_STREAM_TO_UINT16(attr_entry->name.str_len, p); |
| min_len += attr_entry->name.str_len; |
| if (pkt_len < min_len) goto browse_length_error; |
| attr_entry->name.p_str = (uint8_t*)osi_malloc( |
| attr_entry->name.str_len * sizeof(uint8_t)); |
| BE_STREAM_TO_ARRAY(p, attr_entry->name.p_str, |
| attr_entry->name.str_len); |
| AVRC_TRACE_DEBUG("%s media attr id %d cs %d name len %d", |
| __func__, attr_entry->attr_id, |
| attr_entry->name.charset_id, |
| attr_entry->name.str_len); |
| } |
| } break; |
| |
| default: |
| AVRC_TRACE_ERROR("%s item type not handled %d", __func__, |
| curr_item->item_type); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| AVRC_TRACE_DEBUG("%s pkt_len %d min_len %d", __func__, pkt_len, |
| min_len); |
| |
| /* advance to populate the next item */ |
| curr_item++; |
| } |
| break; |
| } |
| |
| case AVRC_PDU_CHANGE_PATH: { |
| tAVRC_CHG_PATH_RSP* change_path_rsp = &(p_rsp->chg_path); |
| min_len += 5; |
| if (pkt_len < min_len) goto browse_length_error; |
| /* Copyback the PDU */ |
| change_path_rsp->pdu = pdu; |
| /* Read the status */ |
| BE_STREAM_TO_UINT8(change_path_rsp->status, p); |
| /* Read the number of items in folder */ |
| BE_STREAM_TO_UINT32(change_path_rsp->num_items, p); |
| |
| AVRC_TRACE_DEBUG("%s pdu %d status %d item count %d", __func__, |
| change_path_rsp->pdu, change_path_rsp->status, |
| change_path_rsp->num_items); |
| break; |
| } |
| |
| case AVRC_PDU_SET_BROWSED_PLAYER: { |
| tAVRC_SET_BR_PLAYER_RSP* set_br_pl_rsp = &(p_rsp->br_player); |
| /* Copyback the PDU */ |
| set_br_pl_rsp->pdu = pdu; |
| |
| /* Read the status */ |
| min_len += 10; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT8(set_br_pl_rsp->status, p); |
| |
| if (set_br_pl_rsp->status != AVRC_STS_NO_ERROR) { |
| AVRC_TRACE_ERROR( |
| "%s Stopping further parsing because player not browsable sts %d", |
| __func__, set_br_pl_rsp->status); |
| break; |
| } |
| BE_STREAM_TO_UINT16(set_br_pl_rsp->uid_counter, p); |
| BE_STREAM_TO_UINT32(set_br_pl_rsp->num_items, p); |
| BE_STREAM_TO_UINT16(set_br_pl_rsp->charset_id, p); |
| BE_STREAM_TO_UINT8(set_br_pl_rsp->folder_depth, p); |
| AVRC_TRACE_DEBUG( |
| "%s AVRC_PDU_SET_BROWSED_PLAYER status %d items %d cs %d depth %d", |
| __func__, set_br_pl_rsp->status, set_br_pl_rsp->num_items, |
| set_br_pl_rsp->charset_id, set_br_pl_rsp->folder_depth); |
| |
| set_br_pl_rsp->p_folders = (tAVRC_NAME*)osi_malloc( |
| set_br_pl_rsp->folder_depth * sizeof(tAVRC_NAME)); |
| |
| /* Read each of the folder in the depth */ |
| for (uint32_t i = 0; i < set_br_pl_rsp->folder_depth; i++) { |
| tAVRC_NAME* folder_name = &(set_br_pl_rsp->p_folders[i]); |
| min_len += 2; |
| if (pkt_len < min_len) goto browse_length_error; |
| BE_STREAM_TO_UINT16(folder_name->str_len, p); |
| min_len += folder_name->str_len; |
| if (pkt_len < min_len) goto browse_length_error; |
| AVRC_TRACE_DEBUG("%s AVRC_PDU_SET_BROWSED_PLAYER item: %d len: %d", |
| __func__, i, folder_name->str_len); |
| folder_name->p_str = |
| (uint8_t*)osi_malloc((folder_name->str_len + 1) * sizeof(uint8_t)); |
| BE_STREAM_TO_ARRAY(p, folder_name->p_str, folder_name->str_len); |
| } |
| break; |
| } |
| |
| default: |
| AVRC_TRACE_ERROR("%s pdu %d not handled", __func__, pdu); |
| } |
| |
| return status; |
| |
| browse_length_error: |
| android_errorWriteLog(0x534e4554, "111451066"); |
| AVRC_TRACE_WARNING("%s: invalid parameter length %d: must be at least %d", |
| __func__, pkt_len, min_len); |
| return AVRC_STS_BAD_CMD; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function avrc_ctrl_pars_vendor_rsp |
| * |
| * Description This function parses the vendor specific commands defined by |
| * Bluetooth SIG |
| * |
| * Returns AVRC_STS_NO_ERROR, if the message in p_data is parsed |
| * successfully. |
| * Otherwise, the error code defined by AVRCP 1.4 |
| * |
| ******************************************************************************/ |
| static tAVRC_STS avrc_ctrl_pars_vendor_rsp(tAVRC_MSG_VENDOR* p_msg, |
| tAVRC_RESPONSE* p_result, |
| uint8_t* p_buf, uint16_t* buf_len) { |
| if (p_msg->vendor_len < 4) { |
| android_errorWriteLog(0x534e4554, "111450417"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least 4", |
| __func__, p_msg->vendor_len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| uint8_t* p = p_msg->p_vendor_data; |
| BE_STREAM_TO_UINT8(p_result->pdu, p); |
| p++; /* skip the reserved/packe_type byte */ |
| |
| uint16_t len; |
| uint16_t min_len = 0; |
| BE_STREAM_TO_UINT16(len, p); |
| AVRC_TRACE_DEBUG("%s ctype:0x%x pdu:0x%x, len:%d vendor_len=0x%x", __func__, |
| p_msg->hdr.ctype, p_result->pdu, len, p_msg->vendor_len); |
| if (p_msg->vendor_len < len + 4) { |
| android_errorWriteLog(0x534e4554, "111450417"); |
| AVRC_TRACE_WARNING("%s: message length %d too short: must be at least %d", |
| __func__, p_msg->vendor_len, len + 4); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| /* Todo: Issue in handling reject, check */ |
| if (p_msg->hdr.ctype == AVRC_RSP_REJ) { |
| min_len += 1; |
| if (len < min_len) goto length_error; |
| p_result->rsp.status = *p; |
| return p_result->rsp.status; |
| } |
| |
| /* TODO: Break the big switch into functions. */ |
| switch (p_result->pdu) { |
| /* case AVRC_PDU_REQUEST_CONTINUATION_RSP: 0x40 */ |
| /* case AVRC_PDU_ABORT_CONTINUATION_RSP: 0x41 */ |
| |
| case AVRC_PDU_REGISTER_NOTIFICATION: |
| return avrc_parse_notification_rsp(p, len, &p_result->reg_notif); |
| |
| case AVRC_PDU_GET_CAPABILITIES: |
| if (len == 0) { |
| p_result->get_caps.count = 0; |
| p_result->get_caps.capability_id = 0; |
| break; |
| } |
| min_len += 2; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT8(p_result->get_caps.capability_id, p); |
| BE_STREAM_TO_UINT8(p_result->get_caps.count, p); |
| AVRC_TRACE_DEBUG("%s cap id = %d, cap_count = %d ", __func__, |
| p_result->get_caps.capability_id, |
| p_result->get_caps.count); |
| if (p_result->get_caps.capability_id == AVRC_CAP_COMPANY_ID) { |
| min_len += MIN(p_result->get_caps.count, AVRC_CAP_MAX_NUM_COMP_ID) * 3; |
| if (len < min_len) goto length_error; |
| for (int xx = 0; ((xx < p_result->get_caps.count) && |
| (xx < AVRC_CAP_MAX_NUM_COMP_ID)); |
| xx++) { |
| BE_STREAM_TO_UINT24(p_result->get_caps.param.company_id[xx], p); |
| } |
| } else if (p_result->get_caps.capability_id == |
| AVRC_CAP_EVENTS_SUPPORTED) { |
| min_len += MIN(p_result->get_caps.count, AVRC_CAP_MAX_NUM_EVT_ID); |
| if (len < min_len) goto length_error; |
| for (int xx = 0; ((xx < p_result->get_caps.count) && |
| (xx < AVRC_CAP_MAX_NUM_EVT_ID)); |
| xx++) { |
| BE_STREAM_TO_UINT8(p_result->get_caps.param.event_id[xx], p); |
| } |
| } |
| break; |
| |
| case AVRC_PDU_LIST_PLAYER_APP_ATTR: |
| if (len == 0) { |
| p_result->list_app_attr.num_attr = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(p_result->list_app_attr.num_attr, p); |
| AVRC_TRACE_DEBUG("%s attr count = %d ", __func__, |
| p_result->list_app_attr.num_attr); |
| |
| if (p_result->list_app_attr.num_attr > AVRC_MAX_APP_ATTR_SIZE) { |
| android_errorWriteLog(0x534e4554, "63146237"); |
| p_result->list_app_attr.num_attr = AVRC_MAX_APP_ATTR_SIZE; |
| } |
| |
| min_len += p_result->list_app_attr.num_attr; |
| if (len < min_len) goto length_error; |
| for (int xx = 0; xx < p_result->list_app_attr.num_attr; xx++) { |
| BE_STREAM_TO_UINT8(p_result->list_app_attr.attrs[xx], p); |
| } |
| break; |
| |
| case AVRC_PDU_LIST_PLAYER_APP_VALUES: |
| if (len == 0) { |
| p_result->list_app_values.num_val = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(p_result->list_app_values.num_val, p); |
| if (p_result->list_app_values.num_val > AVRC_MAX_APP_ATTR_SIZE) { |
| android_errorWriteLog(0x534e4554, "78526423"); |
| p_result->list_app_values.num_val = AVRC_MAX_APP_ATTR_SIZE; |
| } |
| |
| AVRC_TRACE_DEBUG("%s value count = %d ", __func__, |
| p_result->list_app_values.num_val); |
| min_len += p_result->list_app_values.num_val; |
| if (len < min_len) goto length_error; |
| for (int xx = 0; xx < p_result->list_app_values.num_val; xx++) { |
| BE_STREAM_TO_UINT8(p_result->list_app_values.vals[xx], p); |
| } |
| break; |
| |
| case AVRC_PDU_GET_CUR_PLAYER_APP_VALUE: { |
| if (len == 0) { |
| p_result->get_cur_app_val.num_val = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(p_result->get_cur_app_val.num_val, p); |
| AVRC_TRACE_DEBUG("%s attr count = %d ", __func__, |
| p_result->get_cur_app_val.num_val); |
| |
| if (p_result->get_cur_app_val.num_val > AVRC_MAX_APP_ATTR_SIZE) { |
| android_errorWriteLog(0x534e4554, "63146237"); |
| p_result->get_cur_app_val.num_val = AVRC_MAX_APP_ATTR_SIZE; |
| } |
| |
| min_len += p_result->get_cur_app_val.num_val * 2; |
| if (len < min_len) { |
| p_result->get_cur_app_val.num_val = 0; |
| goto length_error; |
| } |
| tAVRC_APP_SETTING* app_sett = (tAVRC_APP_SETTING*)osi_calloc( |
| p_result->get_cur_app_val.num_val * sizeof(tAVRC_APP_SETTING)); |
| for (int xx = 0; xx < p_result->get_cur_app_val.num_val; xx++) { |
| BE_STREAM_TO_UINT8(app_sett[xx].attr_id, p); |
| BE_STREAM_TO_UINT8(app_sett[xx].attr_val, p); |
| } |
| p_result->get_cur_app_val.p_vals = app_sett; |
| } break; |
| |
| case AVRC_PDU_GET_PLAYER_APP_ATTR_TEXT: { |
| uint8_t num_attrs; |
| |
| if (len == 0) { |
| p_result->get_app_attr_txt.num_attr = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(num_attrs, p); |
| if (num_attrs > AVRC_MAX_APP_ATTR_SIZE) { |
| num_attrs = AVRC_MAX_APP_ATTR_SIZE; |
| } |
| AVRC_TRACE_DEBUG("%s attr count = %d ", __func__, |
| p_result->get_app_attr_txt.num_attr); |
| p_result->get_app_attr_txt.num_attr = num_attrs; |
| |
| p_result->get_app_attr_txt.p_attrs = (tAVRC_APP_SETTING_TEXT*)osi_calloc( |
| num_attrs * sizeof(tAVRC_APP_SETTING_TEXT)); |
| for (int xx = 0; xx < num_attrs; xx++) { |
| min_len += 4; |
| if (len < min_len) { |
| for (int j = 0; j < xx; j++) { |
| osi_free(p_result->get_app_attr_txt.p_attrs[j].p_str); |
| } |
| osi_free_and_reset((void**)&p_result->get_app_attr_txt.p_attrs); |
| p_result->get_app_attr_txt.num_attr = 0; |
| goto length_error; |
| } |
| BE_STREAM_TO_UINT8(p_result->get_app_attr_txt.p_attrs[xx].attr_id, p); |
| BE_STREAM_TO_UINT16(p_result->get_app_attr_txt.p_attrs[xx].charset_id, |
| p); |
| BE_STREAM_TO_UINT8(p_result->get_app_attr_txt.p_attrs[xx].str_len, p); |
| min_len += p_result->get_app_attr_txt.p_attrs[xx].str_len; |
| if (len < min_len) { |
| for (int j = 0; j < xx; j++) { |
| osi_free(p_result->get_app_attr_txt.p_attrs[j].p_str); |
| } |
| osi_free_and_reset((void**)&p_result->get_app_attr_txt.p_attrs); |
| p_result->get_app_attr_txt.num_attr = 0; |
| goto length_error; |
| } |
| if (p_result->get_app_attr_txt.p_attrs[xx].str_len != 0) { |
| uint8_t* p_str = (uint8_t*)osi_calloc( |
| p_result->get_app_attr_txt.p_attrs[xx].str_len); |
| BE_STREAM_TO_ARRAY(p, p_str, |
| p_result->get_app_attr_txt.p_attrs[xx].str_len); |
| p_result->get_app_attr_txt.p_attrs[xx].p_str = p_str; |
| } else { |
| p_result->get_app_attr_txt.p_attrs[xx].p_str = NULL; |
| } |
| } |
| } break; |
| |
| case AVRC_PDU_GET_PLAYER_APP_VALUE_TEXT: { |
| uint8_t num_vals; |
| |
| if (len == 0) { |
| p_result->get_app_val_txt.num_attr = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(num_vals, p); |
| if (num_vals > AVRC_MAX_APP_ATTR_SIZE) { |
| num_vals = AVRC_MAX_APP_ATTR_SIZE; |
| } |
| p_result->get_app_val_txt.num_attr = num_vals; |
| AVRC_TRACE_DEBUG("%s value count = %d ", __func__, |
| p_result->get_app_val_txt.num_attr); |
| |
| p_result->get_app_val_txt.p_attrs = (tAVRC_APP_SETTING_TEXT*)osi_calloc( |
| num_vals * sizeof(tAVRC_APP_SETTING_TEXT)); |
| for (int i = 0; i < num_vals; i++) { |
| min_len += 4; |
| if (len < min_len) { |
| for (int j = 0; j < i; j++) { |
| osi_free(p_result->get_app_val_txt.p_attrs[j].p_str); |
| } |
| osi_free_and_reset((void**)&p_result->get_app_val_txt.p_attrs); |
| p_result->get_app_val_txt.num_attr = 0; |
| goto length_error; |
| } |
| BE_STREAM_TO_UINT8(p_result->get_app_val_txt.p_attrs[i].attr_id, p); |
| BE_STREAM_TO_UINT16(p_result->get_app_val_txt.p_attrs[i].charset_id, p); |
| BE_STREAM_TO_UINT8(p_result->get_app_val_txt.p_attrs[i].str_len, p); |
| min_len += p_result->get_app_val_txt.p_attrs[i].str_len; |
| if (len < min_len) { |
| for (int j = 0; j < i; j++) { |
| osi_free(p_result->get_app_val_txt.p_attrs[j].p_str); |
| } |
| osi_free_and_reset((void**)&p_result->get_app_val_txt.p_attrs); |
| p_result->get_app_val_txt.num_attr = 0; |
| goto length_error; |
| } |
| if (p_result->get_app_val_txt.p_attrs[i].str_len != 0) { |
| uint8_t* p_str = (uint8_t*)osi_calloc( |
| p_result->get_app_val_txt.p_attrs[i].str_len); |
| BE_STREAM_TO_ARRAY(p, p_str, |
| p_result->get_app_val_txt.p_attrs[i].str_len); |
| p_result->get_app_val_txt.p_attrs[i].p_str = p_str; |
| } else { |
| p_result->get_app_val_txt.p_attrs[i].p_str = NULL; |
| } |
| } |
| } break; |
| |
| case AVRC_PDU_SET_PLAYER_APP_VALUE: |
| /* nothing comes as part of this rsp */ |
| break; |
| |
| case AVRC_PDU_GET_ELEMENT_ATTR: { |
| uint8_t num_attrs; |
| |
| if (len <= 0) { |
| p_result->get_attrs.num_attrs = 0; |
| break; |
| } |
| min_len += 1; |
| BE_STREAM_TO_UINT8(num_attrs, p); |
| p_result->get_attrs.num_attrs = num_attrs; |
| if (num_attrs) { |
| tAVRC_ATTR_ENTRY* p_attrs = |
| (tAVRC_ATTR_ENTRY*)osi_calloc(num_attrs * sizeof(tAVRC_ATTR_ENTRY)); |
| for (int i = 0; i < num_attrs; i++) { |
| min_len += 8; |
| if (len < min_len) { |
| for (int j = 0; j < i; j++) { |
| osi_free(p_attrs[j].name.p_str); |
| } |
| osi_free(p_attrs); |
| p_result->get_attrs.num_attrs = 0; |
| goto length_error; |
| } |
| BE_STREAM_TO_UINT32(p_attrs[i].attr_id, p); |
| BE_STREAM_TO_UINT16(p_attrs[i].name.charset_id, p); |
| BE_STREAM_TO_UINT16(p_attrs[i].name.str_len, p); |
| min_len += p_attrs[i].name.str_len; |
| if (len < min_len) { |
| for (int j = 0; j < i; j++) { |
| osi_free(p_attrs[j].name.p_str); |
| } |
| osi_free(p_attrs); |
| p_result->get_attrs.num_attrs = 0; |
| goto length_error; |
| } |
| if (p_attrs[i].name.str_len > 0) { |
| p_attrs[i].name.p_str = |
| (uint8_t*)osi_calloc(p_attrs[i].name.str_len); |
| BE_STREAM_TO_ARRAY(p, p_attrs[i].name.p_str, |
| p_attrs[i].name.str_len); |
| } else { |
| p_attrs[i].name.p_str = NULL; |
| } |
| } |
| p_result->get_attrs.p_attrs = p_attrs; |
| } |
| } break; |
| |
| case AVRC_PDU_GET_PLAY_STATUS: |
| if (len == 0) { |
| break; |
| } |
| min_len += 9; |
| if (len < min_len) goto length_error; |
| BE_STREAM_TO_UINT32(p_result->get_play_status.song_len, p); |
| BE_STREAM_TO_UINT32(p_result->get_play_status.song_pos, p); |
| BE_STREAM_TO_UINT8(p_result->get_play_status.play_status, p); |
| break; |
| |
| case AVRC_PDU_SET_ADDRESSED_PLAYER: |
| if (len != 1) { |
| AVRC_TRACE_ERROR("%s pdu: %d len %d", __func__, p_result->pdu, len); |
| return AVRC_STS_BAD_CMD; |
| } |
| BE_STREAM_TO_UINT8(p_result->rsp.status, p); |
| break; |
| |
| default: |
| return AVRC_STS_BAD_CMD; |
| } |
| return AVRC_STS_NO_ERROR; |
| |
| length_error: |
| android_errorWriteLog(0x534e4554, "111450417"); |
| AVRC_TRACE_WARNING("%s: invalid parameter length %d: must be at least %d", |
| __func__, len, min_len); |
| return AVRC_STS_INTERNAL_ERR; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function AVRC_Ctrl_ParsResponse |
| * |
| * Description This function is a parse response for AVRCP Controller. |
| * |
| * Returns AVRC_STS_NO_ERROR, if the message in p_data is parsed |
| * successfully. |
| * Otherwise, the error code defined by AVRCP 1.4 |
| * |
| ******************************************************************************/ |
| tAVRC_STS AVRC_Ctrl_ParsResponse(tAVRC_MSG* p_msg, tAVRC_RESPONSE* p_result, |
| uint8_t* p_buf, uint16_t* buf_len) { |
| tAVRC_STS status = AVRC_STS_INTERNAL_ERR; |
| if (p_msg && p_result) { |
| switch (p_msg->hdr.opcode) { |
| case AVRC_OP_VENDOR: /* 0x00 Vendor-dependent commands */ |
| status = |
| avrc_ctrl_pars_vendor_rsp(&p_msg->vendor, p_result, p_buf, buf_len); |
| break; |
| |
| case AVRC_OP_BROWSE: /* 0xff Browse commands */ |
| status = avrc_pars_browse_rsp(&p_msg->browse, p_result); |
| break; |
| |
| default: |
| AVRC_TRACE_ERROR("%s unknown opcode:0x%x", __func__, p_msg->hdr.opcode); |
| break; |
| } |
| p_result->rsp.opcode = p_msg->hdr.opcode; |
| p_result->rsp.status = status; |
| } |
| return status; |
| } |
| |
| /******************************************************************************* |
| * |
| * Function AVRC_ParsResponse |
| * |
| * Description This function is a superset of AVRC_ParsMetadata to parse |
| * the response. |
| * |
| * Returns AVRC_STS_NO_ERROR, if the message in p_data is parsed |
| * successfully. |
| * Otherwise, the error code defined by AVRCP 1.4 |
| * |
| ******************************************************************************/ |
| tAVRC_STS AVRC_ParsResponse(tAVRC_MSG* p_msg, tAVRC_RESPONSE* p_result, |
| UNUSED_ATTR uint8_t* p_buf, |
| UNUSED_ATTR uint16_t buf_len) { |
| tAVRC_STS status = AVRC_STS_INTERNAL_ERR; |
| uint16_t id; |
| |
| if (p_msg && p_result) { |
| switch (p_msg->hdr.opcode) { |
| case AVRC_OP_VENDOR: /* 0x00 Vendor-dependent commands */ |
| status = avrc_pars_vendor_rsp(&p_msg->vendor, p_result); |
| break; |
| |
| case AVRC_OP_PASS_THRU: /* 0x7C panel subunit opcode */ |
| status = avrc_pars_pass_thru(&p_msg->pass, &id); |
| if (status == AVRC_STS_NO_ERROR) { |
| p_result->pdu = (uint8_t)id; |
| } |
| break; |
| |
| default: |
| AVRC_TRACE_ERROR("%s unknown opcode:0x%x", __func__, p_msg->hdr.opcode); |
| break; |
| } |
| p_result->rsp.opcode = p_msg->hdr.opcode; |
| p_result->rsp.status = status; |
| } |
| return status; |
| } |