1 /* 2 * The NFC Controller Interface is the communication protocol between an 3 * NFC Controller (NFCC) and a Device Host (DH). 4 * 5 * Copyright (C) 2011 Texas Instruments, Inc. 6 * 7 * Written by Ilan Elias <ilane@ti.com> 8 * 9 * Acknowledgements: 10 * This file is based on hci_event.c, which was written 11 * by Maxim Krasnyansky. 12 * 13 * This program is free software; you can redistribute it and/or modify 14 * it under the terms of the GNU General Public License version 2 15 * as published by the Free Software Foundation 16 * 17 * This program is distributed in the hope that it will be useful, 18 * but WITHOUT ANY WARRANTY; without even the implied warranty of 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 20 * GNU General Public License for more details. 21 * 22 * You should have received a copy of the GNU General Public License 23 * along with this program; if not, write to the Free Software 24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 25 * 26 */ 27 28 #include <linux/types.h> 29 #include <linux/interrupt.h> 30 #include <linux/bitops.h> 31 #include <linux/skbuff.h> 32 33 #include "../nfc.h" 34 #include <net/nfc/nci.h> 35 #include <net/nfc/nci_core.h> 36 37 /* Handle NCI Response packets */ 38 39 static void nci_core_reset_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb) 40 { 41 struct nci_core_reset_rsp *rsp = (void *) skb->data; 42 43 nfc_dbg("entry, status 0x%x", rsp->status); 44 45 if (rsp->status == NCI_STATUS_OK) 46 ndev->nci_ver = rsp->nci_ver; 47 48 nfc_dbg("nci_ver 0x%x", ndev->nci_ver); 49 50 nci_req_complete(ndev, rsp->status); 51 } 52 53 static void nci_core_init_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb) 54 { 55 struct nci_core_init_rsp_1 *rsp_1 = (void *) skb->data; 56 struct nci_core_init_rsp_2 *rsp_2; 57 58 nfc_dbg("entry, status 0x%x", rsp_1->status); 59 60 if (rsp_1->status != NCI_STATUS_OK) 61 return; 62 63 ndev->nfcc_features = __le32_to_cpu(rsp_1->nfcc_features); 64 ndev->num_supported_rf_interfaces = rsp_1->num_supported_rf_interfaces; 65 66 if (ndev->num_supported_rf_interfaces > 67 NCI_MAX_SUPPORTED_RF_INTERFACES) { 68 ndev->num_supported_rf_interfaces = 69 NCI_MAX_SUPPORTED_RF_INTERFACES; 70 } 71 72 memcpy(ndev->supported_rf_interfaces, 73 rsp_1->supported_rf_interfaces, 74 ndev->num_supported_rf_interfaces); 75 76 rsp_2 = (void *) (skb->data + 6 + ndev->num_supported_rf_interfaces); 77 78 ndev->max_logical_connections = 79 rsp_2->max_logical_connections; 80 ndev->max_routing_table_size = 81 __le16_to_cpu(rsp_2->max_routing_table_size); 82 ndev->max_control_packet_payload_length = 83 rsp_2->max_control_packet_payload_length; 84 ndev->rf_sending_buffer_size = 85 __le16_to_cpu(rsp_2->rf_sending_buffer_size); 86 ndev->rf_receiving_buffer_size = 87 __le16_to_cpu(rsp_2->rf_receiving_buffer_size); 88 ndev->manufacturer_id = 89 __le16_to_cpu(rsp_2->manufacturer_id); 90 91 nfc_dbg("nfcc_features 0x%x", 92 ndev->nfcc_features); 93 nfc_dbg("num_supported_rf_interfaces %d", 94 ndev->num_supported_rf_interfaces); 95 nfc_dbg("supported_rf_interfaces[0] 0x%x", 96 ndev->supported_rf_interfaces[0]); 97 nfc_dbg("supported_rf_interfaces[1] 0x%x", 98 ndev->supported_rf_interfaces[1]); 99 nfc_dbg("supported_rf_interfaces[2] 0x%x", 100 ndev->supported_rf_interfaces[2]); 101 nfc_dbg("supported_rf_interfaces[3] 0x%x", 102 ndev->supported_rf_interfaces[3]); 103 nfc_dbg("max_logical_connections %d", 104 ndev->max_logical_connections); 105 nfc_dbg("max_routing_table_size %d", 106 ndev->max_routing_table_size); 107 nfc_dbg("max_control_packet_payload_length %d", 108 ndev->max_control_packet_payload_length); 109 nfc_dbg("rf_sending_buffer_size %d", 110 ndev->rf_sending_buffer_size); 111 nfc_dbg("rf_receiving_buffer_size %d", 112 ndev->rf_receiving_buffer_size); 113 nfc_dbg("manufacturer_id 0x%x", 114 ndev->manufacturer_id); 115 116 nci_req_complete(ndev, rsp_1->status); 117 } 118 119 static void nci_core_conn_create_rsp_packet(struct nci_dev *ndev, 120 struct sk_buff *skb) 121 { 122 struct nci_core_conn_create_rsp *rsp = (void *) skb->data; 123 124 nfc_dbg("entry, status 0x%x", rsp->status); 125 126 if (rsp->status != NCI_STATUS_OK) 127 return; 128 129 ndev->max_pkt_payload_size = rsp->max_pkt_payload_size; 130 ndev->initial_num_credits = rsp->initial_num_credits; 131 ndev->conn_id = rsp->conn_id; 132 133 atomic_set(&ndev->credits_cnt, ndev->initial_num_credits); 134 135 nfc_dbg("max_pkt_payload_size %d", ndev->max_pkt_payload_size); 136 nfc_dbg("initial_num_credits %d", ndev->initial_num_credits); 137 nfc_dbg("conn_id %d", ndev->conn_id); 138 } 139 140 static void nci_rf_disc_map_rsp_packet(struct nci_dev *ndev, 141 struct sk_buff *skb) 142 { 143 __u8 status = skb->data[0]; 144 145 nfc_dbg("entry, status 0x%x", status); 146 147 nci_req_complete(ndev, status); 148 } 149 150 static void nci_rf_disc_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb) 151 { 152 __u8 status = skb->data[0]; 153 154 nfc_dbg("entry, status 0x%x", status); 155 156 if (status == NCI_STATUS_OK) 157 set_bit(NCI_DISCOVERY, &ndev->flags); 158 159 nci_req_complete(ndev, status); 160 } 161 162 static void nci_rf_deactivate_rsp_packet(struct nci_dev *ndev, 163 struct sk_buff *skb) 164 { 165 __u8 status = skb->data[0]; 166 167 nfc_dbg("entry, status 0x%x", status); 168 169 clear_bit(NCI_DISCOVERY, &ndev->flags); 170 171 nci_req_complete(ndev, status); 172 } 173 174 void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb) 175 { 176 __u16 rsp_opcode = nci_opcode(skb->data); 177 178 /* we got a rsp, stop the cmd timer */ 179 del_timer(&ndev->cmd_timer); 180 181 nfc_dbg("NCI RX: MT=rsp, PBF=%d, GID=0x%x, OID=0x%x, plen=%d", 182 nci_pbf(skb->data), 183 nci_opcode_gid(rsp_opcode), 184 nci_opcode_oid(rsp_opcode), 185 nci_plen(skb->data)); 186 187 /* strip the nci control header */ 188 skb_pull(skb, NCI_CTRL_HDR_SIZE); 189 190 switch (rsp_opcode) { 191 case NCI_OP_CORE_RESET_RSP: 192 nci_core_reset_rsp_packet(ndev, skb); 193 break; 194 195 case NCI_OP_CORE_INIT_RSP: 196 nci_core_init_rsp_packet(ndev, skb); 197 break; 198 199 case NCI_OP_CORE_CONN_CREATE_RSP: 200 nci_core_conn_create_rsp_packet(ndev, skb); 201 break; 202 203 case NCI_OP_RF_DISCOVER_MAP_RSP: 204 nci_rf_disc_map_rsp_packet(ndev, skb); 205 break; 206 207 case NCI_OP_RF_DISCOVER_RSP: 208 nci_rf_disc_rsp_packet(ndev, skb); 209 break; 210 211 case NCI_OP_RF_DEACTIVATE_RSP: 212 nci_rf_deactivate_rsp_packet(ndev, skb); 213 break; 214 215 default: 216 nfc_err("unknown rsp opcode 0x%x", rsp_opcode); 217 break; 218 } 219 220 kfree_skb(skb); 221 222 /* trigger the next cmd */ 223 atomic_set(&ndev->cmd_cnt, 1); 224 if (!skb_queue_empty(&ndev->cmd_q)) 225 queue_work(ndev->cmd_wq, &ndev->cmd_work); 226 } 227