2 * The NFC Controller Interface is the communication protocol between an
3 * NFC Controller (NFCC) and a Device Host (DH).
5 * Copyright (C) 2011 Texas Instruments, Inc.
7 * Written by Ilan Elias <ilane@ti.com>
10 * This file is based on hci_event.c, which was written
11 * by Maxim Krasnyansky.
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
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.
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
28 #include <linux/types.h>
29 #include <linux/interrupt.h>
30 #include <linux/bitops.h>
31 #include <linux/skbuff.h>
34 #include <net/nfc/nci.h>
35 #include <net/nfc/nci_core.h>
37 /* Handle NCI Response packets */
39 static void nci_core_reset_rsp_packet(struct nci_dev
*ndev
, struct sk_buff
*skb
)
41 struct nci_core_reset_rsp
*rsp
= (void *) skb
->data
;
43 nfc_dbg("entry, status 0x%x", rsp
->status
);
45 if (rsp
->status
== NCI_STATUS_OK
)
46 ndev
->nci_ver
= rsp
->nci_ver
;
48 nfc_dbg("nci_ver 0x%x", ndev
->nci_ver
);
50 nci_req_complete(ndev
, rsp
->status
);
53 static void nci_core_init_rsp_packet(struct nci_dev
*ndev
, struct sk_buff
*skb
)
55 struct nci_core_init_rsp_1
*rsp_1
= (void *) skb
->data
;
56 struct nci_core_init_rsp_2
*rsp_2
;
58 nfc_dbg("entry, status 0x%x", rsp_1
->status
);
60 if (rsp_1
->status
!= NCI_STATUS_OK
)
63 ndev
->nfcc_features
= __le32_to_cpu(rsp_1
->nfcc_features
);
64 ndev
->num_supported_rf_interfaces
= rsp_1
->num_supported_rf_interfaces
;
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
;
72 memcpy(ndev
->supported_rf_interfaces
,
73 rsp_1
->supported_rf_interfaces
,
74 ndev
->num_supported_rf_interfaces
);
76 rsp_2
= (void *) (skb
->data
+ 6 + ndev
->num_supported_rf_interfaces
);
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
);
91 nfc_dbg("nfcc_features 0x%x",
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
);
116 nci_req_complete(ndev
, rsp_1
->status
);
119 static void nci_core_conn_create_rsp_packet(struct nci_dev
*ndev
,
122 struct nci_core_conn_create_rsp
*rsp
= (void *) skb
->data
;
124 nfc_dbg("entry, status 0x%x", rsp
->status
);
126 if (rsp
->status
!= NCI_STATUS_OK
)
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
;
133 atomic_set(&ndev
->credits_cnt
, ndev
->initial_num_credits
);
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
);
140 static void nci_rf_disc_map_rsp_packet(struct nci_dev
*ndev
,
143 __u8 status
= skb
->data
[0];
145 nfc_dbg("entry, status 0x%x", status
);
147 nci_req_complete(ndev
, status
);
150 static void nci_rf_disc_rsp_packet(struct nci_dev
*ndev
, struct sk_buff
*skb
)
152 __u8 status
= skb
->data
[0];
154 nfc_dbg("entry, status 0x%x", status
);
156 if (status
== NCI_STATUS_OK
)
157 set_bit(NCI_DISCOVERY
, &ndev
->flags
);
159 nci_req_complete(ndev
, status
);
162 static void nci_rf_deactivate_rsp_packet(struct nci_dev
*ndev
,
165 __u8 status
= skb
->data
[0];
167 nfc_dbg("entry, status 0x%x", status
);
169 clear_bit(NCI_DISCOVERY
, &ndev
->flags
);
171 nci_req_complete(ndev
, status
);
174 void nci_rsp_packet(struct nci_dev
*ndev
, struct sk_buff
*skb
)
176 __u16 rsp_opcode
= nci_opcode(skb
->data
);
178 /* we got a rsp, stop the cmd timer */
179 del_timer(&ndev
->cmd_timer
);
181 nfc_dbg("NCI RX: MT=rsp, PBF=%d, GID=0x%x, OID=0x%x, plen=%d",
183 nci_opcode_gid(rsp_opcode
),
184 nci_opcode_oid(rsp_opcode
),
185 nci_plen(skb
->data
));
187 /* strip the nci control header */
188 skb_pull(skb
, NCI_CTRL_HDR_SIZE
);
190 switch (rsp_opcode
) {
191 case NCI_OP_CORE_RESET_RSP
:
192 nci_core_reset_rsp_packet(ndev
, skb
);
195 case NCI_OP_CORE_INIT_RSP
:
196 nci_core_init_rsp_packet(ndev
, skb
);
199 case NCI_OP_CORE_CONN_CREATE_RSP
:
200 nci_core_conn_create_rsp_packet(ndev
, skb
);
203 case NCI_OP_RF_DISCOVER_MAP_RSP
:
204 nci_rf_disc_map_rsp_packet(ndev
, skb
);
207 case NCI_OP_RF_DISCOVER_RSP
:
208 nci_rf_disc_rsp_packet(ndev
, skb
);
211 case NCI_OP_RF_DEACTIVATE_RSP
:
212 nci_rf_deactivate_rsp_packet(ndev
, skb
);
216 nfc_err("unknown rsp opcode 0x%x", rsp_opcode
);
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
);