The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
Evan Chu | e9629ba | 2014-01-31 11:18:47 -0500 | [diff] [blame] | 3 | * Copyright (C) 2010-2014 Broadcom Corporation |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 4 | * |
| 5 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 6 | * you may not use this file except in compliance with the License. |
| 7 | * You may obtain a copy of the License at: |
| 8 | * |
| 9 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 10 | * |
| 11 | * Unless required by applicable law or agreed to in writing, software |
| 12 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 13 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 14 | * See the License for the specific language governing permissions and |
| 15 | * limitations under the License. |
| 16 | * |
| 17 | ******************************************************************************/ |
| 18 | |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 19 | /****************************************************************************** |
| 20 | * |
| 21 | * This file contains the LLCP utilities |
| 22 | * |
| 23 | ******************************************************************************/ |
| 24 | |
| 25 | #include <string.h> |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 26 | |
| 27 | #include <android-base/stringprintf.h> |
| 28 | #include <base/logging.h> |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 29 | #include <log/log.h> |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 30 | |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 31 | #include "bt_types.h" |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 32 | #include "gki.h" |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 33 | #include "llcp_defs.h" |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 34 | #include "llcp_int.h" |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 35 | #include "nfc_int.h" |
| 36 | |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 37 | using android::base::StringPrintf; |
| 38 | |
| 39 | extern bool nfc_debug_enabled; |
| 40 | |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 41 | /******************************************************************************* |
| 42 | ** |
| 43 | ** Function llcp_util_parse_link_params |
| 44 | ** |
| 45 | ** Description Parse LLCP Link parameters |
| 46 | ** |
| 47 | ** Returns TRUE if success |
| 48 | ** |
| 49 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 50 | bool llcp_util_parse_link_params(uint16_t length, uint8_t* p_bytes) { |
| 51 | uint8_t param_type, param_len, *p = p_bytes; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 52 | |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 53 | while (length >= 2) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 54 | BE_STREAM_TO_UINT8(param_type, p); |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 55 | BE_STREAM_TO_UINT8(param_len, p); |
| 56 | if (length < param_len + 2) { |
| 57 | android_errorWriteLog(0x534e4554, "114238578"); |
| 58 | LOG(ERROR) << StringPrintf("Bad LTV's"); |
| 59 | return false; |
| 60 | } |
| 61 | length -= param_len + 2; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 62 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 63 | switch (param_type) { |
| 64 | case LLCP_VERSION_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 65 | BE_STREAM_TO_UINT8(llcp_cb.lcb.peer_version, p); |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 66 | DLOG_IF(INFO, nfc_debug_enabled) |
| 67 | << StringPrintf("Peer Version - 0x%02X", llcp_cb.lcb.peer_version); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 68 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 69 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 70 | case LLCP_MIUX_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 71 | BE_STREAM_TO_UINT16(llcp_cb.lcb.peer_miu, p); |
| 72 | llcp_cb.lcb.peer_miu &= LLCP_MIUX_MASK; |
| 73 | llcp_cb.lcb.peer_miu += LLCP_DEFAULT_MIU; |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 74 | DLOG_IF(INFO, nfc_debug_enabled) |
| 75 | << StringPrintf("Peer MIU - %d bytes", llcp_cb.lcb.peer_miu); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 76 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 77 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 78 | case LLCP_WKS_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 79 | BE_STREAM_TO_UINT16(llcp_cb.lcb.peer_wks, p); |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 80 | DLOG_IF(INFO, nfc_debug_enabled) |
| 81 | << StringPrintf("Peer WKS - 0x%04X", llcp_cb.lcb.peer_wks); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 82 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 83 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 84 | case LLCP_LTO_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 85 | BE_STREAM_TO_UINT8(llcp_cb.lcb.peer_lto, p); |
| 86 | llcp_cb.lcb.peer_lto *= LLCP_LTO_UNIT; /* 10ms unit */ |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 87 | DLOG_IF(INFO, nfc_debug_enabled) |
| 88 | << StringPrintf("Peer LTO - %d ms", llcp_cb.lcb.peer_lto); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 89 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 90 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 91 | case LLCP_OPT_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 92 | BE_STREAM_TO_UINT8(llcp_cb.lcb.peer_opt, p); |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 93 | DLOG_IF(INFO, nfc_debug_enabled) |
| 94 | << StringPrintf("Peer OPT - 0x%02X", llcp_cb.lcb.peer_opt); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 95 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 96 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 97 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 98 | LOG(ERROR) << StringPrintf("Unexpected type 0x%x", param_type); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 99 | p += param_len; |
| 100 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 101 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 102 | } |
| 103 | return true; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 104 | } |
| 105 | |
| 106 | /******************************************************************************* |
| 107 | ** |
| 108 | ** Function llcp_util_adjust_ll_congestion |
| 109 | ** |
| 110 | ** Description adjust tx/rx congestion thresholds on logical link |
| 111 | ** |
| 112 | ** Returns void |
| 113 | ** |
| 114 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 115 | void llcp_util_adjust_ll_congestion(void) { |
| 116 | /* buffer quota is allocated equally for each logical data link */ |
| 117 | if (llcp_cb.num_logical_data_link) { |
| 118 | llcp_cb.ll_tx_congest_start = |
| 119 | llcp_cb.max_num_ll_tx_buff / llcp_cb.num_logical_data_link; |
| 120 | llcp_cb.ll_rx_congest_start = |
| 121 | llcp_cb.max_num_ll_rx_buff / llcp_cb.num_logical_data_link; |
| 122 | } else { |
| 123 | llcp_cb.ll_tx_congest_start = llcp_cb.max_num_ll_tx_buff; |
| 124 | llcp_cb.ll_rx_congest_start = llcp_cb.max_num_ll_rx_buff; |
| 125 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 126 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 127 | /* at least one for each logical data link */ |
| 128 | if (llcp_cb.ll_tx_congest_start == 0) { |
| 129 | llcp_cb.ll_tx_congest_start = 1; |
| 130 | } |
| 131 | if (llcp_cb.ll_rx_congest_start == 0) { |
| 132 | llcp_cb.ll_rx_congest_start = 1; |
| 133 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 134 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 135 | if (llcp_cb.ll_tx_congest_start > 1) { |
| 136 | llcp_cb.ll_tx_congest_end = 1; |
| 137 | } else { |
| 138 | llcp_cb.ll_tx_congest_end = 0; |
| 139 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 140 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 141 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 142 | "num_logical_data_link=%d, ll_tx_congest_start=%d, ll_tx_congest_end=%d, " |
| 143 | "ll_rx_congest_start=%d", |
| 144 | llcp_cb.num_logical_data_link, llcp_cb.ll_tx_congest_start, |
| 145 | llcp_cb.ll_tx_congest_end, llcp_cb.ll_rx_congest_start); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 146 | } |
| 147 | |
| 148 | /******************************************************************************* |
| 149 | ** |
| 150 | ** Function llcp_util_adjust_dl_rx_congestion |
| 151 | ** |
| 152 | ** Description adjust rx congestion thresholds on data link |
| 153 | ** |
| 154 | ** Returns void |
| 155 | ** |
| 156 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 157 | void llcp_util_adjust_dl_rx_congestion(void) { |
| 158 | uint8_t idx, rx_congest_start; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 159 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 160 | if (llcp_cb.num_data_link_connection) { |
| 161 | rx_congest_start = llcp_cb.num_rx_buff / llcp_cb.num_data_link_connection; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 162 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 163 | for (idx = 0; idx < LLCP_MAX_DATA_LINK; idx++) { |
| 164 | if (llcp_cb.dlcb[idx].state == LLCP_DLC_STATE_CONNECTED) { |
| 165 | if (rx_congest_start > llcp_cb.dlcb[idx].local_rw) { |
| 166 | /* |
| 167 | ** set rx congestion threshold LLCP_DL_MIN_RX_CONGEST at |
| 168 | ** least so, we don't need to flow off too often. |
| 169 | */ |
| 170 | if (llcp_cb.dlcb[idx].local_rw + 1 > LLCP_DL_MIN_RX_CONGEST) |
| 171 | llcp_cb.dlcb[idx].rx_congest_threshold = |
| 172 | llcp_cb.dlcb[idx].local_rw + 1; |
| 173 | else |
| 174 | llcp_cb.dlcb[idx].rx_congest_threshold = LLCP_DL_MIN_RX_CONGEST; |
| 175 | } else { |
| 176 | llcp_cb.dlcb[idx].rx_congest_threshold = LLCP_DL_MIN_RX_CONGEST; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 177 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 178 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 179 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 180 | "DLC[%d], local_rw=%d, rx_congest_threshold=%d", idx, |
| 181 | llcp_cb.dlcb[idx].local_rw, llcp_cb.dlcb[idx].rx_congest_threshold); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 182 | } |
| 183 | } |
| 184 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 185 | } |
| 186 | |
| 187 | /******************************************************************************* |
| 188 | ** |
| 189 | ** Function llcp_util_check_rx_congested_status |
| 190 | ** |
| 191 | ** Description Update rx congested status |
| 192 | ** |
| 193 | ** Returns void |
| 194 | ** |
| 195 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 196 | void llcp_util_check_rx_congested_status(void) { |
| 197 | uint8_t idx; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 198 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 199 | if (llcp_cb.overall_rx_congested) { |
| 200 | /* check if rx congestion clear */ |
| 201 | if (llcp_cb.total_rx_ui_pdu + llcp_cb.total_rx_i_pdu <= |
| 202 | llcp_cb.overall_rx_congest_end) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 203 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 204 | "rx link is uncongested, " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 205 | "%d+%d <= %d", |
| 206 | llcp_cb.total_rx_ui_pdu, llcp_cb.total_rx_i_pdu, |
| 207 | llcp_cb.overall_rx_congest_end); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 208 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 209 | llcp_cb.overall_rx_congested = false; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 210 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 211 | for (idx = 0; idx < LLCP_MAX_DATA_LINK; idx++) { |
| 212 | /* set flag to clear local busy status on data link connections */ |
| 213 | if ((llcp_cb.dlcb[idx].state == LLCP_DLC_STATE_CONNECTED) && |
| 214 | (llcp_cb.dlcb[idx].is_rx_congested == false)) { |
| 215 | llcp_cb.dlcb[idx].flags |= LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 216 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 217 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 218 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 219 | } else { |
| 220 | /* check if rx link is congested */ |
| 221 | if (llcp_cb.total_rx_ui_pdu + llcp_cb.total_rx_i_pdu >= |
| 222 | llcp_cb.overall_rx_congest_start) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 223 | LOG(WARNING) << StringPrintf( |
| 224 | "rx link is congested, %d+%d " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 225 | ">= %d", |
| 226 | llcp_cb.total_rx_ui_pdu, llcp_cb.total_rx_i_pdu, |
| 227 | llcp_cb.overall_rx_congest_start); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 228 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 229 | llcp_cb.overall_rx_congested = true; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 230 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 231 | /* rx link congestion is started, send RNR to remote end point */ |
| 232 | for (idx = 0; idx < LLCP_MAX_DATA_LINK; idx++) { |
| 233 | if ((llcp_cb.dlcb[idx].state == LLCP_DLC_STATE_CONNECTED) && |
| 234 | (llcp_cb.dlcb[idx].is_rx_congested == false)) { |
| 235 | llcp_cb.dlcb[idx].flags |= LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 236 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 237 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 238 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 239 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 240 | } |
| 241 | |
| 242 | /******************************************************************************* |
| 243 | ** |
| 244 | ** Function llcp_util_send_ui |
| 245 | ** |
| 246 | ** Description Send UI PDU |
| 247 | ** |
| 248 | ** Returns tLLCP_STATUS |
| 249 | ** |
| 250 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 251 | tLLCP_STATUS llcp_util_send_ui(uint8_t ssap, uint8_t dsap, |
| 252 | tLLCP_APP_CB* p_app_cb, NFC_HDR* p_msg) { |
| 253 | uint8_t* p; |
| 254 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 255 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 256 | p_msg->offset -= LLCP_PDU_HEADER_SIZE; |
| 257 | p_msg->len += LLCP_PDU_HEADER_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 258 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 259 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 260 | UINT16_TO_BE_STREAM(p, LLCP_GET_PDU_HEADER(dsap, LLCP_PDU_UI_TYPE, ssap)); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 261 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 262 | GKI_enqueue(&p_app_cb->ui_xmit_q, p_msg); |
| 263 | llcp_cb.total_tx_ui_pdu++; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 264 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 265 | llcp_link_check_send_data(); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 266 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 267 | if ((p_app_cb->is_ui_tx_congested) || |
| 268 | (p_app_cb->ui_xmit_q.count >= llcp_cb.ll_tx_congest_start) || |
| 269 | (llcp_cb.overall_tx_congested) || |
| 270 | (llcp_cb.total_tx_ui_pdu >= llcp_cb.max_num_ll_tx_buff)) { |
| 271 | /* set congested here so overall congestion check routine will not report |
| 272 | * event again, */ |
| 273 | /* or notify uncongestion later */ |
| 274 | p_app_cb->is_ui_tx_congested = true; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 275 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 276 | LOG(WARNING) << StringPrintf( |
| 277 | "Logical link (SAP=0x%X) congested: ui_xmit_q.count=%d", ssap, |
| 278 | p_app_cb->ui_xmit_q.count); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 279 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 280 | status = LLCP_STATUS_CONGESTED; |
| 281 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 282 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 283 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 284 | } |
| 285 | |
| 286 | /******************************************************************************* |
| 287 | ** |
| 288 | ** Function llcp_util_send_disc |
| 289 | ** |
| 290 | ** Description Send DISC PDU |
| 291 | ** |
| 292 | ** Returns void |
| 293 | ** |
| 294 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 295 | void llcp_util_send_disc(uint8_t dsap, uint8_t ssap) { |
| 296 | NFC_HDR* p_msg; |
| 297 | uint8_t* p; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 298 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 299 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 300 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 301 | if (p_msg) { |
| 302 | p_msg->len = LLCP_PDU_DISC_SIZE; |
| 303 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 304 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 305 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 306 | UINT16_TO_BE_STREAM(p, LLCP_GET_PDU_HEADER(dsap, LLCP_PDU_DISC_TYPE, ssap)); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 307 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 308 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 309 | llcp_link_check_send_data(); |
| 310 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 311 | } |
| 312 | |
| 313 | /******************************************************************************* |
| 314 | ** |
| 315 | ** Function llcp_util_allocate_data_link |
| 316 | ** |
| 317 | ** Description Allocate tLLCP_DLCB for data link connection |
| 318 | ** |
| 319 | ** Returns tLLCP_DLCB * |
| 320 | ** |
| 321 | ******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 322 | tLLCP_DLCB* llcp_util_allocate_data_link(uint8_t reg_sap, uint8_t remote_sap) { |
| 323 | tLLCP_DLCB* p_dlcb = NULL; |
| 324 | int idx; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 325 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 326 | DLOG_IF(INFO, nfc_debug_enabled) |
| 327 | << StringPrintf("reg_sap = 0x%x, remote_sap = 0x%x", reg_sap, remote_sap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 328 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 329 | for (idx = 0; idx < LLCP_MAX_DATA_LINK; idx++) { |
| 330 | if (llcp_cb.dlcb[idx].state == LLCP_DLC_STATE_IDLE) { |
| 331 | p_dlcb = &(llcp_cb.dlcb[idx]); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 332 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 333 | memset(p_dlcb, 0, sizeof(tLLCP_DLCB)); |
| 334 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 335 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 336 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 337 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 338 | if (!p_dlcb) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 339 | LOG(ERROR) << StringPrintf("Out of DLCB"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 340 | } else { |
| 341 | p_dlcb->p_app_cb = llcp_util_get_app_cb(reg_sap); |
| 342 | p_dlcb->local_sap = reg_sap; |
| 343 | p_dlcb->remote_sap = remote_sap; |
| 344 | p_dlcb->timer.param = (uintptr_t)p_dlcb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 345 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 346 | /* this is for inactivity timer and congestion control. */ |
| 347 | llcp_cb.num_data_link_connection++; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 348 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 349 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 350 | "local_sap = 0x%x, remote_sap = 0x%x, " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 351 | "num_data_link_connection = %d", |
| 352 | p_dlcb->local_sap, p_dlcb->remote_sap, |
| 353 | llcp_cb.num_data_link_connection); |
| 354 | } |
| 355 | return p_dlcb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 356 | } |
| 357 | |
| 358 | /******************************************************************************* |
| 359 | ** |
| 360 | ** Function llcp_util_deallocate_data_link |
| 361 | ** |
| 362 | ** Description Deallocate tLLCP_DLCB |
| 363 | ** |
| 364 | ** Returns void |
| 365 | ** |
| 366 | ******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 367 | void llcp_util_deallocate_data_link(tLLCP_DLCB* p_dlcb) { |
| 368 | if (p_dlcb) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 369 | DLOG_IF(INFO, nfc_debug_enabled) |
| 370 | << StringPrintf("local_sap = 0x%x", p_dlcb->local_sap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 371 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 372 | if (p_dlcb->state != LLCP_DLC_STATE_IDLE) { |
| 373 | nfc_stop_quick_timer(&p_dlcb->timer); |
| 374 | llcp_dlc_flush_q(p_dlcb); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 375 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 376 | p_dlcb->state = LLCP_DLC_STATE_IDLE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 377 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 378 | if (llcp_cb.num_data_link_connection > 0) { |
| 379 | llcp_cb.num_data_link_connection--; |
| 380 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 381 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 382 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 383 | "num_data_link_connection = %d", llcp_cb.num_data_link_connection); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 384 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 385 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 386 | } |
| 387 | |
| 388 | /******************************************************************************* |
| 389 | ** |
| 390 | ** Function llcp_util_send_connect |
| 391 | ** |
| 392 | ** Description Send CONNECT PDU |
| 393 | ** |
| 394 | ** Returns tLLCP_STATUS |
| 395 | ** |
| 396 | ******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 397 | tLLCP_STATUS llcp_util_send_connect(tLLCP_DLCB* p_dlcb, |
| 398 | tLLCP_CONNECTION_PARAMS* p_params) { |
| 399 | NFC_HDR* p_msg; |
| 400 | uint8_t* p; |
| 401 | uint16_t miu_len = 0, rw_len = 0, sn_len = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 402 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 403 | if (p_params->miu != LLCP_DEFAULT_MIU) { |
| 404 | miu_len = 4; /* TYPE, LEN, 2 bytes MIU */ |
| 405 | } |
| 406 | if (p_params->rw != LLCP_DEFAULT_RW) { |
| 407 | rw_len = 3; /* TYPE, LEN, 1 byte RW */ |
| 408 | p_params->rw &= 0x0F; /* only 4 bits */ |
| 409 | } |
| 410 | if ((strlen(p_params->sn)) && (p_dlcb->remote_sap == LLCP_SAP_SDP)) { |
| 411 | sn_len = (uint16_t)(2 + strlen(p_params->sn)); /* TYPE, LEN, SN */ |
| 412 | } |
| 413 | |
| 414 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
| 415 | |
| 416 | if (p_msg) { |
| 417 | p_msg->len = LLCP_PDU_HEADER_SIZE + miu_len + rw_len + sn_len; |
| 418 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
| 419 | |
| 420 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 421 | |
| 422 | UINT16_TO_BE_STREAM( |
| 423 | p, LLCP_GET_PDU_HEADER(p_dlcb->remote_sap, LLCP_PDU_CONNECT_TYPE, |
| 424 | p_dlcb->local_sap)); |
| 425 | |
| 426 | if (miu_len) { |
| 427 | UINT8_TO_BE_STREAM(p, LLCP_MIUX_TYPE); |
| 428 | UINT8_TO_BE_STREAM(p, LLCP_MIUX_LEN); |
| 429 | UINT16_TO_BE_STREAM(p, p_params->miu - LLCP_DEFAULT_MIU); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 430 | } |
| 431 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 432 | if (rw_len) { |
| 433 | UINT8_TO_BE_STREAM(p, LLCP_RW_TYPE); |
| 434 | UINT8_TO_BE_STREAM(p, LLCP_RW_LEN); |
| 435 | UINT8_TO_BE_STREAM(p, p_params->rw); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 436 | } |
| 437 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 438 | if (sn_len) { |
| 439 | UINT8_TO_BE_STREAM(p, LLCP_SN_TYPE); |
| 440 | UINT8_TO_BE_STREAM(p, sn_len - 2); |
| 441 | memcpy(p, p_params->sn, sn_len - 2); |
| 442 | } |
| 443 | |
| 444 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 445 | llcp_link_check_send_data(); |
| 446 | |
| 447 | return LLCP_STATUS_SUCCESS; |
| 448 | } |
| 449 | |
| 450 | return LLCP_STATUS_FAIL; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 451 | } |
| 452 | |
| 453 | /******************************************************************************* |
| 454 | ** |
| 455 | ** Function llcp_util_parse_connect |
| 456 | ** |
| 457 | ** Description Parse CONNECT PDU |
| 458 | ** |
| 459 | ** Returns tLLCP_STATUS |
| 460 | ** |
| 461 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 462 | tLLCP_STATUS llcp_util_parse_connect(uint8_t* p_bytes, uint16_t length, |
| 463 | tLLCP_CONNECTION_PARAMS* p_params) { |
| 464 | uint8_t param_type, param_len, *p = p_bytes; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 465 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 466 | p_params->miu = LLCP_DEFAULT_MIU; |
| 467 | p_params->rw = LLCP_DEFAULT_RW; |
| 468 | p_params->sn[0] = 0; |
| 469 | p_params->sn[1] = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 470 | |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 471 | while (length >= 2) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 472 | BE_STREAM_TO_UINT8(param_type, p); |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 473 | BE_STREAM_TO_UINT8(param_len, p); |
| 474 | /* check remaining lengh */ |
| 475 | if (length < param_len + 2) { |
| 476 | android_errorWriteLog(0x534e4554, "111660010"); |
| 477 | LOG(ERROR) << StringPrintf("Bad LTV's"); |
| 478 | return LLCP_STATUS_FAIL; |
| 479 | } |
| 480 | length -= param_len + 2; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 481 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 482 | switch (param_type) { |
| 483 | case LLCP_MIUX_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 484 | BE_STREAM_TO_UINT16(p_params->miu, p); |
| 485 | p_params->miu &= LLCP_MIUX_MASK; |
| 486 | p_params->miu += LLCP_DEFAULT_MIU; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 487 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 488 | DLOG_IF(INFO, nfc_debug_enabled) |
| 489 | << StringPrintf("LLCP_MIUX_TYPE:%d", p_params->miu); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 490 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 491 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 492 | case LLCP_RW_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 493 | BE_STREAM_TO_UINT8(p_params->rw, p); |
| 494 | p_params->rw &= 0x0F; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 495 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 496 | DLOG_IF(INFO, nfc_debug_enabled) |
| 497 | << StringPrintf("LLCP_RW_TYPE:%d", p_params->rw); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 498 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 499 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 500 | case LLCP_SN_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 501 | if (param_len == 0) { |
| 502 | /* indicate that SN type is included without SN */ |
| 503 | p_params->sn[1] = LLCP_SN_TYPE; |
| 504 | } else if (param_len <= LLCP_MAX_SN_LEN) { |
| 505 | memcpy(p_params->sn, p, param_len); |
| 506 | p_params->sn[param_len] = 0; |
| 507 | } else { |
| 508 | memcpy(p_params->sn, p, LLCP_MAX_SN_LEN); |
| 509 | p_params->sn[LLCP_MAX_SN_LEN] = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 510 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 511 | p += param_len; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 512 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 513 | DLOG_IF(INFO, nfc_debug_enabled) |
| 514 | << StringPrintf("LLCP_SN_TYPE:<%s>", p_params->sn); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 515 | break; |
| 516 | |
| 517 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 518 | LOG(ERROR) << StringPrintf("Unexpected type 0x%x", param_type); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 519 | p += param_len; |
| 520 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 521 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 522 | } |
| 523 | return LLCP_STATUS_SUCCESS; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 524 | } |
| 525 | |
| 526 | /******************************************************************************* |
| 527 | ** |
| 528 | ** Function llcp_util_send_cc |
| 529 | ** |
| 530 | ** Description Send CC PDU |
| 531 | ** |
| 532 | ** Returns tLLCP_STATUS |
| 533 | ** |
| 534 | ******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 535 | tLLCP_STATUS llcp_util_send_cc(tLLCP_DLCB* p_dlcb, |
| 536 | tLLCP_CONNECTION_PARAMS* p_params) { |
| 537 | NFC_HDR* p_msg; |
| 538 | uint8_t* p; |
| 539 | uint16_t miu_len = 0, rw_len = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 540 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 541 | if (p_params->miu != LLCP_DEFAULT_MIU) { |
| 542 | miu_len = 4; |
| 543 | } |
| 544 | if (p_params->rw != LLCP_DEFAULT_RW) { |
| 545 | rw_len = 3; |
| 546 | p_params->rw &= 0x0F; |
| 547 | } |
| 548 | |
| 549 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
| 550 | |
| 551 | if (p_msg) { |
| 552 | p_msg->len = LLCP_PDU_HEADER_SIZE + miu_len + rw_len; |
| 553 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
| 554 | |
| 555 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 556 | |
| 557 | UINT16_TO_BE_STREAM( |
| 558 | p, LLCP_GET_PDU_HEADER(p_dlcb->remote_sap, LLCP_PDU_CC_TYPE, |
| 559 | p_dlcb->local_sap)); |
| 560 | |
| 561 | if (miu_len) { |
| 562 | UINT8_TO_BE_STREAM(p, LLCP_MIUX_TYPE); |
| 563 | UINT8_TO_BE_STREAM(p, LLCP_MIUX_LEN); |
| 564 | UINT16_TO_BE_STREAM(p, p_params->miu - LLCP_DEFAULT_MIU); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 565 | } |
| 566 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 567 | if (rw_len) { |
| 568 | UINT8_TO_BE_STREAM(p, LLCP_RW_TYPE); |
| 569 | UINT8_TO_BE_STREAM(p, LLCP_RW_LEN); |
| 570 | UINT8_TO_BE_STREAM(p, p_params->rw); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 571 | } |
| 572 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 573 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 574 | llcp_link_check_send_data(); |
| 575 | |
| 576 | return LLCP_STATUS_SUCCESS; |
| 577 | } |
| 578 | |
| 579 | return LLCP_STATUS_FAIL; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 580 | } |
| 581 | |
| 582 | /******************************************************************************* |
| 583 | ** |
| 584 | ** Function llcp_util_parse_cc |
| 585 | ** |
| 586 | ** Description Parse CC PDU |
| 587 | ** |
| 588 | ** Returns tLLCP_STATUS |
| 589 | ** |
| 590 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 591 | tLLCP_STATUS llcp_util_parse_cc(uint8_t* p_bytes, uint16_t length, |
| 592 | uint16_t* p_miu, uint8_t* p_rw) { |
| 593 | uint8_t param_type, param_len, *p = p_bytes; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 594 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 595 | *p_miu = LLCP_DEFAULT_MIU; |
| 596 | *p_rw = LLCP_DEFAULT_RW; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 597 | |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 598 | while (length >= 2) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 599 | BE_STREAM_TO_UINT8(param_type, p); |
Ruchi Kandoi | 8f404a4 | 2018-09-14 15:42:46 -0700 | [diff] [blame^] | 600 | BE_STREAM_TO_UINT8(param_len, p); |
| 601 | if (length < param_len + 2) { |
| 602 | android_errorWriteLog(0x534e4554, "114237888"); |
| 603 | LOG(ERROR) << StringPrintf("Bad LTV's"); |
| 604 | return LLCP_STATUS_FAIL; |
| 605 | } |
| 606 | length -= param_len + 2; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 607 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 608 | switch (param_type) { |
| 609 | case LLCP_MIUX_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 610 | BE_STREAM_TO_UINT16((*p_miu), p); |
| 611 | (*p_miu) &= LLCP_MIUX_MASK; |
| 612 | (*p_miu) += LLCP_DEFAULT_MIU; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 613 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 614 | DLOG_IF(INFO, nfc_debug_enabled) |
| 615 | << StringPrintf("LLCP_MIUX_TYPE:%d", *p_miu); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 616 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 617 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 618 | case LLCP_RW_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 619 | BE_STREAM_TO_UINT8((*p_rw), p); |
| 620 | (*p_rw) &= 0x0F; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 621 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 622 | DLOG_IF(INFO, nfc_debug_enabled) |
| 623 | << StringPrintf("LLCP_RW_TYPE:%d", *p_rw); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 624 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 625 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 626 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 627 | LOG(ERROR) << StringPrintf("Unexpected type 0x%x", param_type); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 628 | p += param_len; |
| 629 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 630 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 631 | } |
| 632 | return LLCP_STATUS_SUCCESS; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 633 | } |
| 634 | |
| 635 | /******************************************************************************* |
| 636 | ** |
| 637 | ** Function llcp_util_send_dm |
| 638 | ** |
| 639 | ** Description Send DM PDU |
| 640 | ** |
| 641 | ** Returns void |
| 642 | ** |
| 643 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 644 | void llcp_util_send_dm(uint8_t dsap, uint8_t ssap, uint8_t reason) { |
| 645 | NFC_HDR* p_msg; |
| 646 | uint8_t* p; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 647 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 648 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 649 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 650 | if (p_msg) { |
| 651 | p_msg->len = LLCP_PDU_DM_SIZE; |
| 652 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 653 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 654 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 655 | UINT16_TO_BE_STREAM(p, LLCP_GET_PDU_HEADER(dsap, LLCP_PDU_DM_TYPE, ssap)); |
| 656 | UINT8_TO_BE_STREAM(p, reason); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 657 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 658 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 659 | llcp_link_check_send_data(); |
| 660 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 661 | } |
| 662 | |
| 663 | /******************************************************************************* |
| 664 | ** |
| 665 | ** Function llcp_util_build_info_pdu |
| 666 | ** |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 667 | ** Description Add DSAP, PTYPE, SSAP and sequence numbers and update local |
| 668 | ** ack sequence |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 669 | ** |
| 670 | ** Returns void |
| 671 | ** |
| 672 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 673 | void llcp_util_build_info_pdu(tLLCP_DLCB* p_dlcb, NFC_HDR* p_msg) { |
| 674 | uint8_t* p; |
| 675 | uint8_t rcv_seq; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 676 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 677 | p_msg->offset -= LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE; |
| 678 | p_msg->len += LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE; |
| 679 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 680 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 681 | UINT16_TO_BE_STREAM(p, |
| 682 | LLCP_GET_PDU_HEADER(p_dlcb->remote_sap, LLCP_PDU_I_TYPE, |
| 683 | p_dlcb->local_sap)); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 684 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 685 | /* if local_busy or rx congested then do not update receive sequence number to |
| 686 | * flow off */ |
| 687 | if ((p_dlcb->local_busy) || (p_dlcb->is_rx_congested) || |
| 688 | (llcp_cb.overall_rx_congested)) { |
| 689 | rcv_seq = p_dlcb->sent_ack_seq; |
| 690 | } else { |
| 691 | p_dlcb->sent_ack_seq = p_dlcb->next_rx_seq; |
| 692 | rcv_seq = p_dlcb->sent_ack_seq; |
| 693 | } |
| 694 | UINT8_TO_BE_STREAM(p, LLCP_GET_SEQUENCE(p_dlcb->next_tx_seq, rcv_seq)); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 695 | } |
| 696 | |
| 697 | /******************************************************************************* |
| 698 | ** |
| 699 | ** Function llcp_util_send_frmr |
| 700 | ** |
| 701 | ** Description Send FRMR PDU |
| 702 | ** |
| 703 | ** Returns tLLCP_STATUS |
| 704 | ** |
| 705 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 706 | tLLCP_STATUS llcp_util_send_frmr(tLLCP_DLCB* p_dlcb, uint8_t flags, |
| 707 | uint8_t ptype, uint8_t sequence) { |
| 708 | NFC_HDR* p_msg; |
| 709 | uint8_t* p; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 710 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 711 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 712 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 713 | if (p_msg) { |
| 714 | p_msg->len = LLCP_PDU_FRMR_SIZE; |
| 715 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 716 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 717 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 718 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 719 | UINT16_TO_BE_STREAM( |
| 720 | p, LLCP_GET_PDU_HEADER(p_dlcb->remote_sap, LLCP_PDU_FRMR_TYPE, |
| 721 | p_dlcb->local_sap)); |
| 722 | UINT8_TO_BE_STREAM(p, (flags << 4) | ptype); |
| 723 | UINT8_TO_BE_STREAM(p, sequence); |
| 724 | UINT8_TO_BE_STREAM(p, (p_dlcb->next_tx_seq << 4) | p_dlcb->next_rx_seq); |
| 725 | UINT8_TO_BE_STREAM(p, (p_dlcb->rcvd_ack_seq << 4) | p_dlcb->sent_ack_seq); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 726 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 727 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 728 | llcp_link_check_send_data(); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 729 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 730 | return LLCP_STATUS_SUCCESS; |
| 731 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 732 | LOG(ERROR) << StringPrintf("Out of resource"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 733 | return LLCP_STATUS_FAIL; |
| 734 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 735 | } |
| 736 | |
| 737 | /******************************************************************************* |
| 738 | ** |
| 739 | ** Function llcp_util_send_rr_rnr |
| 740 | ** |
| 741 | ** Description Send RR or RNR PDU |
| 742 | ** |
| 743 | ** Returns void |
| 744 | ** |
| 745 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 746 | void llcp_util_send_rr_rnr(tLLCP_DLCB* p_dlcb) { |
| 747 | NFC_HDR* p_msg; |
| 748 | uint8_t* p; |
| 749 | uint8_t pdu_type; |
| 750 | uint8_t pdu_size; |
| 751 | uint8_t rcv_seq; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 752 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 753 | /* if no indication of change in local busy or rx congestion */ |
| 754 | if ((p_dlcb->flags & LLCP_DATA_LINK_FLAG_PENDING_RR_RNR) == 0) { |
| 755 | /* if all ack is sent */ |
| 756 | if (p_dlcb->sent_ack_seq == p_dlcb->next_rx_seq) { |
| 757 | /* we don't need to send RR/RNR */ |
| 758 | return; |
| 759 | } else { |
| 760 | /* if rx flow off because of local busy or congestion */ |
| 761 | if ((p_dlcb->local_busy) || (p_dlcb->is_rx_congested) || |
| 762 | (llcp_cb.overall_rx_congested)) { |
| 763 | /* don't send RR/RNR */ |
| 764 | return; |
| 765 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 766 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 767 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 768 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 769 | if ((p_dlcb->local_busy) || (p_dlcb->is_rx_congested) || |
| 770 | (llcp_cb.overall_rx_congested)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 771 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 772 | "" |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 773 | "local_busy=%d,is_rx_congested=%d,overall_rx_congested=%d", |
| 774 | p_dlcb->local_busy, p_dlcb->is_rx_congested, |
| 775 | llcp_cb.overall_rx_congested); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 776 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 777 | /* if local_busy or rx congested then do not update receive sequence number |
| 778 | * to flow off */ |
| 779 | pdu_type = LLCP_PDU_RNR_TYPE; |
| 780 | pdu_size = LLCP_PDU_RNR_SIZE; |
| 781 | rcv_seq = p_dlcb->sent_ack_seq; |
| 782 | } else { |
| 783 | pdu_type = LLCP_PDU_RR_TYPE; |
| 784 | pdu_size = LLCP_PDU_RR_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 785 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 786 | p_dlcb->sent_ack_seq = p_dlcb->next_rx_seq; |
| 787 | rcv_seq = p_dlcb->sent_ack_seq; |
| 788 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 789 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 790 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 791 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 792 | if (p_msg) { |
| 793 | p_dlcb->flags &= ~LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 794 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 795 | p_msg->len = pdu_size; |
| 796 | p_msg->offset = NCI_MSG_OFFSET_SIZE + NCI_DATA_HDR_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 797 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 798 | p = (uint8_t*)(p_msg + 1) + p_msg->offset; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 799 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 800 | UINT16_TO_BE_STREAM(p, LLCP_GET_PDU_HEADER(p_dlcb->remote_sap, pdu_type, |
| 801 | p_dlcb->local_sap)); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 802 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 803 | UINT8_TO_BE_STREAM(p, rcv_seq); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 804 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 805 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 806 | "LLCP TX - N(S,R):(NA,%d) V(S,SA,R,RA):(%d,%d,%d,%d)", |
| 807 | p_dlcb->next_rx_seq, p_dlcb->next_tx_seq, p_dlcb->rcvd_ack_seq, |
| 808 | p_dlcb->next_rx_seq, p_dlcb->sent_ack_seq); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 809 | GKI_enqueue(&llcp_cb.lcb.sig_xmit_q, p_msg); |
| 810 | llcp_link_check_send_data(); |
| 811 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 812 | LOG(ERROR) << StringPrintf("Out of resource"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 813 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 814 | } |
| 815 | |
| 816 | /******************************************************************************* |
| 817 | ** |
| 818 | ** Function llcp_util_get_app_cb |
| 819 | ** |
| 820 | ** Description get pointer of application registered control block by SAP |
| 821 | ** |
| 822 | ** Returns tLLCP_APP_CB * |
| 823 | ** |
| 824 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 825 | tLLCP_APP_CB* llcp_util_get_app_cb(uint8_t local_sap) { |
| 826 | tLLCP_APP_CB* p_app_cb = NULL; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 827 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 828 | if (local_sap <= LLCP_UPPER_BOUND_WK_SAP) { |
| 829 | if ((local_sap != LLCP_SAP_LM) && (local_sap < LLCP_MAX_WKS)) { |
| 830 | p_app_cb = &llcp_cb.wks_cb[local_sap]; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 831 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 832 | } else if (local_sap <= LLCP_UPPER_BOUND_SDP_SAP) { |
| 833 | if (local_sap - LLCP_LOWER_BOUND_SDP_SAP < LLCP_MAX_SERVER) { |
| 834 | p_app_cb = &llcp_cb.server_cb[local_sap - LLCP_LOWER_BOUND_SDP_SAP]; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 835 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 836 | } else if (local_sap <= LLCP_UPPER_BOUND_LOCAL_SAP) { |
| 837 | if (local_sap - LLCP_LOWER_BOUND_LOCAL_SAP < LLCP_MAX_CLIENT) { |
| 838 | p_app_cb = &llcp_cb.client_cb[local_sap - LLCP_LOWER_BOUND_LOCAL_SAP]; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 839 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 840 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 841 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 842 | return (p_app_cb); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 843 | } |