Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2011 Intel Corporation. All rights reserved. |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify |
| 5 | * it under the terms of the GNU General Public License as published by |
| 6 | * the Free Software Foundation; either version 2 of the License, or |
| 7 | * (at your option) any later version. |
| 8 | * |
| 9 | * This program is distributed in the hope that it will be useful, |
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 12 | * GNU General Public License for more details. |
| 13 | * |
| 14 | * You should have received a copy of the GNU General Public License |
Jeff Kirsher | 98b32de | 2013-12-06 08:56:16 -0800 | [diff] [blame] | 15 | * along with this program; if not, see <http://www.gnu.org/licenses/>. |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 16 | */ |
| 17 | |
| 18 | enum llcp_state { |
| 19 | LLCP_CONNECTED = 1, /* wait_for_packet() wants that */ |
Samuel Ortiz | b401123 | 2013-05-03 18:29:30 +0200 | [diff] [blame] | 20 | LLCP_CONNECTING, |
Thierry Escande | 17f7ae16 | 2013-06-04 11:34:51 +0200 | [diff] [blame] | 21 | LLCP_DISCONNECTING, |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 22 | LLCP_CLOSED, |
| 23 | LLCP_BOUND, |
| 24 | LLCP_LISTEN, |
| 25 | }; |
| 26 | |
| 27 | #define LLCP_DEFAULT_LTO 100 |
| 28 | #define LLCP_DEFAULT_RW 1 |
| 29 | #define LLCP_DEFAULT_MIU 128 |
| 30 | |
Samuel Ortiz | eda21f1 | 2012-03-05 01:03:43 +0100 | [diff] [blame] | 31 | #define LLCP_MAX_LTO 0xff |
| 32 | #define LLCP_MAX_RW 15 |
| 33 | #define LLCP_MAX_MIUX 0x7ff |
Thierry Escande | 66cbfa1 | 2013-04-02 10:25:14 +0200 | [diff] [blame] | 34 | #define LLCP_MAX_MIU (LLCP_MAX_MIUX + 128) |
Samuel Ortiz | eda21f1 | 2012-03-05 01:03:43 +0100 | [diff] [blame] | 35 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 36 | #define LLCP_WKS_NUM_SAP 16 |
| 37 | #define LLCP_SDP_NUM_SAP 16 |
| 38 | #define LLCP_LOCAL_NUM_SAP 32 |
| 39 | #define LLCP_LOCAL_SAP_OFFSET (LLCP_WKS_NUM_SAP + LLCP_SDP_NUM_SAP) |
| 40 | #define LLCP_MAX_SAP (LLCP_WKS_NUM_SAP + LLCP_SDP_NUM_SAP + LLCP_LOCAL_NUM_SAP) |
Samuel Ortiz | 8f50020 | 2012-06-25 15:46:28 +0200 | [diff] [blame] | 41 | #define LLCP_SDP_UNBOUND (LLCP_MAX_SAP + 1) |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 42 | |
| 43 | struct nfc_llcp_sock; |
| 44 | |
Samuel Ortiz | a69f32a | 2012-05-04 17:04:19 +0200 | [diff] [blame] | 45 | struct llcp_sock_list { |
| 46 | struct hlist_head head; |
| 47 | rwlock_t lock; |
| 48 | }; |
| 49 | |
Thierry Escande | e0ae7ba | 2013-02-15 10:43:05 +0100 | [diff] [blame] | 50 | struct nfc_llcp_sdp_tlv { |
| 51 | u8 *tlv; |
| 52 | u8 tlv_len; |
| 53 | |
| 54 | char *uri; |
| 55 | u8 tid; |
| 56 | u8 sap; |
| 57 | |
Thierry Escande | 40213fa | 2013-03-04 15:43:32 +0100 | [diff] [blame] | 58 | unsigned long time; |
| 59 | |
Thierry Escande | e0ae7ba | 2013-02-15 10:43:05 +0100 | [diff] [blame] | 60 | struct hlist_node node; |
| 61 | }; |
| 62 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 63 | struct nfc_llcp_local { |
| 64 | struct list_head list; |
| 65 | struct nfc_dev *dev; |
| 66 | |
Samuel Ortiz | c7aa122 | 2012-05-04 11:24:16 +0200 | [diff] [blame] | 67 | struct kref ref; |
| 68 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 69 | struct mutex sdp_lock; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 70 | |
| 71 | struct timer_list link_timer; |
| 72 | struct sk_buff_head tx_queue; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 73 | struct work_struct tx_work; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 74 | struct work_struct rx_work; |
| 75 | struct sk_buff *rx_pending; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 76 | struct work_struct timeout_work; |
| 77 | |
| 78 | u32 target_idx; |
| 79 | u8 rf_mode; |
| 80 | u8 comm_mode; |
Thierry Escande | 52feb44 | 2012-10-17 14:43:39 +0200 | [diff] [blame] | 81 | u8 lto; |
| 82 | u8 rw; |
| 83 | __be16 miux; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 84 | unsigned long local_wks; /* Well known services */ |
| 85 | unsigned long local_sdp; /* Local services */ |
| 86 | unsigned long local_sap; /* Local SAPs, not available for discovery */ |
Samuel Ortiz | 8f50020 | 2012-06-25 15:46:28 +0200 | [diff] [blame] | 87 | atomic_t local_sdp_cnt[LLCP_SDP_NUM_SAP]; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 88 | |
| 89 | /* local */ |
| 90 | u8 gb[NFC_MAX_GT_LEN]; |
| 91 | u8 gb_len; |
| 92 | |
| 93 | /* remote */ |
| 94 | u8 remote_gb[NFC_MAX_GT_LEN]; |
| 95 | u8 remote_gb_len; |
| 96 | |
| 97 | u8 remote_version; |
| 98 | u16 remote_miu; |
| 99 | u16 remote_lto; |
| 100 | u8 remote_opt; |
| 101 | u16 remote_wks; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 102 | |
Thierry Escande | d9b8d8e | 2013-02-15 10:43:06 +0100 | [diff] [blame] | 103 | struct mutex sdreq_lock; |
| 104 | struct hlist_head pending_sdreqs; |
Thierry Escande | 40213fa | 2013-03-04 15:43:32 +0100 | [diff] [blame] | 105 | struct timer_list sdreq_timer; |
| 106 | struct work_struct sdreq_timeout_work; |
Thierry Escande | d9b8d8e | 2013-02-15 10:43:06 +0100 | [diff] [blame] | 107 | u8 sdreq_next_tid; |
| 108 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 109 | /* sockets array */ |
Samuel Ortiz | a69f32a | 2012-05-04 17:04:19 +0200 | [diff] [blame] | 110 | struct llcp_sock_list sockets; |
| 111 | struct llcp_sock_list connecting_sockets; |
Thierry Escande | 4463523 | 2012-09-26 18:16:44 +0200 | [diff] [blame] | 112 | struct llcp_sock_list raw_sockets; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 113 | }; |
| 114 | |
| 115 | struct nfc_llcp_sock { |
| 116 | struct sock sk; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 117 | struct nfc_dev *dev; |
| 118 | struct nfc_llcp_local *local; |
| 119 | u32 target_idx; |
| 120 | u32 nfc_protocol; |
| 121 | |
Samuel Ortiz | 7a06e58 | 2012-05-07 22:03:34 +0200 | [diff] [blame] | 122 | /* Link parameters */ |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 123 | u8 ssap; |
| 124 | u8 dsap; |
| 125 | char *service_name; |
| 126 | size_t service_name_len; |
Samuel Ortiz | 26fd76c | 2013-02-22 10:53:25 +0100 | [diff] [blame] | 127 | u8 rw; |
Samuel Ortiz | 5eef666 | 2013-03-20 16:06:12 +0100 | [diff] [blame] | 128 | __be16 miux; |
Samuel Ortiz | 26fd76c | 2013-02-22 10:53:25 +0100 | [diff] [blame] | 129 | |
Samuel Ortiz | e4306be | 2013-02-22 01:12:28 +0100 | [diff] [blame] | 130 | |
| 131 | /* Remote link parameters */ |
| 132 | u8 remote_rw; |
| 133 | u16 remote_miu; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 134 | |
| 135 | /* Link variables */ |
| 136 | u8 send_n; |
| 137 | u8 send_ack_n; |
| 138 | u8 recv_n; |
| 139 | u8 recv_ack_n; |
| 140 | |
| 141 | /* Is the remote peer ready to receive */ |
| 142 | u8 remote_ready; |
| 143 | |
Samuel Ortiz | cbbf472 | 2012-06-22 14:48:11 +0200 | [diff] [blame] | 144 | /* Reserved source SAP */ |
| 145 | u8 reserved_ssap; |
| 146 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 147 | struct sk_buff_head tx_queue; |
| 148 | struct sk_buff_head tx_pending_queue; |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 149 | |
| 150 | struct list_head accept_queue; |
| 151 | struct sock *parent; |
| 152 | }; |
| 153 | |
Samuel Ortiz | 968272b | 2012-10-15 16:14:37 +0200 | [diff] [blame] | 154 | struct nfc_llcp_ui_cb { |
| 155 | __u8 dsap; |
| 156 | __u8 ssap; |
| 157 | }; |
| 158 | |
| 159 | #define nfc_llcp_ui_skb_cb(__skb) ((struct nfc_llcp_ui_cb *)&((__skb)->cb[0])) |
| 160 | |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 161 | #define nfc_llcp_sock(sk) ((struct nfc_llcp_sock *) (sk)) |
| 162 | #define nfc_llcp_dev(sk) (nfc_llcp_sock((sk))->dev) |
| 163 | |
| 164 | #define LLCP_HEADER_SIZE 2 |
| 165 | #define LLCP_SEQUENCE_SIZE 1 |
Thierry Escande | 098dafc | 2013-03-29 11:47:43 +0100 | [diff] [blame] | 166 | #define LLCP_AGF_PDU_HEADER_SIZE 2 |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 167 | |
| 168 | /* LLCP versions: 1.1 is 1.0 plus SDP */ |
| 169 | #define LLCP_VERSION_10 0x10 |
| 170 | #define LLCP_VERSION_11 0x11 |
| 171 | |
| 172 | /* LLCP PDU types */ |
| 173 | #define LLCP_PDU_SYMM 0x0 |
| 174 | #define LLCP_PDU_PAX 0x1 |
| 175 | #define LLCP_PDU_AGF 0x2 |
| 176 | #define LLCP_PDU_UI 0x3 |
| 177 | #define LLCP_PDU_CONNECT 0x4 |
| 178 | #define LLCP_PDU_DISC 0x5 |
| 179 | #define LLCP_PDU_CC 0x6 |
| 180 | #define LLCP_PDU_DM 0x7 |
| 181 | #define LLCP_PDU_FRMR 0x8 |
| 182 | #define LLCP_PDU_SNL 0x9 |
| 183 | #define LLCP_PDU_I 0xc |
| 184 | #define LLCP_PDU_RR 0xd |
| 185 | #define LLCP_PDU_RNR 0xe |
| 186 | |
| 187 | /* Parameters TLV types */ |
| 188 | #define LLCP_TLV_VERSION 0x1 |
| 189 | #define LLCP_TLV_MIUX 0x2 |
| 190 | #define LLCP_TLV_WKS 0x3 |
| 191 | #define LLCP_TLV_LTO 0x4 |
| 192 | #define LLCP_TLV_RW 0x5 |
| 193 | #define LLCP_TLV_SN 0x6 |
| 194 | #define LLCP_TLV_OPT 0x7 |
| 195 | #define LLCP_TLV_SDREQ 0x8 |
| 196 | #define LLCP_TLV_SDRES 0x9 |
| 197 | #define LLCP_TLV_MAX 0xa |
| 198 | |
| 199 | /* Well known LLCP SAP */ |
| 200 | #define LLCP_SAP_SDP 0x1 |
| 201 | #define LLCP_SAP_IP 0x2 |
| 202 | #define LLCP_SAP_OBEX 0x3 |
| 203 | #define LLCP_SAP_SNEP 0x4 |
| 204 | #define LLCP_SAP_MAX 0xff |
| 205 | |
| 206 | /* Disconnection reason code */ |
| 207 | #define LLCP_DM_DISC 0x00 |
| 208 | #define LLCP_DM_NOCONN 0x01 |
| 209 | #define LLCP_DM_NOBOUND 0x02 |
| 210 | #define LLCP_DM_REJ 0x03 |
| 211 | |
| 212 | |
Samuel Ortiz | a69f32a | 2012-05-04 17:04:19 +0200 | [diff] [blame] | 213 | void nfc_llcp_sock_link(struct llcp_sock_list *l, struct sock *s); |
| 214 | void nfc_llcp_sock_unlink(struct llcp_sock_list *l, struct sock *s); |
Thierry Escande | abd18d4 | 2013-04-02 10:25:15 +0200 | [diff] [blame] | 215 | void nfc_llcp_socket_remote_param_init(struct nfc_llcp_sock *sock); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 216 | struct nfc_llcp_local *nfc_llcp_find_local(struct nfc_dev *dev); |
Samuel Ortiz | c7aa122 | 2012-05-04 11:24:16 +0200 | [diff] [blame] | 217 | struct nfc_llcp_local *nfc_llcp_local_get(struct nfc_llcp_local *local); |
| 218 | int nfc_llcp_local_put(struct nfc_llcp_local *local); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 219 | u8 nfc_llcp_get_sdp_ssap(struct nfc_llcp_local *local, |
Samuel Ortiz | 427a2eb | 2012-03-05 01:03:52 +0100 | [diff] [blame] | 220 | struct nfc_llcp_sock *sock); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 221 | u8 nfc_llcp_get_local_ssap(struct nfc_llcp_local *local); |
| 222 | void nfc_llcp_put_ssap(struct nfc_llcp_local *local, u8 ssap); |
Samuel Ortiz | d094afa | 2012-03-05 01:03:42 +0100 | [diff] [blame] | 223 | int nfc_llcp_queue_i_frames(struct nfc_llcp_sock *sock); |
Thierry Escande | 4463523 | 2012-09-26 18:16:44 +0200 | [diff] [blame] | 224 | void nfc_llcp_send_to_raw_sock(struct nfc_llcp_local *local, |
| 225 | struct sk_buff *skb, u8 direction); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 226 | |
| 227 | /* Sock API */ |
Eric W. Biederman | 11aa9c2 | 2015-05-08 21:09:13 -0500 | [diff] [blame] | 228 | struct sock *nfc_llcp_sock_alloc(struct socket *sock, int type, gfp_t gfp, int kern); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 229 | void nfc_llcp_sock_free(struct nfc_llcp_sock *sock); |
| 230 | void nfc_llcp_accept_unlink(struct sock *sk); |
| 231 | void nfc_llcp_accept_enqueue(struct sock *parent, struct sock *sk); |
| 232 | struct sock *nfc_llcp_accept_dequeue(struct sock *sk, struct socket *newsock); |
| 233 | |
| 234 | /* TLV API */ |
Samuel Ortiz | 7a06e58 | 2012-05-07 22:03:34 +0200 | [diff] [blame] | 235 | int nfc_llcp_parse_gb_tlv(struct nfc_llcp_local *local, |
| 236 | u8 *tlv_array, u16 tlv_array_len); |
| 237 | int nfc_llcp_parse_connection_tlv(struct nfc_llcp_sock *sock, |
| 238 | u8 *tlv_array, u16 tlv_array_len); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 239 | |
| 240 | /* Commands API */ |
| 241 | void nfc_llcp_recv(void *data, struct sk_buff *skb, int err); |
| 242 | u8 *nfc_llcp_build_tlv(u8 type, u8 *value, u8 value_length, u8 *tlv_length); |
Thierry Escande | e0ae7ba | 2013-02-15 10:43:05 +0100 | [diff] [blame] | 243 | struct nfc_llcp_sdp_tlv *nfc_llcp_build_sdres_tlv(u8 tid, u8 sap); |
Thierry Escande | d9b8d8e | 2013-02-15 10:43:06 +0100 | [diff] [blame] | 244 | struct nfc_llcp_sdp_tlv *nfc_llcp_build_sdreq_tlv(u8 tid, char *uri, |
| 245 | size_t uri_len); |
Thierry Escande | e0ae7ba | 2013-02-15 10:43:05 +0100 | [diff] [blame] | 246 | void nfc_llcp_free_sdp_tlv(struct nfc_llcp_sdp_tlv *sdp); |
Thierry Escande | d9b8d8e | 2013-02-15 10:43:06 +0100 | [diff] [blame] | 247 | void nfc_llcp_free_sdp_tlv_list(struct hlist_head *sdp_head); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 248 | void nfc_llcp_recv(void *data, struct sk_buff *skb, int err); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 249 | int nfc_llcp_send_symm(struct nfc_dev *dev); |
| 250 | int nfc_llcp_send_connect(struct nfc_llcp_sock *sock); |
| 251 | int nfc_llcp_send_cc(struct nfc_llcp_sock *sock); |
Thierry Escande | e0ae7ba | 2013-02-15 10:43:05 +0100 | [diff] [blame] | 252 | int nfc_llcp_send_snl_sdres(struct nfc_llcp_local *local, |
| 253 | struct hlist_head *tlv_list, size_t tlvs_len); |
Thierry Escande | d9b8d8e | 2013-02-15 10:43:06 +0100 | [diff] [blame] | 254 | int nfc_llcp_send_snl_sdreq(struct nfc_llcp_local *local, |
| 255 | struct hlist_head *tlv_list, size_t tlvs_len); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 256 | int nfc_llcp_send_dm(struct nfc_llcp_local *local, u8 ssap, u8 dsap, u8 reason); |
| 257 | int nfc_llcp_send_disconnect(struct nfc_llcp_sock *sock); |
Samuel Ortiz | 53a0ac2 | 2012-03-05 01:03:37 +0100 | [diff] [blame] | 258 | int nfc_llcp_send_i_frame(struct nfc_llcp_sock *sock, |
Samuel Ortiz | 427a2eb | 2012-03-05 01:03:52 +0100 | [diff] [blame] | 259 | struct msghdr *msg, size_t len); |
Samuel Ortiz | 94f418a | 2012-10-16 15:01:40 +0200 | [diff] [blame] | 260 | int nfc_llcp_send_ui_frame(struct nfc_llcp_sock *sock, u8 ssap, u8 dsap, |
| 261 | struct msghdr *msg, size_t len); |
Samuel Ortiz | d094afa | 2012-03-05 01:03:42 +0100 | [diff] [blame] | 262 | int nfc_llcp_send_rr(struct nfc_llcp_sock *sock); |
Samuel Ortiz | d646960 | 2011-12-14 16:43:12 +0100 | [diff] [blame] | 263 | |
| 264 | /* Socket API */ |
| 265 | int __init nfc_llcp_sock_init(void); |
| 266 | void nfc_llcp_sock_exit(void); |