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 | |
| 19 | /****************************************************************************** |
| 20 | * |
| 21 | * This file contains the LLCP Data Link Connection Management |
| 22 | * |
| 23 | ******************************************************************************/ |
| 24 | |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 25 | #include <string> |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 26 | |
| 27 | #include <android-base/stringprintf.h> |
| 28 | #include <base/logging.h> |
George Chang | 0487ca4 | 2018-10-16 17:10:42 +0800 | [diff] [blame^] | 29 | #include <log/log.h> |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 30 | #include "bt_types.h" |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 31 | #include "gki.h" |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 32 | #include "llcp_defs.h" |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 33 | #include "llcp_int.h" |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 34 | #include "nfc_int.h" |
| 35 | |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 36 | using android::base::StringPrintf; |
| 37 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 38 | static tLLCP_STATUS llcp_dlsm_idle(tLLCP_DLCB* p_dlcb, tLLCP_DLC_EVENT event, |
| 39 | void* p_data); |
| 40 | static tLLCP_STATUS llcp_dlsm_w4_remote_resp(tLLCP_DLCB* p_dlcb, |
| 41 | tLLCP_DLC_EVENT event, |
| 42 | void* p_data); |
| 43 | static tLLCP_STATUS llcp_dlsm_w4_local_resp(tLLCP_DLCB* p_dlcb, |
| 44 | tLLCP_DLC_EVENT event, |
| 45 | void* p_data); |
| 46 | static tLLCP_STATUS llcp_dlsm_connected(tLLCP_DLCB* p_dlcb, |
| 47 | tLLCP_DLC_EVENT event, void* p_data); |
| 48 | static tLLCP_STATUS llcp_dlsm_w4_remote_dm(tLLCP_DLCB* p_dlcb, |
Ruchi Kandoi | 9ba6d24 | 2017-10-13 16:07:01 -0700 | [diff] [blame] | 49 | tLLCP_DLC_EVENT event); |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 50 | static std::string llcp_dlsm_get_state_name(tLLCP_DLC_STATE state); |
| 51 | static std::string llcp_dlsm_get_event_name(tLLCP_DLC_EVENT event); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 52 | |
Andre Eisenbach | 8a4edf6 | 2017-11-20 14:51:11 -0800 | [diff] [blame] | 53 | extern bool nfc_debug_enabled; |
| 54 | extern unsigned char appl_dta_mode_flag; |
| 55 | |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 56 | /******************************************************************************* |
| 57 | ** |
| 58 | ** Function llcp_dlsm_execute |
| 59 | ** |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 60 | ** Description This function executes the state machine for data link |
| 61 | ** connection. |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 62 | ** |
| 63 | ** Returns tLLCP_STATUS |
| 64 | ** |
| 65 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 66 | tLLCP_STATUS llcp_dlsm_execute(tLLCP_DLCB* p_dlcb, tLLCP_DLC_EVENT event, |
| 67 | void* p_data) { |
| 68 | tLLCP_STATUS status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 69 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 70 | DLOG_IF(INFO, nfc_debug_enabled) |
| 71 | << StringPrintf("DLC (0x%02X) - state: %s, evt: %s", p_dlcb->local_sap, |
| 72 | llcp_dlsm_get_state_name(p_dlcb->state).c_str(), |
| 73 | llcp_dlsm_get_event_name(event).c_str()); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 74 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 75 | switch (p_dlcb->state) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 76 | case LLCP_DLC_STATE_IDLE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 77 | status = llcp_dlsm_idle(p_dlcb, event, p_data); |
| 78 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 79 | |
| 80 | case LLCP_DLC_STATE_W4_REMOTE_RESP: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 81 | status = llcp_dlsm_w4_remote_resp(p_dlcb, event, p_data); |
| 82 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 83 | |
| 84 | case LLCP_DLC_STATE_W4_LOCAL_RESP: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 85 | status = llcp_dlsm_w4_local_resp(p_dlcb, event, p_data); |
| 86 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 87 | |
| 88 | case LLCP_DLC_STATE_CONNECTED: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 89 | status = llcp_dlsm_connected(p_dlcb, event, p_data); |
| 90 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 91 | |
| 92 | case LLCP_DLC_STATE_W4_REMOTE_DM: |
Ruchi Kandoi | 9ba6d24 | 2017-10-13 16:07:01 -0700 | [diff] [blame] | 93 | status = llcp_dlsm_w4_remote_dm(p_dlcb, event); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 94 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 95 | |
| 96 | default: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 97 | status = LLCP_STATUS_FAIL; |
| 98 | break; |
| 99 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 100 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 101 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 102 | } |
| 103 | |
| 104 | /******************************************************************************* |
| 105 | ** |
| 106 | ** Function llcp_dlsm_idle |
| 107 | ** |
| 108 | ** Description Data link connection is in idle state |
| 109 | ** |
| 110 | ** Returns tLLCP_STATUS |
| 111 | ** |
| 112 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 113 | static tLLCP_STATUS llcp_dlsm_idle(tLLCP_DLCB* p_dlcb, tLLCP_DLC_EVENT event, |
| 114 | void* p_data) { |
| 115 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
| 116 | tLLCP_SAP_CBACK_DATA data; |
| 117 | tLLCP_CONNECTION_PARAMS* p_params; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 118 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 119 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 120 | case LLCP_DLC_EVENT_API_CONNECT_REQ: |
| 121 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 122 | /* upper layer requests to create data link connection */ |
| 123 | p_params = (tLLCP_CONNECTION_PARAMS*)p_data; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 124 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 125 | status = llcp_util_send_connect(p_dlcb, p_params); |
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 | if (status == LLCP_STATUS_SUCCESS) { |
| 128 | p_dlcb->local_miu = p_params->miu; |
| 129 | p_dlcb->local_rw = p_params->rw; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 130 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 131 | /* wait for response from peer device */ |
| 132 | p_dlcb->state = LLCP_DLC_STATE_W4_REMOTE_RESP; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 133 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 134 | nfc_start_quick_timer(&p_dlcb->timer, NFC_TTYPE_LLCP_DATA_LINK, |
| 135 | (uint32_t)(llcp_cb.lcb.data_link_timeout * |
| 136 | QUICK_TIMER_TICKS_PER_SEC) / |
| 137 | 1000); |
| 138 | } |
| 139 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 140 | |
| 141 | case LLCP_DLC_EVENT_PEER_CONNECT_IND: |
| 142 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 143 | /* peer device requests to create data link connection */ |
| 144 | p_params = (tLLCP_CONNECTION_PARAMS*)p_data; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 145 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 146 | if (p_params->miu > llcp_cb.lcb.peer_miu) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 147 | LOG(WARNING) << StringPrintf( |
| 148 | "Peer sent data link MIU bigger than peer's " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 149 | "link MIU"); |
| 150 | p_params->miu = llcp_cb.lcb.peer_miu; |
| 151 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 152 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 153 | data.connect_ind.event = LLCP_SAP_EVT_CONNECT_IND; |
| 154 | data.connect_ind.remote_sap = p_dlcb->remote_sap; |
| 155 | data.connect_ind.local_sap = p_dlcb->local_sap; |
| 156 | data.connect_ind.miu = p_params->miu; |
| 157 | data.connect_ind.rw = p_params->rw; |
| 158 | data.connect_ind.p_service_name = p_params->sn; |
| 159 | data.connect_ind.server_sap = p_dlcb->local_sap; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 160 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 161 | p_dlcb->remote_miu = p_params->miu; |
| 162 | p_dlcb->remote_rw = p_params->rw; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 163 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 164 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 165 | "Remote MIU:%d, RW:%d", p_dlcb->remote_miu, p_dlcb->remote_rw); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 166 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 167 | /* wait for response from upper layer */ |
| 168 | p_dlcb->state = LLCP_DLC_STATE_W4_LOCAL_RESP; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 169 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 170 | nfc_start_quick_timer(&p_dlcb->timer, NFC_TTYPE_LLCP_DATA_LINK, |
| 171 | (uint32_t)(llcp_cb.lcb.data_link_timeout * |
| 172 | QUICK_TIMER_TICKS_PER_SEC) / |
| 173 | 1000); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 174 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 175 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 176 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 177 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 178 | |
| 179 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 180 | LOG(ERROR) << StringPrintf("Unexpected event"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 181 | status = LLCP_STATUS_FAIL; |
| 182 | break; |
| 183 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 184 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 185 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 186 | } |
| 187 | |
| 188 | /******************************************************************************* |
| 189 | ** |
| 190 | ** Function llcp_dlsm_w4_remote_resp |
| 191 | ** |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 192 | ** Description data link connection is waiting for connection confirm from |
| 193 | ** peer |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 194 | ** |
| 195 | ** Returns tLLCP_STATUS |
| 196 | ** |
| 197 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 198 | static tLLCP_STATUS llcp_dlsm_w4_remote_resp(tLLCP_DLCB* p_dlcb, |
| 199 | tLLCP_DLC_EVENT event, |
| 200 | void* p_data) { |
| 201 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
| 202 | tLLCP_SAP_CBACK_DATA data; |
| 203 | tLLCP_CONNECTION_PARAMS* p_params; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 204 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 205 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 206 | case LLCP_DLC_EVENT_PEER_CONNECT_CFM: |
| 207 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 208 | /* peer device accepted data link connection */ |
| 209 | nfc_stop_quick_timer(&p_dlcb->timer); |
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 | p_params = (tLLCP_CONNECTION_PARAMS*)p_data; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 212 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 213 | /* data link MIU must be up to link MIU */ |
| 214 | if (p_params->miu > llcp_cb.lcb.peer_miu) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 215 | LOG(WARNING) << StringPrintf( |
| 216 | "Peer sent data link MIU bigger than " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 217 | "peer's link MIU"); |
| 218 | p_params->miu = llcp_cb.lcb.peer_miu; |
| 219 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 220 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 221 | p_dlcb->remote_miu = p_params->miu; |
| 222 | p_dlcb->remote_rw = p_params->rw; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 223 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 224 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 225 | "Remote MIU:%d, RW:%d", p_dlcb->remote_miu, p_dlcb->remote_rw); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 226 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 227 | p_dlcb->state = LLCP_DLC_STATE_CONNECTED; |
| 228 | llcp_util_adjust_dl_rx_congestion(); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 229 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 230 | data.connect_resp.event = LLCP_SAP_EVT_CONNECT_RESP; |
| 231 | data.connect_resp.remote_sap = p_dlcb->remote_sap; |
| 232 | data.connect_resp.local_sap = p_dlcb->local_sap; |
| 233 | data.connect_resp.miu = p_params->miu; |
| 234 | data.connect_resp.rw = p_params->rw; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 235 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 236 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 237 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 238 | if (llcp_cb.overall_rx_congested) { |
| 239 | p_dlcb->flags |= LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
| 240 | } |
| 241 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 242 | |
| 243 | case LLCP_DLC_EVENT_PEER_DISCONNECT_RESP: |
| 244 | case LLCP_DLC_EVENT_TIMEOUT: |
| 245 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 246 | /* peer device rejected connection or didn't respond */ |
| 247 | data.disconnect_resp.event = LLCP_SAP_EVT_DISCONNECT_RESP; |
| 248 | data.disconnect_resp.local_sap = p_dlcb->local_sap; |
| 249 | data.disconnect_resp.remote_sap = p_dlcb->remote_sap; |
| 250 | data.disconnect_resp.reason = *((uint8_t*)p_data); |
| 251 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 252 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 253 | /* stop timer, flush any pending data in queue and deallocate control |
| 254 | * block */ |
| 255 | llcp_util_deallocate_data_link(p_dlcb); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 256 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 257 | llcp_util_adjust_dl_rx_congestion(); |
| 258 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 259 | |
| 260 | case LLCP_DLC_EVENT_FRAME_ERROR: |
| 261 | case LLCP_DLC_EVENT_LINK_ERROR: |
| 262 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 263 | /* received bad frame or link is deactivated */ |
| 264 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 265 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 266 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 267 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 268 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 269 | llcp_util_deallocate_data_link(p_dlcb); |
| 270 | llcp_util_adjust_dl_rx_congestion(); |
| 271 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 272 | |
| 273 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 274 | LOG(ERROR) << StringPrintf("Unexpected event"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 275 | status = LLCP_STATUS_FAIL; |
| 276 | break; |
| 277 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 278 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 279 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 280 | } |
| 281 | |
| 282 | /******************************************************************************* |
| 283 | ** |
| 284 | ** Function llcp_dlsm_w4_local_resp |
| 285 | ** |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 286 | ** Description data link connection is waiting for connection confirm from |
| 287 | ** application |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 288 | ** |
| 289 | ** Returns tLLCP_STATUS |
| 290 | ** |
| 291 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 292 | static tLLCP_STATUS llcp_dlsm_w4_local_resp(tLLCP_DLCB* p_dlcb, |
| 293 | tLLCP_DLC_EVENT event, |
| 294 | void* p_data) { |
| 295 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
| 296 | tLLCP_CONNECTION_PARAMS* p_params; |
| 297 | tLLCP_SAP_CBACK_DATA data; |
| 298 | uint8_t reason; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 299 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 300 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 301 | case LLCP_DLC_EVENT_API_CONNECT_CFM: |
| 302 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 303 | /* upper layer accepted data link connection */ |
| 304 | nfc_stop_quick_timer(&p_dlcb->timer); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 305 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 306 | p_params = (tLLCP_CONNECTION_PARAMS*)p_data; |
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 | p_dlcb->local_miu = p_params->miu; |
| 309 | p_dlcb->local_rw = p_params->rw; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 310 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 311 | p_dlcb->state = LLCP_DLC_STATE_CONNECTED; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 312 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 313 | if (llcp_cb.overall_rx_congested) { |
| 314 | p_dlcb->flags |= LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
| 315 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 316 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 317 | status = llcp_util_send_cc(p_dlcb, p_params); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 318 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 319 | if (status == LLCP_STATUS_SUCCESS) { |
| 320 | llcp_util_adjust_dl_rx_congestion(); |
| 321 | } else { |
| 322 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 323 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 324 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 325 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 326 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 327 | llcp_util_deallocate_data_link(p_dlcb); |
| 328 | } |
| 329 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 330 | |
| 331 | case LLCP_DLC_EVENT_API_CONNECT_REJECT: |
| 332 | case LLCP_DLC_EVENT_TIMEOUT: |
| 333 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 334 | if (event == LLCP_DLC_EVENT_TIMEOUT) |
| 335 | reason = LLCP_SAP_DM_REASON_TEMP_REJECT_THIS; |
| 336 | else |
| 337 | reason = *((uint8_t*)p_data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 338 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 339 | /* upper layer rejected connection or didn't respond */ |
| 340 | llcp_util_send_dm(p_dlcb->remote_sap, p_dlcb->local_sap, reason); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 341 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 342 | /* stop timer, flush any pending data in queue and deallocate control |
| 343 | * block */ |
| 344 | llcp_util_deallocate_data_link(p_dlcb); |
| 345 | llcp_util_adjust_dl_rx_congestion(); |
| 346 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 347 | |
| 348 | case LLCP_DLC_EVENT_FRAME_ERROR: |
| 349 | case LLCP_DLC_EVENT_LINK_ERROR: |
| 350 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 351 | /* received bad frame or link is deactivated */ |
| 352 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 353 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 354 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 355 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 356 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 357 | llcp_util_deallocate_data_link(p_dlcb); |
| 358 | llcp_util_adjust_dl_rx_congestion(); |
| 359 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 360 | |
| 361 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 362 | LOG(ERROR) << StringPrintf("Unexpected event"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 363 | status = LLCP_STATUS_FAIL; |
| 364 | break; |
| 365 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 366 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 367 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 368 | } |
| 369 | |
| 370 | /******************************************************************************* |
| 371 | ** |
| 372 | ** Function llcp_dlsm_connected |
| 373 | ** |
| 374 | ** Description data link connection is connected |
| 375 | ** |
| 376 | ** Returns tLLCP_STATUS |
| 377 | ** |
| 378 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 379 | static tLLCP_STATUS llcp_dlsm_connected(tLLCP_DLCB* p_dlcb, |
| 380 | tLLCP_DLC_EVENT event, void* p_data) { |
| 381 | bool flush; |
| 382 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
| 383 | tLLCP_SAP_CBACK_DATA data; |
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 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 386 | case LLCP_DLC_EVENT_API_DISCONNECT_REQ: |
| 387 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 388 | /* upper layer requests to disconnect */ |
| 389 | flush = *(bool*)(p_data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 390 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 391 | /* |
| 392 | ** if upper layer asks to discard any pending data |
| 393 | ** or there is no pending data/ack to send and it is not waiting for ack |
| 394 | */ |
| 395 | if ((flush) || ((p_dlcb->i_xmit_q.count == 0) && |
| 396 | (p_dlcb->next_rx_seq == p_dlcb->sent_ack_seq) && |
| 397 | (p_dlcb->next_tx_seq == p_dlcb->rcvd_ack_seq))) { |
| 398 | /* wait for disconnect response */ |
| 399 | p_dlcb->state = LLCP_DLC_STATE_W4_REMOTE_DM; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 400 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 401 | llcp_util_send_disc(p_dlcb->remote_sap, p_dlcb->local_sap); |
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 | nfc_start_quick_timer(&p_dlcb->timer, NFC_TTYPE_LLCP_DATA_LINK, |
| 404 | (uint32_t)(llcp_cb.lcb.data_link_timeout * |
| 405 | QUICK_TIMER_TICKS_PER_SEC) / |
| 406 | 1000); |
| 407 | } else { |
| 408 | /* set flag to send DISC when tx queue is empty */ |
| 409 | p_dlcb->flags |= LLCP_DATA_LINK_FLAG_PENDING_DISC; |
| 410 | } |
| 411 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 412 | |
| 413 | case LLCP_DLC_EVENT_PEER_DISCONNECT_IND: |
| 414 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 415 | /* peer device requests to disconnect */ |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 416 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 417 | /* send disconnect response and notify upper layer */ |
| 418 | llcp_util_send_dm(p_dlcb->remote_sap, p_dlcb->local_sap, |
| 419 | LLCP_SAP_DM_REASON_RESP_DISC); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 420 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 421 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 422 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 423 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 424 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 425 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 426 | llcp_util_deallocate_data_link(p_dlcb); |
| 427 | llcp_util_adjust_dl_rx_congestion(); |
| 428 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 429 | |
| 430 | case LLCP_DLC_EVENT_API_DATA_REQ: |
| 431 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 432 | /* upper layer requests to send data */ |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 433 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 434 | /* if peer device can receive data */ |
| 435 | if (p_dlcb->remote_rw) { |
| 436 | /* enqueue data and check if data can be sent */ |
| 437 | GKI_enqueue(&p_dlcb->i_xmit_q, p_data); |
| 438 | llcp_cb.total_tx_i_pdu++; |
| 439 | |
| 440 | llcp_link_check_send_data(); |
| 441 | |
| 442 | if ((p_dlcb->is_tx_congested) || (llcp_cb.overall_tx_congested) || |
| 443 | (p_dlcb->remote_busy) || |
| 444 | (p_dlcb->i_xmit_q.count >= |
| 445 | p_dlcb->remote_rw)) /*if enough data to send next round */ |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 446 | { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 447 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 448 | "Data link (SSAP:DSAP=0x%X:0x%X) " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 449 | "congested: xmit_q.count=%d", |
| 450 | p_dlcb->local_sap, p_dlcb->remote_sap, p_dlcb->i_xmit_q.count); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 451 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 452 | /* set congested here so overall congestion check routine will not |
| 453 | * report event again */ |
| 454 | p_dlcb->is_tx_congested = true; |
| 455 | status = LLCP_STATUS_CONGESTED; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 456 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 457 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 458 | LOG(ERROR) << StringPrintf("Remote RW is zero: discard data"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 459 | /* buffer will be freed when returned to API function */ |
| 460 | status = LLCP_STATUS_FAIL; |
| 461 | } |
| 462 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 463 | |
| 464 | case LLCP_DLC_EVENT_PEER_DATA_IND: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 465 | /* peer device sends data so notify upper layer to read data from data |
| 466 | * link connection */ |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 467 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 468 | data.data_ind.event = LLCP_SAP_EVT_DATA_IND; |
| 469 | data.data_ind.local_sap = p_dlcb->local_sap; |
| 470 | data.data_ind.link_type = LLCP_LINK_TYPE_DATA_LINK_CONNECTION; |
| 471 | data.data_ind.remote_sap = p_dlcb->remote_sap; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 472 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 473 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
| 474 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 475 | |
| 476 | case LLCP_DLC_EVENT_FRAME_ERROR: |
| 477 | case LLCP_DLC_EVENT_LINK_ERROR: |
| 478 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 479 | /* received bad frame or link is deactivated */ |
| 480 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 481 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 482 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 483 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 484 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 485 | llcp_util_deallocate_data_link(p_dlcb); |
| 486 | llcp_util_adjust_dl_rx_congestion(); |
| 487 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 488 | |
| 489 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 490 | LOG(ERROR) << StringPrintf("Unexpected event"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 491 | status = LLCP_STATUS_FAIL; |
| 492 | break; |
| 493 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 494 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 495 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 496 | } |
| 497 | |
| 498 | /******************************************************************************* |
| 499 | ** |
| 500 | ** Function llcp_dlsm_w4_remote_dm |
| 501 | ** |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 502 | ** Description data link connection is waiting for disconnection confirm |
| 503 | ** from peer |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 504 | ** |
| 505 | ** Returns tLLCP_STATUS |
| 506 | ** |
| 507 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 508 | static tLLCP_STATUS llcp_dlsm_w4_remote_dm(tLLCP_DLCB* p_dlcb, |
Ruchi Kandoi | 9ba6d24 | 2017-10-13 16:07:01 -0700 | [diff] [blame] | 509 | tLLCP_DLC_EVENT event) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 510 | tLLCP_STATUS status = LLCP_STATUS_SUCCESS; |
| 511 | tLLCP_SAP_CBACK_DATA data; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 512 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 513 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 514 | case LLCP_DLC_EVENT_PEER_DISCONNECT_RESP: |
| 515 | case LLCP_DLC_EVENT_TIMEOUT: |
| 516 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 517 | /* peer device sends disconnect response or didn't responde */ |
| 518 | data.disconnect_resp.event = LLCP_SAP_EVT_DISCONNECT_RESP; |
| 519 | data.disconnect_resp.local_sap = p_dlcb->local_sap; |
| 520 | data.disconnect_resp.remote_sap = p_dlcb->remote_sap; |
| 521 | data.disconnect_resp.reason = LLCP_SAP_DM_REASON_RESP_DISC; |
| 522 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 523 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 524 | llcp_util_deallocate_data_link(p_dlcb); |
| 525 | llcp_util_adjust_dl_rx_congestion(); |
| 526 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 527 | |
| 528 | case LLCP_DLC_EVENT_FRAME_ERROR: |
| 529 | case LLCP_DLC_EVENT_LINK_ERROR: |
| 530 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 531 | /* received bad frame or link is deactivated */ |
| 532 | data.disconnect_ind.event = LLCP_SAP_EVT_DISCONNECT_IND; |
| 533 | data.disconnect_ind.local_sap = p_dlcb->local_sap; |
| 534 | data.disconnect_ind.remote_sap = p_dlcb->remote_sap; |
| 535 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 536 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 537 | llcp_util_deallocate_data_link(p_dlcb); |
| 538 | llcp_util_adjust_dl_rx_congestion(); |
| 539 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 540 | |
| 541 | case LLCP_DLC_EVENT_PEER_DATA_IND: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 542 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 543 | |
| 544 | case LLCP_DLC_EVENT_PEER_DISCONNECT_IND: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 545 | /* it's race condition, send disconnect response and wait for DM */ |
| 546 | llcp_util_send_dm(p_dlcb->remote_sap, p_dlcb->local_sap, |
| 547 | LLCP_SAP_DM_REASON_RESP_DISC); |
| 548 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 549 | |
| 550 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 551 | LOG(ERROR) << StringPrintf("Unexpected event"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 552 | status = LLCP_STATUS_FAIL; |
| 553 | break; |
| 554 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 555 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 556 | return status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 557 | } |
| 558 | |
| 559 | /******************************************************************************* |
| 560 | ** |
| 561 | ** Function llcp_dlc_find_dlcb_by_local_sap |
| 562 | ** |
| 563 | ** Description Find tLLCP_DLCB by local SAP and remote SAP |
Ruchi Kandoi | 552f2b7 | 2017-01-28 16:22:55 -0800 | [diff] [blame] | 564 | ** if remote_sap is LLCP_INVALID_SAP, it will return a DLCB |
| 565 | ** which is waiting for CC from peer. |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 566 | ** |
| 567 | ** Returns tLLCP_DLCB * |
| 568 | ** |
| 569 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 570 | tLLCP_DLCB* llcp_dlc_find_dlcb_by_sap(uint8_t local_sap, uint8_t remote_sap) { |
| 571 | int i; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 572 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 573 | for (i = 0; i < LLCP_MAX_DATA_LINK; i++) { |
| 574 | if ((llcp_cb.dlcb[i].state != LLCP_DLC_STATE_IDLE) && |
| 575 | (llcp_cb.dlcb[i].local_sap == local_sap)) { |
| 576 | if ((remote_sap == LLCP_INVALID_SAP) && |
| 577 | (llcp_cb.dlcb[i].state == LLCP_DLC_STATE_W4_REMOTE_RESP)) { |
| 578 | /* Remote SAP has not been finalized because we are watiing for CC */ |
| 579 | return (&llcp_cb.dlcb[i]); |
| 580 | } else if (llcp_cb.dlcb[i].remote_sap == remote_sap) { |
| 581 | return (&llcp_cb.dlcb[i]); |
| 582 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 583 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 584 | } |
| 585 | return NULL; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 586 | } |
| 587 | |
| 588 | /******************************************************************************* |
| 589 | ** |
| 590 | ** Function llcp_dlc_flush_q |
| 591 | ** |
| 592 | ** Description Free buffers in tx and rx queue in data link |
| 593 | ** |
| 594 | ** Returns void |
| 595 | ** |
| 596 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 597 | void llcp_dlc_flush_q(tLLCP_DLCB* p_dlcb) { |
| 598 | if (p_dlcb) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 599 | DLOG_IF(INFO, nfc_debug_enabled) |
| 600 | << StringPrintf("local SAP:0x%02X", p_dlcb->local_sap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 601 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 602 | /* Release any held buffers */ |
| 603 | while (p_dlcb->i_xmit_q.p_first) { |
| 604 | GKI_freebuf(GKI_dequeue(&p_dlcb->i_xmit_q)); |
| 605 | llcp_cb.total_tx_i_pdu--; |
| 606 | } |
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 | /* discard any received I PDU on data link including in AGF */ |
| 609 | LLCP_FlushDataLinkRxData(p_dlcb->local_sap, p_dlcb->remote_sap); |
| 610 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 611 | LOG(ERROR) << StringPrintf("p_dlcb is NULL"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 612 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 613 | } |
| 614 | |
| 615 | /******************************************************************************* |
| 616 | ** |
| 617 | ** Function llcp_dlc_proc_connect_pdu |
| 618 | ** |
| 619 | ** Description Process CONNECT PDU |
| 620 | ** |
| 621 | ** Returns void |
| 622 | ** |
| 623 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 624 | static void llcp_dlc_proc_connect_pdu(uint8_t dsap, uint8_t ssap, |
| 625 | uint16_t length, uint8_t* p_data) { |
| 626 | tLLCP_DLCB* p_dlcb; |
| 627 | tLLCP_STATUS status; |
| 628 | tLLCP_APP_CB* p_app_cb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 629 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 630 | tLLCP_CONNECTION_PARAMS params; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 631 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 632 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 633 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 634 | p_app_cb = llcp_util_get_app_cb(dsap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 635 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 636 | if ((p_app_cb == NULL) || (p_app_cb->p_app_cback == NULL) || |
| 637 | ((p_app_cb->link_type & LLCP_LINK_TYPE_DATA_LINK_CONNECTION) == 0)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 638 | LOG(ERROR) << StringPrintf("Unregistered SAP:0x%x", dsap); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 639 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_NO_SERVICE); |
| 640 | return; |
| 641 | } |
| 642 | |
| 643 | /* parse CONNECT PDU and get connection parameters */ |
| 644 | if (llcp_util_parse_connect(p_data, length, ¶ms) != LLCP_STATUS_SUCCESS) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 645 | LOG(ERROR) << StringPrintf("Bad format CONNECT"); |
Love Khanna | d7852c9 | 2017-06-02 19:55:05 +0530 | [diff] [blame] | 646 | /* fix to pass TC_CTO_TAR_BI_02_x (x=5) test case |
| 647 | * As per the LLCP test specification v1.2.00 by receiving erroneous SNL PDU |
| 648 | * i'e with improper length and service name "urn:nfc:sn:dta-co-echo-in", |
| 649 | * the IUT should not send any PDU except SYMM PDU */ |
| 650 | |
| 651 | if (appl_dta_mode_flag == 1 && |
| 652 | p_data[1] == strlen((const char*)&p_data[2])) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 653 | DLOG_IF(INFO, nfc_debug_enabled) |
| 654 | << StringPrintf("%s: Strings are not equal", __func__); |
Love Khanna | d7852c9 | 2017-06-02 19:55:05 +0530 | [diff] [blame] | 655 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_NO_SERVICE); |
| 656 | } else { |
| 657 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_NO_SERVICE); |
| 658 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 659 | return; |
| 660 | } |
| 661 | |
| 662 | /* if this is connection by service name */ |
| 663 | if (dsap == LLCP_SAP_SDP) { |
| 664 | /* find registered SAP with service name */ |
| 665 | if (strlen(params.sn)) |
| 666 | dsap = llcp_sdp_get_sap_by_name(params.sn, (uint8_t)strlen(params.sn)); |
| 667 | else { |
| 668 | /* if SN type is included without SN */ |
| 669 | if (params.sn[1] == LLCP_SN_TYPE) { |
| 670 | llcp_util_send_dm(ssap, LLCP_SAP_SDP, LLCP_SAP_DM_REASON_NO_SERVICE); |
| 671 | } else { |
| 672 | /* SDP doesn't accept connection */ |
| 673 | llcp_util_send_dm(ssap, LLCP_SAP_SDP, |
| 674 | LLCP_SAP_DM_REASON_PERM_REJECT_THIS); |
| 675 | } |
| 676 | return; |
| 677 | } |
| 678 | |
| 679 | if (dsap == LLCP_SAP_SDP) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 680 | LOG(ERROR) << StringPrintf("SDP doesn't accept connection"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 681 | |
| 682 | llcp_util_send_dm(ssap, LLCP_SAP_SDP, |
| 683 | LLCP_SAP_DM_REASON_PERM_REJECT_THIS); |
| 684 | return; |
| 685 | } else if (dsap == 0) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 686 | LOG(ERROR) << StringPrintf("Unregistered Service:%s", params.sn); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 687 | |
| 688 | llcp_util_send_dm(ssap, LLCP_SAP_SDP, LLCP_SAP_DM_REASON_NO_SERVICE); |
| 689 | return; |
| 690 | } else { |
| 691 | /* check if this application can support connection-oriented transport */ |
| 692 | p_app_cb = llcp_util_get_app_cb(dsap); |
| 693 | |
| 694 | if ((p_app_cb == NULL) || (p_app_cb->p_app_cback == NULL) || |
| 695 | ((p_app_cb->link_type & LLCP_LINK_TYPE_DATA_LINK_CONNECTION) == 0)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 696 | LOG(ERROR) << StringPrintf( |
| 697 | "SAP(0x%x) doesn't support " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 698 | "connection-oriented", |
| 699 | dsap); |
| 700 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_NO_SERVICE); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 701 | return; |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 702 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 703 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 704 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 705 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 706 | /* check if any data link */ |
| 707 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 708 | if (p_dlcb) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 709 | LOG(ERROR) << StringPrintf("Data link is aleady established"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 710 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_TEMP_REJECT_THIS); |
| 711 | } else { |
| 712 | /* allocate data link connection control block and notify upper layer |
| 713 | * through state machine */ |
| 714 | p_dlcb = llcp_util_allocate_data_link(dsap, ssap); |
| 715 | |
| 716 | if (p_dlcb) { |
| 717 | status = |
| 718 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_PEER_CONNECT_IND, ¶ms); |
| 719 | if (status != LLCP_STATUS_SUCCESS) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 720 | LOG(ERROR) << StringPrintf("Error in state machine"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 721 | llcp_util_deallocate_data_link(p_dlcb); |
| 722 | } |
| 723 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 724 | LOG(ERROR) << StringPrintf("Out of resource"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 725 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_TEMP_REJECT_ANY); |
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 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 728 | } |
| 729 | |
| 730 | /******************************************************************************* |
| 731 | ** |
| 732 | ** Function llcp_dlc_proc_disc_pdu |
| 733 | ** |
| 734 | ** Description Process DISC PDU |
| 735 | ** |
| 736 | ** Returns void |
| 737 | ** |
| 738 | *******************************************************************************/ |
Ruchi Kandoi | 9ba6d24 | 2017-10-13 16:07:01 -0700 | [diff] [blame] | 739 | static void llcp_dlc_proc_disc_pdu(uint8_t dsap, uint8_t ssap, |
| 740 | uint16_t length) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 741 | tLLCP_DLCB* p_dlcb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 742 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 743 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 744 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 745 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 746 | if (p_dlcb) { |
| 747 | if (length > 0) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 748 | LOG(ERROR) << StringPrintf( |
| 749 | "Received extra data (%d bytes) in DISC " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 750 | "PDU", |
| 751 | length); |
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 | llcp_util_send_frmr(p_dlcb, |
| 754 | LLCP_FRMR_W_ERROR_FLAG | LLCP_FRMR_I_ERROR_FLAG, |
| 755 | LLCP_PDU_DISC_TYPE, 0); |
| 756 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
| 757 | } else { |
| 758 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_PEER_DISCONNECT_IND, NULL); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 759 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 760 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 761 | LOG(ERROR) << StringPrintf("No data link for SAP (0x%x,0x%x)", dsap, ssap); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 762 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 763 | } |
| 764 | |
| 765 | /******************************************************************************* |
| 766 | ** |
| 767 | ** Function llcp_dlc_proc_cc_pdu |
| 768 | ** |
| 769 | ** Description Process CC PDU |
| 770 | ** |
| 771 | ** Returns void |
| 772 | ** |
| 773 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 774 | static void llcp_dlc_proc_cc_pdu(uint8_t dsap, uint8_t ssap, uint16_t length, |
| 775 | uint8_t* p_data) { |
| 776 | tLLCP_DLCB* p_dlcb; |
| 777 | tLLCP_CONNECTION_PARAMS params; |
| 778 | tLLCP_STATUS status; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 779 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 780 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 781 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 782 | /* find a DLCB waiting for CC on this local SAP */ |
| 783 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, LLCP_INVALID_SAP); |
| 784 | if (p_dlcb) { |
| 785 | /* The CC may contain a SSAP that is different from the DSAP in the CONNECT |
| 786 | */ |
| 787 | p_dlcb->remote_sap = ssap; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 788 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 789 | if (llcp_util_parse_cc(p_data, length, &(params.miu), &(params.rw)) == |
| 790 | LLCP_STATUS_SUCCESS) { |
| 791 | status = |
| 792 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_PEER_CONNECT_CFM, ¶ms); |
| 793 | if (status != LLCP_STATUS_SUCCESS) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 794 | LOG(ERROR) << StringPrintf("Error in state machine"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 795 | llcp_util_deallocate_data_link(p_dlcb); |
| 796 | } |
| 797 | } else { |
| 798 | llcp_util_send_frmr(p_dlcb, |
| 799 | LLCP_FRMR_W_ERROR_FLAG | LLCP_FRMR_I_ERROR_FLAG, |
| 800 | LLCP_PDU_DISC_TYPE, 0); |
| 801 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
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 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 804 | LOG(ERROR) << StringPrintf("No data link for SAP (0x%x,0x%x)", dsap, ssap); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 805 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 806 | } |
| 807 | |
| 808 | /******************************************************************************* |
| 809 | ** |
| 810 | ** Function llcp_dlc_proc_dm_pdu |
| 811 | ** |
| 812 | ** Description Process DM PDU |
| 813 | ** |
| 814 | ** Returns void |
| 815 | ** |
| 816 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 817 | static void llcp_dlc_proc_dm_pdu(uint8_t dsap, uint8_t ssap, uint16_t length, |
| 818 | uint8_t* p_data) { |
| 819 | tLLCP_DLCB* p_dlcb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 820 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 821 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 822 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 823 | if (length != LLCP_PDU_DM_SIZE - LLCP_PDU_HEADER_SIZE) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 824 | LOG(ERROR) << StringPrintf("Received invalid DM PDU"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 825 | } else { |
| 826 | if (*p_data == LLCP_SAP_DM_REASON_RESP_DISC) { |
| 827 | /* local device initiated disconnecting */ |
| 828 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 829 | } else { |
| 830 | /* peer device rejected connection with any reason */ |
| 831 | /* find a DLCB waiting for CC on this local SAP */ |
| 832 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, LLCP_INVALID_SAP); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 833 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 834 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 835 | if (p_dlcb) { |
| 836 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_PEER_DISCONNECT_RESP, |
| 837 | p_data); /* passing reason */ |
| 838 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 839 | LOG(ERROR) << StringPrintf("No data link for SAP (0x%x,0x%x)", dsap, |
| 840 | ssap); |
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 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 843 | } |
| 844 | |
| 845 | /******************************************************************************* |
| 846 | ** |
| 847 | ** Function llcp_dlc_proc_i_pdu |
| 848 | ** |
| 849 | ** Description Process I PDU |
| 850 | ** |
| 851 | ** Returns void |
| 852 | ** |
| 853 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 854 | void llcp_dlc_proc_i_pdu(uint8_t dsap, uint8_t ssap, uint16_t i_pdu_length, |
| 855 | uint8_t* p_i_pdu, NFC_HDR* p_msg) { |
| 856 | uint8_t *p, *p_dst, send_seq, rcv_seq, error_flags; |
| 857 | uint16_t info_len, available_bytes; |
| 858 | tLLCP_DLCB* p_dlcb; |
| 859 | bool appended; |
| 860 | NFC_HDR* p_last_buf; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 861 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 862 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 863 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 864 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 865 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 866 | if ((p_dlcb) && (p_dlcb->state == LLCP_DLC_STATE_CONNECTED)) { |
| 867 | error_flags = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 868 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 869 | if (p_msg) { |
| 870 | i_pdu_length = p_msg->len; |
| 871 | p_i_pdu = (uint8_t*)(p_msg + 1) + p_msg->offset; |
| 872 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 873 | |
George Chang | 0487ca4 | 2018-10-16 17:10:42 +0800 | [diff] [blame^] | 874 | if (i_pdu_length < LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE) { |
| 875 | android_errorWriteLog(0x534e4554, "116722267"); |
| 876 | LOG(ERROR) << StringPrintf("Insufficient I PDU length %d", i_pdu_length); |
| 877 | if (p_msg) { |
| 878 | GKI_freebuf(p_msg); |
| 879 | } |
| 880 | return; |
| 881 | } |
| 882 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 883 | info_len = i_pdu_length - LLCP_PDU_HEADER_SIZE - LLCP_SEQUENCE_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 884 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 885 | if (info_len > p_dlcb->local_miu) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 886 | LOG(ERROR) << StringPrintf( |
| 887 | "exceeding local MIU (%d bytes): got %d " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 888 | "bytes SDU", |
| 889 | p_dlcb->local_miu, info_len); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 890 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 891 | error_flags |= LLCP_FRMR_I_ERROR_FLAG; |
| 892 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 893 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 894 | /* get sequence numbers */ |
| 895 | p = p_i_pdu + LLCP_PDU_HEADER_SIZE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 896 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 897 | send_seq = LLCP_GET_NS(*p); |
| 898 | rcv_seq = LLCP_GET_NR(*p); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 899 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 900 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 901 | "LLCP RX I PDU - N(S,R):(%d,%d) V(S,SA,R,RA):(%d,%d,%d,%d)", send_seq, |
| 902 | rcv_seq, p_dlcb->next_tx_seq, p_dlcb->rcvd_ack_seq, p_dlcb->next_rx_seq, |
| 903 | p_dlcb->sent_ack_seq); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 904 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 905 | /* if send sequence number, N(S) is not expected one, V(R) */ |
| 906 | if (p_dlcb->next_rx_seq != send_seq) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 907 | LOG(ERROR) << StringPrintf("Bad N(S) got:%d, expected:%d", send_seq, |
| 908 | p_dlcb->next_rx_seq); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 909 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 910 | error_flags |= LLCP_FRMR_S_ERROR_FLAG; |
| 911 | } else { |
| 912 | /* if peer device sends more than our receiving window size */ |
| 913 | if ((uint8_t)(send_seq - p_dlcb->sent_ack_seq) % LLCP_SEQ_MODULO >= |
| 914 | p_dlcb->local_rw) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 915 | LOG(ERROR) << StringPrintf("Bad N(S):%d >= V(RA):%d + RW(L):%d", |
| 916 | send_seq, p_dlcb->sent_ack_seq, |
| 917 | p_dlcb->local_rw); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 918 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 919 | error_flags |= LLCP_FRMR_S_ERROR_FLAG; |
| 920 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 921 | } |
| 922 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 923 | /* check N(R) is in valid range; V(SA) <= N(R) <= V(S) */ |
| 924 | if ((uint8_t)(rcv_seq - p_dlcb->rcvd_ack_seq) % LLCP_SEQ_MODULO + |
| 925 | (uint8_t)(p_dlcb->next_tx_seq - rcv_seq) % LLCP_SEQ_MODULO != |
| 926 | (uint8_t)(p_dlcb->next_tx_seq - p_dlcb->rcvd_ack_seq) % |
| 927 | LLCP_SEQ_MODULO) { |
| 928 | error_flags |= LLCP_FRMR_R_ERROR_FLAG; |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 929 | LOG(ERROR) << StringPrintf("Bad N(R):%d valid range [V(SA):%d, V(S):%d]", |
| 930 | rcv_seq, p_dlcb->rcvd_ack_seq, |
| 931 | p_dlcb->next_tx_seq); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 932 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 933 | |
| 934 | /* if any error is found */ |
| 935 | if (error_flags) { |
| 936 | llcp_util_send_frmr(p_dlcb, error_flags, LLCP_PDU_I_TYPE, *p); |
| 937 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
| 938 | } else { |
| 939 | /* update local sequence variables */ |
| 940 | p_dlcb->next_rx_seq = (p_dlcb->next_rx_seq + 1) % LLCP_SEQ_MODULO; |
| 941 | p_dlcb->rcvd_ack_seq = rcv_seq; |
| 942 | |
| 943 | appended = false; |
| 944 | |
| 945 | /* get last buffer in rx queue */ |
| 946 | p_last_buf = (NFC_HDR*)GKI_getlast(&p_dlcb->i_rx_q); |
| 947 | |
| 948 | if (p_last_buf) { |
| 949 | /* get max length to append at the end of buffer */ |
| 950 | available_bytes = GKI_get_buf_size(p_last_buf) - NFC_HDR_SIZE - |
| 951 | p_last_buf->offset - p_last_buf->len; |
| 952 | |
| 953 | /* if new UI PDU with length can be attached at the end of buffer */ |
| 954 | if (available_bytes >= LLCP_PDU_AGF_LEN_SIZE + info_len) { |
| 955 | p_dst = |
| 956 | (uint8_t*)(p_last_buf + 1) + p_last_buf->offset + p_last_buf->len; |
| 957 | |
| 958 | /* add length of information in I PDU */ |
| 959 | UINT16_TO_BE_STREAM(p_dst, info_len); |
| 960 | |
| 961 | /* copy information of I PDU */ |
| 962 | p = p_i_pdu + LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE; |
| 963 | |
| 964 | memcpy(p_dst, p, info_len); |
| 965 | |
| 966 | p_last_buf->len += LLCP_PDU_AGF_LEN_SIZE + info_len; |
| 967 | |
| 968 | if (p_msg) { |
| 969 | GKI_freebuf(p_msg); |
| 970 | p_msg = NULL; |
| 971 | } |
| 972 | |
| 973 | appended = true; |
| 974 | } |
| 975 | } |
| 976 | |
| 977 | /* if it is not available to append */ |
| 978 | if (!appended) { |
| 979 | /* if it's not from AGF PDU */ |
| 980 | if (p_msg) { |
| 981 | /* add length of information in front of information */ |
| 982 | p = p_i_pdu + LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE - |
| 983 | LLCP_PDU_AGF_LEN_SIZE; |
| 984 | UINT16_TO_BE_STREAM(p, info_len); |
| 985 | |
| 986 | p_msg->offset += |
| 987 | LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE - LLCP_PDU_AGF_LEN_SIZE; |
| 988 | p_msg->len -= |
| 989 | LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE - LLCP_PDU_AGF_LEN_SIZE; |
| 990 | p_msg->layer_specific = 0; |
| 991 | } else { |
| 992 | p_msg = (NFC_HDR*)GKI_getpoolbuf(LLCP_POOL_ID); |
| 993 | |
| 994 | if (p_msg) { |
| 995 | p_dst = (uint8_t*)(p_msg + 1); |
| 996 | |
| 997 | /* add length of information in front of information */ |
| 998 | UINT16_TO_BE_STREAM(p_dst, info_len); |
| 999 | |
| 1000 | p = p_i_pdu + LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE; |
| 1001 | memcpy(p_dst, p, info_len); |
| 1002 | |
| 1003 | p_msg->offset = 0; |
| 1004 | p_msg->len = LLCP_PDU_AGF_LEN_SIZE + info_len; |
| 1005 | p_msg->layer_specific = 0; |
| 1006 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1007 | LOG(ERROR) << StringPrintf("out of buffer"); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1008 | } |
| 1009 | } |
| 1010 | |
| 1011 | /* insert I PDU in rx queue */ |
| 1012 | if (p_msg) { |
| 1013 | GKI_enqueue(&p_dlcb->i_rx_q, p_msg); |
| 1014 | p_msg = NULL; |
| 1015 | llcp_cb.total_rx_i_pdu++; |
| 1016 | |
| 1017 | llcp_util_check_rx_congested_status(); |
| 1018 | } |
| 1019 | } |
| 1020 | |
| 1021 | p_dlcb->num_rx_i_pdu++; |
| 1022 | |
| 1023 | if ((!p_dlcb->local_busy) && (p_dlcb->num_rx_i_pdu == 1)) { |
| 1024 | /* notify rx data is available so upper layer reads data until queue is |
| 1025 | * empty */ |
| 1026 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_PEER_DATA_IND, NULL); |
| 1027 | } |
| 1028 | |
| 1029 | if ((!p_dlcb->is_rx_congested) && |
| 1030 | (p_dlcb->num_rx_i_pdu >= p_dlcb->rx_congest_threshold)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1031 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 1032 | "congested num_rx_i_pdu=%d, " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1033 | "rx_congest_threshold=%d", |
| 1034 | p_dlcb->num_rx_i_pdu, p_dlcb->rx_congest_threshold); |
| 1035 | |
| 1036 | /* send RNR */ |
| 1037 | p_dlcb->is_rx_congested = true; |
| 1038 | p_dlcb->flags |= LLCP_DATA_LINK_FLAG_PENDING_RR_RNR; |
| 1039 | } |
| 1040 | } |
| 1041 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1042 | LOG(ERROR) << StringPrintf("No data link for SAP (0x%x,0x%x)", dsap, ssap); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1043 | llcp_util_send_dm(ssap, dsap, LLCP_SAP_DM_REASON_NO_ACTIVE_CONNECTION); |
| 1044 | } |
| 1045 | |
| 1046 | if (p_msg) { |
| 1047 | GKI_freebuf(p_msg); |
| 1048 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1049 | } |
| 1050 | |
| 1051 | /******************************************************************************* |
| 1052 | ** |
| 1053 | ** Function llcp_dlc_proc_rr_rnr_pdu |
| 1054 | ** |
| 1055 | ** Description Process RR or RNR PDU |
| 1056 | ** |
| 1057 | ** Returns void |
| 1058 | ** |
| 1059 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1060 | static void llcp_dlc_proc_rr_rnr_pdu(uint8_t dsap, uint8_t ptype, uint8_t ssap, |
| 1061 | uint16_t length, uint8_t* p_data) { |
| 1062 | uint8_t rcv_seq, error_flags; |
| 1063 | tLLCP_DLCB* p_dlcb; |
| 1064 | bool flush = true; |
| 1065 | tLLCP_SAP_CBACK_DATA cback_data; |
| 1066 | bool old_remote_busy; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1067 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1068 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1069 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1070 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 1071 | if (p_dlcb != NULL) { |
| 1072 | error_flags = 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1073 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1074 | rcv_seq = LLCP_GET_NR(*p_data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1075 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1076 | if (length != LLCP_PDU_RR_SIZE - LLCP_PDU_HEADER_SIZE) { |
| 1077 | error_flags |= LLCP_FRMR_W_ERROR_FLAG | LLCP_FRMR_I_ERROR_FLAG; |
| 1078 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1079 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1080 | /* check N(R) is in valid range; V(SA) <= N(R) <= V(S) */ |
| 1081 | if ((uint8_t)(rcv_seq - p_dlcb->rcvd_ack_seq) % LLCP_SEQ_MODULO + |
| 1082 | (uint8_t)(p_dlcb->next_tx_seq - rcv_seq) % LLCP_SEQ_MODULO != |
| 1083 | (uint8_t)(p_dlcb->next_tx_seq - p_dlcb->rcvd_ack_seq) % |
| 1084 | LLCP_SEQ_MODULO) { |
| 1085 | error_flags |= LLCP_FRMR_R_ERROR_FLAG; |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1086 | LOG(ERROR) << StringPrintf( |
| 1087 | "Bad N(R):%d valid range [V(SA):%d, " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1088 | "V(S):%d]", |
| 1089 | rcv_seq, p_dlcb->rcvd_ack_seq, p_dlcb->next_tx_seq); |
| 1090 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1091 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1092 | if (error_flags) { |
| 1093 | llcp_util_send_frmr(p_dlcb, error_flags, ptype, *p_data); |
| 1094 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
| 1095 | } else { |
| 1096 | p_dlcb->rcvd_ack_seq = rcv_seq; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1097 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1098 | DLOG_IF(INFO, nfc_debug_enabled) |
| 1099 | << StringPrintf("LLCP RX - N(S,R):(NA,%d) V(S,SA,R,RA):(%d,%d,%d,%d)", |
| 1100 | rcv_seq, p_dlcb->next_tx_seq, p_dlcb->rcvd_ack_seq, |
| 1101 | p_dlcb->next_rx_seq, p_dlcb->sent_ack_seq); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1102 | old_remote_busy = p_dlcb->remote_busy; |
| 1103 | if (ptype == LLCP_PDU_RNR_TYPE) { |
| 1104 | p_dlcb->remote_busy = true; |
| 1105 | /* if upper layer hasn't get congestion started notification */ |
| 1106 | if ((!old_remote_busy) && (!p_dlcb->is_tx_congested)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1107 | LOG(WARNING) << StringPrintf( |
| 1108 | "Data link (SSAP:DSAP=0x%X:0x%X) " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1109 | "congestion start: i_xmit_q.count=%d", |
| 1110 | p_dlcb->local_sap, p_dlcb->remote_sap, p_dlcb->i_xmit_q.count); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1111 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1112 | cback_data.congest.event = LLCP_SAP_EVT_CONGEST; |
| 1113 | cback_data.congest.local_sap = p_dlcb->local_sap; |
| 1114 | cback_data.congest.remote_sap = p_dlcb->remote_sap; |
| 1115 | cback_data.congest.is_congested = true; |
| 1116 | cback_data.congest.link_type = LLCP_LINK_TYPE_DATA_LINK_CONNECTION; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1117 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1118 | (*p_dlcb->p_app_cb->p_app_cback)(&cback_data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1119 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1120 | } else { |
| 1121 | p_dlcb->remote_busy = false; |
| 1122 | /* if upper layer hasn't get congestion ended notification and data link |
| 1123 | * is not congested */ |
| 1124 | if ((old_remote_busy) && (!p_dlcb->is_tx_congested)) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1125 | LOG(WARNING) << StringPrintf( |
| 1126 | "Data link (SSAP:DSAP=0x%X:0x%X) " |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1127 | "congestion end: i_xmit_q.count=%d", |
| 1128 | p_dlcb->local_sap, p_dlcb->remote_sap, p_dlcb->i_xmit_q.count); |
| 1129 | |
| 1130 | cback_data.congest.event = LLCP_SAP_EVT_CONGEST; |
| 1131 | cback_data.congest.local_sap = p_dlcb->local_sap; |
| 1132 | cback_data.congest.remote_sap = p_dlcb->remote_sap; |
| 1133 | cback_data.congest.is_congested = false; |
| 1134 | cback_data.congest.link_type = LLCP_LINK_TYPE_DATA_LINK_CONNECTION; |
| 1135 | |
| 1136 | (*p_dlcb->p_app_cb->p_app_cback)(&cback_data); |
| 1137 | } |
| 1138 | } |
| 1139 | |
| 1140 | /* check flag to send DISC when tx queue is empty */ |
| 1141 | if (p_dlcb->flags & LLCP_DATA_LINK_FLAG_PENDING_DISC) { |
| 1142 | /* if no pending data and all PDU is acked */ |
| 1143 | if ((p_dlcb->i_xmit_q.count == 0) && |
| 1144 | (p_dlcb->next_rx_seq == p_dlcb->sent_ack_seq) && |
| 1145 | (p_dlcb->next_tx_seq == p_dlcb->rcvd_ack_seq)) { |
| 1146 | p_dlcb->flags &= ~LLCP_DATA_LINK_FLAG_PENDING_DISC; |
| 1147 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_API_DISCONNECT_REQ, &flush); |
| 1148 | } |
| 1149 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1150 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1151 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1152 | LOG(ERROR) << StringPrintf("No data link for SAP (0x%x,0x%x)", dsap, ssap); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1153 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1154 | } |
| 1155 | |
| 1156 | /******************************************************************************* |
| 1157 | ** |
| 1158 | ** Function llcp_dlc_proc_rx_pdu |
| 1159 | ** |
| 1160 | ** Description Process PDU for data link |
| 1161 | ** |
| 1162 | ** Returns void |
| 1163 | ** |
| 1164 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1165 | void llcp_dlc_proc_rx_pdu(uint8_t dsap, uint8_t ptype, uint8_t ssap, |
| 1166 | uint16_t length, uint8_t* p_data) { |
| 1167 | tLLCP_DLCB* p_dlcb; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1168 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1169 | DLOG_IF(INFO, nfc_debug_enabled) |
| 1170 | << StringPrintf("DSAP:0x%x, PTYPE:0x%x, SSAP:0x%x", dsap, ptype, ssap); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1171 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1172 | if (dsap == LLCP_SAP_LM) { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1173 | LOG(ERROR) << StringPrintf("Invalid SAP:0x%x for PTYPE:0x%x", dsap, ptype); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1174 | return; |
| 1175 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1176 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1177 | switch (ptype) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1178 | case LLCP_PDU_CONNECT_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1179 | llcp_dlc_proc_connect_pdu(dsap, ssap, length, p_data); |
| 1180 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1181 | |
| 1182 | case LLCP_PDU_DISC_TYPE: |
Ruchi Kandoi | 9ba6d24 | 2017-10-13 16:07:01 -0700 | [diff] [blame] | 1183 | llcp_dlc_proc_disc_pdu(dsap, ssap, length); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1184 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1185 | |
| 1186 | case LLCP_PDU_CC_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1187 | llcp_dlc_proc_cc_pdu(dsap, ssap, length, p_data); |
| 1188 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1189 | |
| 1190 | case LLCP_PDU_DM_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1191 | llcp_dlc_proc_dm_pdu(dsap, ssap, length, p_data); |
| 1192 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1193 | |
| 1194 | case LLCP_PDU_FRMR_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1195 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 1196 | if (p_dlcb) { |
| 1197 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
| 1198 | } |
| 1199 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1200 | |
| 1201 | case LLCP_PDU_RR_TYPE: |
| 1202 | case LLCP_PDU_RNR_TYPE: |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1203 | llcp_dlc_proc_rr_rnr_pdu(dsap, ptype, ssap, length, p_data); |
| 1204 | break; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1205 | |
| 1206 | default: |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1207 | LOG(ERROR) << StringPrintf("Unexpected PDU type (0x%x)", ptype); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1208 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1209 | p_dlcb = llcp_dlc_find_dlcb_by_sap(dsap, ssap); |
| 1210 | if (p_dlcb) { |
| 1211 | llcp_util_send_frmr(p_dlcb, LLCP_FRMR_W_ERROR_FLAG, ptype, 0); |
| 1212 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_FRAME_ERROR, NULL); |
| 1213 | } |
| 1214 | break; |
| 1215 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1216 | } |
| 1217 | |
| 1218 | /******************************************************************************* |
| 1219 | ** |
| 1220 | ** Function llcp_dlc_check_to_send_rr_rnr |
| 1221 | ** |
| 1222 | ** Description Send RR or RNR if necessary |
| 1223 | ** |
| 1224 | ** Returns void |
| 1225 | ** |
| 1226 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1227 | void llcp_dlc_check_to_send_rr_rnr(void) { |
| 1228 | uint8_t idx; |
| 1229 | bool flush = true; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1230 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1231 | DLOG_IF(INFO, nfc_debug_enabled) << __func__; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1232 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1233 | /* |
| 1234 | ** DLC doesn't send RR PDU for each received I PDU because multiple I PDUs |
| 1235 | ** can be aggregated in a received AGF PDU. In this case, this is post |
| 1236 | ** processing of AGF PDU to send single RR or RNR after processing all I |
| 1237 | ** PDUs in received AGF if there was no I-PDU to carry N(R). |
| 1238 | ** |
| 1239 | ** Send RR or RNR if any change of local busy condition or rx congestion |
| 1240 | ** status, or V(RA) is not V(R). |
| 1241 | */ |
| 1242 | for (idx = 0; idx < LLCP_MAX_DATA_LINK; idx++) { |
| 1243 | if (llcp_cb.dlcb[idx].state == LLCP_DLC_STATE_CONNECTED) { |
| 1244 | llcp_util_send_rr_rnr(&(llcp_cb.dlcb[idx])); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1245 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1246 | /* check flag to send DISC when tx queue is empty */ |
| 1247 | if (llcp_cb.dlcb[idx].flags & LLCP_DATA_LINK_FLAG_PENDING_DISC) { |
| 1248 | /* if no pending data and all PDU is acked */ |
| 1249 | if ((llcp_cb.dlcb[idx].i_xmit_q.count == 0) && |
| 1250 | (llcp_cb.dlcb[idx].next_rx_seq == llcp_cb.dlcb[idx].sent_ack_seq) && |
| 1251 | (llcp_cb.dlcb[idx].next_tx_seq == llcp_cb.dlcb[idx].rcvd_ack_seq)) { |
| 1252 | llcp_cb.dlcb[idx].flags &= ~LLCP_DATA_LINK_FLAG_PENDING_DISC; |
| 1253 | llcp_dlsm_execute(&(llcp_cb.dlcb[idx]), |
| 1254 | LLCP_DLC_EVENT_API_DISCONNECT_REQ, &flush); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1255 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1256 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1257 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1258 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1259 | } |
| 1260 | |
| 1261 | /******************************************************************************* |
| 1262 | ** |
| 1263 | ** Function llcp_dlc_is_rw_open |
| 1264 | ** |
| 1265 | ** Description check if receive window is open in remote |
| 1266 | ** |
| 1267 | ** Returns TRUE if remote can receive more data |
| 1268 | ** |
| 1269 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1270 | bool llcp_dlc_is_rw_open(tLLCP_DLCB* p_dlcb) { |
| 1271 | if ((uint8_t)(p_dlcb->next_tx_seq - p_dlcb->rcvd_ack_seq) % LLCP_SEQ_MODULO < |
| 1272 | p_dlcb->remote_rw) { |
| 1273 | return true; |
| 1274 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1275 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 1276 | "Flow Off, V(S):%d, V(SA):%d, RW(R):%d", p_dlcb->next_tx_seq, |
| 1277 | p_dlcb->rcvd_ack_seq, p_dlcb->remote_rw); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1278 | return false; |
| 1279 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1280 | } |
| 1281 | |
| 1282 | /******************************************************************************* |
| 1283 | ** |
| 1284 | ** Function llcp_dlc_get_next_pdu |
| 1285 | ** |
| 1286 | ** Description Get a PDU from tx queue of data link |
| 1287 | ** |
Ruchi Kandoi | 0a73688 | 2017-01-09 15:43:14 -0800 | [diff] [blame] | 1288 | ** Returns NFC_HDR* |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1289 | ** |
| 1290 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1291 | NFC_HDR* llcp_dlc_get_next_pdu(tLLCP_DLCB* p_dlcb) { |
| 1292 | NFC_HDR* p_msg = NULL; |
| 1293 | bool flush = true; |
| 1294 | tLLCP_SAP_CBACK_DATA data; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1295 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1296 | uint8_t send_seq = p_dlcb->next_tx_seq; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1297 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1298 | /* if there is data to send and remote device can receive it */ |
| 1299 | if ((p_dlcb->i_xmit_q.count) && (!p_dlcb->remote_busy) && |
| 1300 | (llcp_dlc_is_rw_open(p_dlcb))) { |
| 1301 | p_msg = (NFC_HDR*)GKI_dequeue(&p_dlcb->i_xmit_q); |
| 1302 | llcp_cb.total_tx_i_pdu--; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1303 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1304 | if (p_msg->offset >= LLCP_MIN_OFFSET) { |
| 1305 | /* add LLCP header, DSAP, PTYPE, SSAP, N(S), N(R) and update sent_ack_seq, |
| 1306 | * V(RA) */ |
| 1307 | llcp_util_build_info_pdu(p_dlcb, p_msg); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1308 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1309 | p_dlcb->next_tx_seq = (p_dlcb->next_tx_seq + 1) % LLCP_SEQ_MODULO; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1310 | |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1311 | DLOG_IF(INFO, nfc_debug_enabled) << StringPrintf( |
| 1312 | "LLCP TX - N(S,R):(%d,%d) V(S,SA,R,RA):(%d,%d,%d,%d)", send_seq, |
| 1313 | p_dlcb->next_rx_seq, p_dlcb->next_tx_seq, p_dlcb->rcvd_ack_seq, |
| 1314 | p_dlcb->next_rx_seq, p_dlcb->sent_ack_seq); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1315 | } else { |
Ruchi Kandoi | 6767aec | 2017-09-26 09:46:26 -0700 | [diff] [blame] | 1316 | LOG(ERROR) << StringPrintf("offset (%d) must be %d at least", |
| 1317 | p_msg->offset, LLCP_MIN_OFFSET); |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1318 | GKI_freebuf(p_msg); |
| 1319 | p_msg = NULL; |
| 1320 | } |
| 1321 | } |
| 1322 | |
| 1323 | /* if tx queue is empty and all PDU is acknowledged */ |
| 1324 | if ((p_dlcb->i_xmit_q.count == 0) && |
| 1325 | (p_dlcb->next_rx_seq == p_dlcb->sent_ack_seq) && |
| 1326 | (p_dlcb->next_tx_seq == p_dlcb->rcvd_ack_seq)) { |
| 1327 | /* check flag to send DISC */ |
| 1328 | if (p_dlcb->flags & LLCP_DATA_LINK_FLAG_PENDING_DISC) { |
| 1329 | p_dlcb->flags &= ~LLCP_DATA_LINK_FLAG_PENDING_DISC; |
| 1330 | llcp_dlsm_execute(p_dlcb, LLCP_DLC_EVENT_API_DISCONNECT_REQ, &flush); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1331 | } |
| 1332 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1333 | /* check flag to notify upper layer */ |
| 1334 | if (p_dlcb->flags & LLCP_DATA_LINK_FLAG_NOTIFY_TX_DONE) { |
| 1335 | p_dlcb->flags &= ~LLCP_DATA_LINK_FLAG_NOTIFY_TX_DONE; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1336 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1337 | data.tx_complete.event = LLCP_SAP_EVT_TX_COMPLETE; |
| 1338 | data.tx_complete.local_sap = p_dlcb->local_sap; |
| 1339 | data.tx_complete.remote_sap = p_dlcb->remote_sap; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1340 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1341 | (*p_dlcb->p_app_cb->p_app_cback)(&data); |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1342 | } |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1343 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1344 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1345 | return p_msg; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1346 | } |
| 1347 | |
| 1348 | /******************************************************************************* |
| 1349 | ** |
| 1350 | ** Function llcp_dlc_get_next_pdu_length |
| 1351 | ** |
| 1352 | ** Description return length of PDU which is top in tx queue of data link |
| 1353 | ** |
| 1354 | ** Returns length of PDU |
| 1355 | ** |
| 1356 | *******************************************************************************/ |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1357 | uint16_t llcp_dlc_get_next_pdu_length(tLLCP_DLCB* p_dlcb) { |
| 1358 | NFC_HDR* p_msg; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1359 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1360 | /* if there is data to send and remote device can receive it */ |
| 1361 | if ((p_dlcb->i_xmit_q.count) && (!p_dlcb->remote_busy) && |
| 1362 | (llcp_dlc_is_rw_open(p_dlcb))) { |
| 1363 | p_msg = (NFC_HDR*)p_dlcb->i_xmit_q.p_first; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1364 | |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1365 | return (p_msg->len + LLCP_PDU_HEADER_SIZE + LLCP_SEQUENCE_SIZE); |
| 1366 | } |
| 1367 | return 0; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1368 | } |
| 1369 | |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1370 | /******************************************************************************* |
| 1371 | ** |
| 1372 | ** Function llcp_dlsm_get_state_name |
| 1373 | ** |
| 1374 | ** Description This function returns the state name. |
| 1375 | ** |
| 1376 | ** Returns pointer to the name |
| 1377 | ** |
| 1378 | *******************************************************************************/ |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1379 | static std::string llcp_dlsm_get_state_name(tLLCP_DLC_STATE state) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1380 | switch (state) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1381 | case LLCP_DLC_STATE_IDLE: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1382 | return "IDLE"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1383 | case LLCP_DLC_STATE_W4_REMOTE_RESP: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1384 | return "W4_REMOTE_RESP"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1385 | case LLCP_DLC_STATE_W4_LOCAL_RESP: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1386 | return "W4_LOCAL_RESP"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1387 | case LLCP_DLC_STATE_CONNECTED: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1388 | return "CONNECTED"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1389 | case LLCP_DLC_STATE_W4_REMOTE_DM: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1390 | return "W4_REMOTE_DM"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1391 | default: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1392 | return "???? UNKNOWN STATE"; |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1393 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1394 | } |
| 1395 | |
| 1396 | /******************************************************************************* |
| 1397 | ** |
| 1398 | ** Function llcp_dlsm_get_event_name |
| 1399 | ** |
| 1400 | ** Description This function returns the event name. |
| 1401 | ** |
| 1402 | ** Returns pointer to the name |
| 1403 | ** |
| 1404 | *******************************************************************************/ |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1405 | static std::string llcp_dlsm_get_event_name(tLLCP_DLC_EVENT event) { |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1406 | switch (event) { |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1407 | case LLCP_DLC_EVENT_API_CONNECT_REQ: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1408 | return "API_CONNECT_REQ"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1409 | case LLCP_DLC_EVENT_API_CONNECT_CFM: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1410 | return "API_CONNECT_CFM"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1411 | case LLCP_DLC_EVENT_API_CONNECT_REJECT: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1412 | return "API_CONNECT_REJECT"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1413 | case LLCP_DLC_EVENT_PEER_CONNECT_IND: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1414 | return "PEER_CONNECT_IND"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1415 | case LLCP_DLC_EVENT_PEER_CONNECT_CFM: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1416 | return "PEER_CONNECT_CFM"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1417 | case LLCP_DLC_EVENT_API_DATA_REQ: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1418 | return "API_DATA_REQ"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1419 | case LLCP_DLC_EVENT_PEER_DATA_IND: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1420 | return "PEER_DATA_IND"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1421 | case LLCP_DLC_EVENT_API_DISCONNECT_REQ: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1422 | return "API_DISCONNECT_REQ"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1423 | case LLCP_DLC_EVENT_PEER_DISCONNECT_IND: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1424 | return "PEER_DISCONNECT_IND"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1425 | case LLCP_DLC_EVENT_PEER_DISCONNECT_RESP: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1426 | return "PEER_DISCONNECT_RESP"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1427 | case LLCP_DLC_EVENT_FRAME_ERROR: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1428 | return "FRAME_ERROR"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1429 | case LLCP_DLC_EVENT_LINK_ERROR: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1430 | return "LINK_ERROR"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1431 | case LLCP_DLC_EVENT_TIMEOUT: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1432 | return "TIMEOUT"; |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1433 | default: |
Ruchi Kandoi | 7dab0e5 | 2017-08-03 13:09:49 -0700 | [diff] [blame] | 1434 | return "???? UNKNOWN EVENT"; |
Ruchi Kandoi | 6fca02d | 2017-01-30 14:28:16 -0800 | [diff] [blame] | 1435 | } |
The Android Open Source Project | e9df6ba | 2012-12-13 14:55:37 -0800 | [diff] [blame] | 1436 | } |