1c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2a06347c0SRobert Dolca /* -------------------------------------------------------------------------
3a06347c0SRobert Dolca * Copyright (C) 2014-2016, Intel Corporation
4a06347c0SRobert Dolca *
5a06347c0SRobert Dolca * -------------------------------------------------------------------------
6a06347c0SRobert Dolca */
7a06347c0SRobert Dolca
8a06347c0SRobert Dolca #include <linux/module.h>
9a06347c0SRobert Dolca #include <linux/nfc.h>
10a06347c0SRobert Dolca #include <linux/i2c.h>
11a06347c0SRobert Dolca #include <linux/delay.h>
12a06347c0SRobert Dolca #include <linux/firmware.h>
13a06347c0SRobert Dolca #include <net/nfc/nci_core.h>
14a06347c0SRobert Dolca
15a06347c0SRobert Dolca #include "fdp.h"
16a06347c0SRobert Dolca
17a06347c0SRobert Dolca #define FDP_OTP_PATCH_NAME "otp.bin"
18a06347c0SRobert Dolca #define FDP_RAM_PATCH_NAME "ram.bin"
19a06347c0SRobert Dolca #define FDP_FW_HEADER_SIZE 576
20a06347c0SRobert Dolca #define FDP_FW_UPDATE_SLEEP 1000
21a06347c0SRobert Dolca
22a06347c0SRobert Dolca #define NCI_GET_VERSION_TIMEOUT 8000
23a06347c0SRobert Dolca #define NCI_PATCH_REQUEST_TIMEOUT 8000
24a06347c0SRobert Dolca #define FDP_PATCH_CONN_DEST 0xC2
25a06347c0SRobert Dolca #define FDP_PATCH_CONN_PARAM_TYPE 0xA0
26a06347c0SRobert Dolca
27a06347c0SRobert Dolca #define NCI_PATCH_TYPE_RAM 0x00
28a06347c0SRobert Dolca #define NCI_PATCH_TYPE_OTP 0x01
29a06347c0SRobert Dolca #define NCI_PATCH_TYPE_EOT 0xFF
30a06347c0SRobert Dolca
31a06347c0SRobert Dolca #define NCI_PARAM_ID_FW_RAM_VERSION 0xA0
32a06347c0SRobert Dolca #define NCI_PARAM_ID_FW_OTP_VERSION 0xA1
33a06347c0SRobert Dolca #define NCI_PARAM_ID_OTP_LIMITED_VERSION 0xC5
34a06347c0SRobert Dolca #define NCI_PARAM_ID_KEY_INDEX_ID 0xC6
35a06347c0SRobert Dolca
36a06347c0SRobert Dolca #define NCI_GID_PROP 0x0F
37a06347c0SRobert Dolca #define NCI_OP_PROP_PATCH_OID 0x08
38a06347c0SRobert Dolca #define NCI_OP_PROP_SET_PDATA_OID 0x23
39a06347c0SRobert Dolca
40a06347c0SRobert Dolca struct fdp_nci_info {
417a5e98daSKrzysztof Kozlowski const struct nfc_phy_ops *phy_ops;
42a06347c0SRobert Dolca struct fdp_i2c_phy *phy;
43a06347c0SRobert Dolca struct nci_dev *ndev;
44a06347c0SRobert Dolca
45a06347c0SRobert Dolca const struct firmware *otp_patch;
46a06347c0SRobert Dolca const struct firmware *ram_patch;
47a06347c0SRobert Dolca u32 otp_patch_version;
48a06347c0SRobert Dolca u32 ram_patch_version;
49a06347c0SRobert Dolca
50a06347c0SRobert Dolca u32 otp_version;
51a06347c0SRobert Dolca u32 ram_version;
52a06347c0SRobert Dolca u32 limited_otp_version;
53a06347c0SRobert Dolca u8 key_index;
54a06347c0SRobert Dolca
553d463dd5SKrzysztof Kozlowski const u8 *fw_vsc_cfg;
56a06347c0SRobert Dolca u8 clock_type;
57a06347c0SRobert Dolca u32 clock_freq;
58a06347c0SRobert Dolca
59a06347c0SRobert Dolca atomic_t data_pkt_counter;
60a06347c0SRobert Dolca void (*data_pkt_counter_cb)(struct nci_dev *ndev);
61a06347c0SRobert Dolca u8 setup_patch_sent;
62a06347c0SRobert Dolca u8 setup_patch_ntf;
63a06347c0SRobert Dolca u8 setup_patch_status;
64a06347c0SRobert Dolca u8 setup_reset_ntf;
65a06347c0SRobert Dolca wait_queue_head_t setup_wq;
66a06347c0SRobert Dolca };
67a06347c0SRobert Dolca
683d463dd5SKrzysztof Kozlowski static const u8 nci_core_get_config_otp_ram_version[5] = {
69a06347c0SRobert Dolca 0x04,
70a06347c0SRobert Dolca NCI_PARAM_ID_FW_RAM_VERSION,
71a06347c0SRobert Dolca NCI_PARAM_ID_FW_OTP_VERSION,
72a06347c0SRobert Dolca NCI_PARAM_ID_OTP_LIMITED_VERSION,
73a06347c0SRobert Dolca NCI_PARAM_ID_KEY_INDEX_ID
74a06347c0SRobert Dolca };
75a06347c0SRobert Dolca
76a06347c0SRobert Dolca struct nci_core_get_config_rsp {
77a06347c0SRobert Dolca u8 status;
78a06347c0SRobert Dolca u8 count;
79da60fbe7SGustavo A. R. Silva u8 data[];
80a06347c0SRobert Dolca };
81a06347c0SRobert Dolca
fdp_nci_create_conn(struct nci_dev * ndev)82a06347c0SRobert Dolca static int fdp_nci_create_conn(struct nci_dev *ndev)
83a06347c0SRobert Dolca {
84a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
85a06347c0SRobert Dolca struct core_conn_create_dest_spec_params param;
86a06347c0SRobert Dolca int r;
87a06347c0SRobert Dolca
88a06347c0SRobert Dolca /* proprietary destination specific paramerer without value */
89a06347c0SRobert Dolca param.type = FDP_PATCH_CONN_PARAM_TYPE;
90a06347c0SRobert Dolca param.length = 0x00;
91a06347c0SRobert Dolca
92a06347c0SRobert Dolca r = nci_core_conn_create(info->ndev, FDP_PATCH_CONN_DEST, 1,
93a06347c0SRobert Dolca sizeof(param), ¶m);
94a06347c0SRobert Dolca if (r)
95a06347c0SRobert Dolca return r;
96a06347c0SRobert Dolca
979b8d1a4cSChristophe Ricard return nci_get_conn_info_by_dest_type_params(ndev,
989b8d1a4cSChristophe Ricard FDP_PATCH_CONN_DEST, NULL);
99a06347c0SRobert Dolca }
100a06347c0SRobert Dolca
fdp_nci_get_versions(struct nci_dev * ndev)101a06347c0SRobert Dolca static inline int fdp_nci_get_versions(struct nci_dev *ndev)
102a06347c0SRobert Dolca {
103a06347c0SRobert Dolca return nci_core_cmd(ndev, NCI_OP_CORE_GET_CONFIG_CMD,
104a06347c0SRobert Dolca sizeof(nci_core_get_config_otp_ram_version),
105a06347c0SRobert Dolca (__u8 *) &nci_core_get_config_otp_ram_version);
106a06347c0SRobert Dolca }
107a06347c0SRobert Dolca
fdp_nci_patch_cmd(struct nci_dev * ndev,u8 type)108a06347c0SRobert Dolca static inline int fdp_nci_patch_cmd(struct nci_dev *ndev, u8 type)
109a06347c0SRobert Dolca {
110a06347c0SRobert Dolca return nci_prop_cmd(ndev, NCI_OP_PROP_PATCH_OID, sizeof(type), &type);
111a06347c0SRobert Dolca }
112a06347c0SRobert Dolca
fdp_nci_set_production_data(struct nci_dev * ndev,u8 len,const char * data)113a06347c0SRobert Dolca static inline int fdp_nci_set_production_data(struct nci_dev *ndev, u8 len,
1143d463dd5SKrzysztof Kozlowski const char *data)
115a06347c0SRobert Dolca {
116a06347c0SRobert Dolca return nci_prop_cmd(ndev, NCI_OP_PROP_SET_PDATA_OID, len, data);
117a06347c0SRobert Dolca }
118a06347c0SRobert Dolca
fdp_nci_set_clock(struct nci_dev * ndev,u8 clock_type,u32 clock_freq)119a06347c0SRobert Dolca static int fdp_nci_set_clock(struct nci_dev *ndev, u8 clock_type,
120a06347c0SRobert Dolca u32 clock_freq)
121a06347c0SRobert Dolca {
122a06347c0SRobert Dolca u32 fc = 13560;
123a06347c0SRobert Dolca u32 nd, num, delta;
124a06347c0SRobert Dolca char data[9];
125a06347c0SRobert Dolca
126a06347c0SRobert Dolca nd = (24 * fc) / clock_freq;
127a06347c0SRobert Dolca delta = 24 * fc - nd * clock_freq;
128a06347c0SRobert Dolca num = (32768 * delta) / clock_freq;
129a06347c0SRobert Dolca
130a06347c0SRobert Dolca data[0] = 0x00;
131a06347c0SRobert Dolca data[1] = 0x00;
132a06347c0SRobert Dolca data[2] = 0x00;
133a06347c0SRobert Dolca
134a06347c0SRobert Dolca data[3] = 0x10;
135a06347c0SRobert Dolca data[4] = 0x04;
136a06347c0SRobert Dolca data[5] = num & 0xFF;
137a06347c0SRobert Dolca data[6] = (num >> 8) & 0xff;
138a06347c0SRobert Dolca data[7] = nd;
139a06347c0SRobert Dolca data[8] = clock_type;
140a06347c0SRobert Dolca
141a06347c0SRobert Dolca return fdp_nci_set_production_data(ndev, 9, data);
142a06347c0SRobert Dolca }
143a06347c0SRobert Dolca
fdp_nci_send_patch_cb(struct nci_dev * ndev)144a06347c0SRobert Dolca static void fdp_nci_send_patch_cb(struct nci_dev *ndev)
145a06347c0SRobert Dolca {
146a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
147a06347c0SRobert Dolca
148a06347c0SRobert Dolca info->setup_patch_sent = 1;
149a06347c0SRobert Dolca wake_up(&info->setup_wq);
150a06347c0SRobert Dolca }
151a06347c0SRobert Dolca
152cd4375d6SKrzysztof Kozlowski /*
153a06347c0SRobert Dolca * Register a packet sent counter and a callback
154a06347c0SRobert Dolca *
155a06347c0SRobert Dolca * We have no other way of knowing when all firmware packets were sent out
156a06347c0SRobert Dolca * on the i2c bus. We need to know that in order to close the connection and
157a06347c0SRobert Dolca * send the patch end message.
158a06347c0SRobert Dolca */
fdp_nci_set_data_pkt_counter(struct nci_dev * ndev,void (* cb)(struct nci_dev * ndev),int count)159a06347c0SRobert Dolca static void fdp_nci_set_data_pkt_counter(struct nci_dev *ndev,
160a06347c0SRobert Dolca void (*cb)(struct nci_dev *ndev), int count)
161a06347c0SRobert Dolca {
162a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
163a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
164a06347c0SRobert Dolca
165a06347c0SRobert Dolca dev_dbg(dev, "NCI data pkt counter %d\n", count);
166a06347c0SRobert Dolca atomic_set(&info->data_pkt_counter, count);
167a06347c0SRobert Dolca info->data_pkt_counter_cb = cb;
168a06347c0SRobert Dolca }
169a06347c0SRobert Dolca
170cd4375d6SKrzysztof Kozlowski /*
171a06347c0SRobert Dolca * The device is expecting a stream of packets. All packets need to
172a06347c0SRobert Dolca * have the PBF flag set to 0x0 (last packet) even if the firmware
173a06347c0SRobert Dolca * file is segmented and there are multiple packets. If we give the
174a06347c0SRobert Dolca * whole firmware to nci_send_data it will segment it and it will set
175a06347c0SRobert Dolca * the PBF flag to 0x01 so we need to do the segmentation here.
176a06347c0SRobert Dolca *
177a06347c0SRobert Dolca * The firmware will be analyzed and applied when we send NCI_OP_PROP_PATCH_CMD
178a06347c0SRobert Dolca * command with NCI_PATCH_TYPE_EOT parameter. The device will send a
1790853f5abSBhaskar Chowdhury * NFCC_PATCH_NTF packet and a NCI_OP_CORE_RESET_NTF packet.
180a06347c0SRobert Dolca */
fdp_nci_send_patch(struct nci_dev * ndev,u8 conn_id,u8 type)181a06347c0SRobert Dolca static int fdp_nci_send_patch(struct nci_dev *ndev, u8 conn_id, u8 type)
182a06347c0SRobert Dolca {
183a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
184a06347c0SRobert Dolca const struct firmware *fw;
185a06347c0SRobert Dolca struct sk_buff *skb;
186a06347c0SRobert Dolca unsigned long len;
1870dcdf9f6SDan Carpenter int max_size, payload_size;
188a06347c0SRobert Dolca int rc = 0;
189a06347c0SRobert Dolca
190a06347c0SRobert Dolca if ((type == NCI_PATCH_TYPE_OTP && !info->otp_patch) ||
191a06347c0SRobert Dolca (type == NCI_PATCH_TYPE_RAM && !info->ram_patch))
192a06347c0SRobert Dolca return -EINVAL;
193a06347c0SRobert Dolca
194a06347c0SRobert Dolca if (type == NCI_PATCH_TYPE_OTP)
195a06347c0SRobert Dolca fw = info->otp_patch;
196a06347c0SRobert Dolca else
197a06347c0SRobert Dolca fw = info->ram_patch;
198a06347c0SRobert Dolca
199a06347c0SRobert Dolca max_size = nci_conn_max_data_pkt_payload_size(ndev, conn_id);
200a06347c0SRobert Dolca if (max_size <= 0)
201a06347c0SRobert Dolca return -EINVAL;
202a06347c0SRobert Dolca
203a06347c0SRobert Dolca len = fw->size;
204a06347c0SRobert Dolca
205a06347c0SRobert Dolca fdp_nci_set_data_pkt_counter(ndev, fdp_nci_send_patch_cb,
206a06347c0SRobert Dolca DIV_ROUND_UP(fw->size, max_size));
207a06347c0SRobert Dolca
208a06347c0SRobert Dolca while (len) {
209a06347c0SRobert Dolca
2100dcdf9f6SDan Carpenter payload_size = min_t(unsigned long, max_size, len);
211a06347c0SRobert Dolca
212a06347c0SRobert Dolca skb = nci_skb_alloc(ndev, (NCI_CTRL_HDR_SIZE + payload_size),
213a06347c0SRobert Dolca GFP_KERNEL);
214a06347c0SRobert Dolca if (!skb) {
215a06347c0SRobert Dolca fdp_nci_set_data_pkt_counter(ndev, NULL, 0);
216a06347c0SRobert Dolca return -ENOMEM;
217a06347c0SRobert Dolca }
218a06347c0SRobert Dolca
219a06347c0SRobert Dolca
220a06347c0SRobert Dolca skb_reserve(skb, NCI_CTRL_HDR_SIZE);
221a06347c0SRobert Dolca
22259ae1d12SJohannes Berg skb_put_data(skb, fw->data + (fw->size - len), payload_size);
223a06347c0SRobert Dolca
224a06347c0SRobert Dolca rc = nci_send_data(ndev, conn_id, skb);
225a06347c0SRobert Dolca
226a06347c0SRobert Dolca if (rc) {
227a06347c0SRobert Dolca fdp_nci_set_data_pkt_counter(ndev, NULL, 0);
228a06347c0SRobert Dolca return rc;
229a06347c0SRobert Dolca }
230a06347c0SRobert Dolca
231a06347c0SRobert Dolca len -= payload_size;
232a06347c0SRobert Dolca }
233a06347c0SRobert Dolca
234a06347c0SRobert Dolca return rc;
235a06347c0SRobert Dolca }
236a06347c0SRobert Dolca
fdp_nci_open(struct nci_dev * ndev)237a06347c0SRobert Dolca static int fdp_nci_open(struct nci_dev *ndev)
238a06347c0SRobert Dolca {
2393d463dd5SKrzysztof Kozlowski const struct fdp_nci_info *info = nci_get_drvdata(ndev);
240a06347c0SRobert Dolca
24192a310cdSzuoqilin return info->phy_ops->enable(info->phy);
242a06347c0SRobert Dolca }
243a06347c0SRobert Dolca
fdp_nci_close(struct nci_dev * ndev)244a06347c0SRobert Dolca static int fdp_nci_close(struct nci_dev *ndev)
245a06347c0SRobert Dolca {
246a06347c0SRobert Dolca return 0;
247a06347c0SRobert Dolca }
248a06347c0SRobert Dolca
fdp_nci_send(struct nci_dev * ndev,struct sk_buff * skb)249a06347c0SRobert Dolca static int fdp_nci_send(struct nci_dev *ndev, struct sk_buff *skb)
250a06347c0SRobert Dolca {
251a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
2528e4aae6bSShang XiaoJing int ret;
253a06347c0SRobert Dolca
254a06347c0SRobert Dolca if (atomic_dec_and_test(&info->data_pkt_counter))
255a06347c0SRobert Dolca info->data_pkt_counter_cb(ndev);
256a06347c0SRobert Dolca
2578e4aae6bSShang XiaoJing ret = info->phy_ops->write(info->phy, skb);
2588e4aae6bSShang XiaoJing if (ret < 0) {
2598e4aae6bSShang XiaoJing kfree_skb(skb);
2608e4aae6bSShang XiaoJing return ret;
2618e4aae6bSShang XiaoJing }
2628e4aae6bSShang XiaoJing
2638e4aae6bSShang XiaoJing consume_skb(skb);
2648e4aae6bSShang XiaoJing return 0;
265a06347c0SRobert Dolca }
266a06347c0SRobert Dolca
fdp_nci_request_firmware(struct nci_dev * ndev)267a06347c0SRobert Dolca static int fdp_nci_request_firmware(struct nci_dev *ndev)
268a06347c0SRobert Dolca {
269a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
270a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
2713d463dd5SKrzysztof Kozlowski const u8 *data;
272a06347c0SRobert Dolca int r;
273a06347c0SRobert Dolca
274a06347c0SRobert Dolca r = request_firmware(&info->ram_patch, FDP_RAM_PATCH_NAME, dev);
275a06347c0SRobert Dolca if (r < 0) {
276a06347c0SRobert Dolca nfc_err(dev, "RAM patch request error\n");
27743fa32d1Swengjianfeng return r;
278a06347c0SRobert Dolca }
279a06347c0SRobert Dolca
2803d463dd5SKrzysztof Kozlowski data = info->ram_patch->data;
281a06347c0SRobert Dolca info->ram_patch_version =
282a06347c0SRobert Dolca data[FDP_FW_HEADER_SIZE] |
283a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE + 1] << 8) |
284a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE + 2] << 16) |
285a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE + 3] << 24);
286a06347c0SRobert Dolca
2876c755b1dSKrzysztof Kozlowski dev_dbg(dev, "RAM patch version: %d, size: %zu\n",
2886c755b1dSKrzysztof Kozlowski info->ram_patch_version, info->ram_patch->size);
289a06347c0SRobert Dolca
290a06347c0SRobert Dolca
291a06347c0SRobert Dolca r = request_firmware(&info->otp_patch, FDP_OTP_PATCH_NAME, dev);
292a06347c0SRobert Dolca if (r < 0) {
293a06347c0SRobert Dolca nfc_err(dev, "OTP patch request error\n");
29443fa32d1Swengjianfeng return 0;
295a06347c0SRobert Dolca }
296a06347c0SRobert Dolca
297a06347c0SRobert Dolca data = (u8 *) info->otp_patch->data;
298a06347c0SRobert Dolca info->otp_patch_version =
299a06347c0SRobert Dolca data[FDP_FW_HEADER_SIZE] |
300a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE + 1] << 8) |
301a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE+2] << 16) |
302a06347c0SRobert Dolca (data[FDP_FW_HEADER_SIZE+3] << 24);
303a06347c0SRobert Dolca
3046c755b1dSKrzysztof Kozlowski dev_dbg(dev, "OTP patch version: %d, size: %zu\n",
3056c755b1dSKrzysztof Kozlowski info->otp_patch_version, info->otp_patch->size);
306a06347c0SRobert Dolca return 0;
307a06347c0SRobert Dolca }
308a06347c0SRobert Dolca
fdp_nci_release_firmware(struct nci_dev * ndev)309a06347c0SRobert Dolca static void fdp_nci_release_firmware(struct nci_dev *ndev)
310a06347c0SRobert Dolca {
311a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
312a06347c0SRobert Dolca
313a06347c0SRobert Dolca if (info->otp_patch) {
314a06347c0SRobert Dolca release_firmware(info->otp_patch);
315a06347c0SRobert Dolca info->otp_patch = NULL;
316a06347c0SRobert Dolca }
317a06347c0SRobert Dolca
318a06347c0SRobert Dolca if (info->ram_patch) {
319a06347c0SRobert Dolca release_firmware(info->ram_patch);
320f36acc33SColin Ian King info->ram_patch = NULL;
321a06347c0SRobert Dolca }
322a06347c0SRobert Dolca }
323a06347c0SRobert Dolca
fdp_nci_patch_otp(struct nci_dev * ndev)324a06347c0SRobert Dolca static int fdp_nci_patch_otp(struct nci_dev *ndev)
325a06347c0SRobert Dolca {
326a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
327a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
328fa1ce54eSGeert Uytterhoeven int conn_id;
329a06347c0SRobert Dolca int r = 0;
330a06347c0SRobert Dolca
331a06347c0SRobert Dolca if (info->otp_version >= info->otp_patch_version)
332872fff33Swengjianfeng return r;
333a06347c0SRobert Dolca
334a06347c0SRobert Dolca info->setup_patch_sent = 0;
335a06347c0SRobert Dolca info->setup_reset_ntf = 0;
336a06347c0SRobert Dolca info->setup_patch_ntf = 0;
337a06347c0SRobert Dolca
338a06347c0SRobert Dolca /* Patch init request */
339a06347c0SRobert Dolca r = fdp_nci_patch_cmd(ndev, NCI_PATCH_TYPE_OTP);
340a06347c0SRobert Dolca if (r)
341872fff33Swengjianfeng return r;
342a06347c0SRobert Dolca
343a06347c0SRobert Dolca /* Patch data connection creation */
344a06347c0SRobert Dolca conn_id = fdp_nci_create_conn(ndev);
345872fff33Swengjianfeng if (conn_id < 0)
346872fff33Swengjianfeng return conn_id;
347a06347c0SRobert Dolca
348a06347c0SRobert Dolca /* Send the patch over the data connection */
349a06347c0SRobert Dolca r = fdp_nci_send_patch(ndev, conn_id, NCI_PATCH_TYPE_OTP);
350a06347c0SRobert Dolca if (r)
351872fff33Swengjianfeng return r;
352a06347c0SRobert Dolca
353a06347c0SRobert Dolca /* Wait for all the packets to be send over i2c */
354a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq,
355a06347c0SRobert Dolca info->setup_patch_sent == 1);
356a06347c0SRobert Dolca
357a06347c0SRobert Dolca /* make sure that the NFCC processed the last data packet */
358a06347c0SRobert Dolca msleep(FDP_FW_UPDATE_SLEEP);
359a06347c0SRobert Dolca
360a06347c0SRobert Dolca /* Close the data connection */
361a06347c0SRobert Dolca r = nci_core_conn_close(info->ndev, conn_id);
362a06347c0SRobert Dolca if (r)
363872fff33Swengjianfeng return r;
364a06347c0SRobert Dolca
365a06347c0SRobert Dolca /* Patch finish message */
366a06347c0SRobert Dolca if (fdp_nci_patch_cmd(ndev, NCI_PATCH_TYPE_EOT)) {
367a06347c0SRobert Dolca nfc_err(dev, "OTP patch error 0x%x\n", r);
368872fff33Swengjianfeng return -EINVAL;
369a06347c0SRobert Dolca }
370a06347c0SRobert Dolca
371a06347c0SRobert Dolca /* If the patch notification didn't arrive yet, wait for it */
372a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq, info->setup_patch_ntf);
373a06347c0SRobert Dolca
374a06347c0SRobert Dolca /* Check if the patching was successful */
375a06347c0SRobert Dolca r = info->setup_patch_status;
376a06347c0SRobert Dolca if (r) {
377a06347c0SRobert Dolca nfc_err(dev, "OTP patch error 0x%x\n", r);
378872fff33Swengjianfeng return -EINVAL;
379a06347c0SRobert Dolca }
380a06347c0SRobert Dolca
381a06347c0SRobert Dolca /*
382a06347c0SRobert Dolca * We need to wait for the reset notification before we
383a06347c0SRobert Dolca * can continue
384a06347c0SRobert Dolca */
385a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq, info->setup_reset_ntf);
386a06347c0SRobert Dolca
387a06347c0SRobert Dolca return r;
388a06347c0SRobert Dolca }
389a06347c0SRobert Dolca
fdp_nci_patch_ram(struct nci_dev * ndev)390a06347c0SRobert Dolca static int fdp_nci_patch_ram(struct nci_dev *ndev)
391a06347c0SRobert Dolca {
392a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
393a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
394fa1ce54eSGeert Uytterhoeven int conn_id;
395a06347c0SRobert Dolca int r = 0;
396a06347c0SRobert Dolca
397a06347c0SRobert Dolca if (info->ram_version >= info->ram_patch_version)
398872fff33Swengjianfeng return r;
399a06347c0SRobert Dolca
400a06347c0SRobert Dolca info->setup_patch_sent = 0;
401a06347c0SRobert Dolca info->setup_reset_ntf = 0;
402a06347c0SRobert Dolca info->setup_patch_ntf = 0;
403a06347c0SRobert Dolca
404a06347c0SRobert Dolca /* Patch init request */
405a06347c0SRobert Dolca r = fdp_nci_patch_cmd(ndev, NCI_PATCH_TYPE_RAM);
406a06347c0SRobert Dolca if (r)
407872fff33Swengjianfeng return r;
408a06347c0SRobert Dolca
409a06347c0SRobert Dolca /* Patch data connection creation */
410a06347c0SRobert Dolca conn_id = fdp_nci_create_conn(ndev);
411872fff33Swengjianfeng if (conn_id < 0)
412872fff33Swengjianfeng return conn_id;
413a06347c0SRobert Dolca
414a06347c0SRobert Dolca /* Send the patch over the data connection */
415a06347c0SRobert Dolca r = fdp_nci_send_patch(ndev, conn_id, NCI_PATCH_TYPE_RAM);
416a06347c0SRobert Dolca if (r)
417872fff33Swengjianfeng return r;
418a06347c0SRobert Dolca
419a06347c0SRobert Dolca /* Wait for all the packets to be send over i2c */
420a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq,
421a06347c0SRobert Dolca info->setup_patch_sent == 1);
422a06347c0SRobert Dolca
423a06347c0SRobert Dolca /* make sure that the NFCC processed the last data packet */
424a06347c0SRobert Dolca msleep(FDP_FW_UPDATE_SLEEP);
425a06347c0SRobert Dolca
426a06347c0SRobert Dolca /* Close the data connection */
427a06347c0SRobert Dolca r = nci_core_conn_close(info->ndev, conn_id);
428a06347c0SRobert Dolca if (r)
429872fff33Swengjianfeng return r;
430a06347c0SRobert Dolca
431a06347c0SRobert Dolca /* Patch finish message */
432a06347c0SRobert Dolca if (fdp_nci_patch_cmd(ndev, NCI_PATCH_TYPE_EOT)) {
433a06347c0SRobert Dolca nfc_err(dev, "RAM patch error 0x%x\n", r);
434872fff33Swengjianfeng return -EINVAL;
435a06347c0SRobert Dolca }
436a06347c0SRobert Dolca
437a06347c0SRobert Dolca /* If the patch notification didn't arrive yet, wait for it */
438a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq, info->setup_patch_ntf);
439a06347c0SRobert Dolca
440a06347c0SRobert Dolca /* Check if the patching was successful */
441a06347c0SRobert Dolca r = info->setup_patch_status;
442a06347c0SRobert Dolca if (r) {
443a06347c0SRobert Dolca nfc_err(dev, "RAM patch error 0x%x\n", r);
444872fff33Swengjianfeng return -EINVAL;
445a06347c0SRobert Dolca }
446a06347c0SRobert Dolca
447a06347c0SRobert Dolca /*
448a06347c0SRobert Dolca * We need to wait for the reset notification before we
449a06347c0SRobert Dolca * can continue
450a06347c0SRobert Dolca */
451a06347c0SRobert Dolca wait_event_interruptible(info->setup_wq, info->setup_reset_ntf);
452a06347c0SRobert Dolca
453a06347c0SRobert Dolca return r;
454a06347c0SRobert Dolca }
455a06347c0SRobert Dolca
fdp_nci_setup(struct nci_dev * ndev)456a06347c0SRobert Dolca static int fdp_nci_setup(struct nci_dev *ndev)
457a06347c0SRobert Dolca {
458a06347c0SRobert Dolca /* Format: total length followed by an NCI packet */
459a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
460a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
461a06347c0SRobert Dolca int r;
462a06347c0SRobert Dolca u8 patched = 0;
463a06347c0SRobert Dolca
464a06347c0SRobert Dolca r = nci_core_init(ndev);
465a06347c0SRobert Dolca if (r)
466a06347c0SRobert Dolca goto error;
467a06347c0SRobert Dolca
468a06347c0SRobert Dolca /* Get RAM and OTP version */
469a06347c0SRobert Dolca r = fdp_nci_get_versions(ndev);
470a06347c0SRobert Dolca if (r)
471a06347c0SRobert Dolca goto error;
472a06347c0SRobert Dolca
473a06347c0SRobert Dolca /* Load firmware from disk */
474a06347c0SRobert Dolca r = fdp_nci_request_firmware(ndev);
475a06347c0SRobert Dolca if (r)
476a06347c0SRobert Dolca goto error;
477a06347c0SRobert Dolca
478a06347c0SRobert Dolca /* Update OTP */
479a06347c0SRobert Dolca if (info->otp_version < info->otp_patch_version) {
480a06347c0SRobert Dolca r = fdp_nci_patch_otp(ndev);
481a06347c0SRobert Dolca if (r)
482a06347c0SRobert Dolca goto error;
483a06347c0SRobert Dolca patched = 1;
484a06347c0SRobert Dolca }
485a06347c0SRobert Dolca
486a06347c0SRobert Dolca /* Update RAM */
487a06347c0SRobert Dolca if (info->ram_version < info->ram_patch_version) {
488a06347c0SRobert Dolca r = fdp_nci_patch_ram(ndev);
489a06347c0SRobert Dolca if (r)
490a06347c0SRobert Dolca goto error;
491a06347c0SRobert Dolca patched = 1;
492a06347c0SRobert Dolca }
493a06347c0SRobert Dolca
494a06347c0SRobert Dolca /* Release the firmware buffers */
495a06347c0SRobert Dolca fdp_nci_release_firmware(ndev);
496a06347c0SRobert Dolca
497a06347c0SRobert Dolca /* If a patch was applied the new version is checked */
498a06347c0SRobert Dolca if (patched) {
499a06347c0SRobert Dolca r = nci_core_init(ndev);
500a06347c0SRobert Dolca if (r)
501a06347c0SRobert Dolca goto error;
502a06347c0SRobert Dolca
503a06347c0SRobert Dolca r = fdp_nci_get_versions(ndev);
504a06347c0SRobert Dolca if (r)
505a06347c0SRobert Dolca goto error;
506a06347c0SRobert Dolca
507a06347c0SRobert Dolca if (info->otp_version != info->otp_patch_version ||
508a06347c0SRobert Dolca info->ram_version != info->ram_patch_version) {
509a06347c0SRobert Dolca nfc_err(dev, "Firmware update failed");
510a06347c0SRobert Dolca r = -EINVAL;
511a06347c0SRobert Dolca goto error;
512a06347c0SRobert Dolca }
513a06347c0SRobert Dolca }
514a06347c0SRobert Dolca
515a06347c0SRobert Dolca /*
516a06347c0SRobert Dolca * We initialized the devices but the NFC subsystem expects
517a06347c0SRobert Dolca * it to not be initialized.
518a06347c0SRobert Dolca */
519a06347c0SRobert Dolca return nci_core_reset(ndev);
520a06347c0SRobert Dolca
521a06347c0SRobert Dolca error:
522a06347c0SRobert Dolca fdp_nci_release_firmware(ndev);
523a06347c0SRobert Dolca nfc_err(dev, "Setup error %d\n", r);
524a06347c0SRobert Dolca return r;
525a06347c0SRobert Dolca }
526a06347c0SRobert Dolca
fdp_nci_post_setup(struct nci_dev * ndev)527a06347c0SRobert Dolca static int fdp_nci_post_setup(struct nci_dev *ndev)
528a06347c0SRobert Dolca {
529a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
530a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
531a06347c0SRobert Dolca int r;
532a06347c0SRobert Dolca
533a06347c0SRobert Dolca /* Check if the device has VSC */
534a06347c0SRobert Dolca if (info->fw_vsc_cfg && info->fw_vsc_cfg[0]) {
535a06347c0SRobert Dolca
536a06347c0SRobert Dolca /* Set the vendor specific configuration */
537a06347c0SRobert Dolca r = fdp_nci_set_production_data(ndev, info->fw_vsc_cfg[3],
538a06347c0SRobert Dolca &info->fw_vsc_cfg[4]);
539a06347c0SRobert Dolca if (r) {
540a06347c0SRobert Dolca nfc_err(dev, "Vendor specific config set error %d\n",
541a06347c0SRobert Dolca r);
542a06347c0SRobert Dolca return r;
543a06347c0SRobert Dolca }
544a06347c0SRobert Dolca }
545a06347c0SRobert Dolca
546a06347c0SRobert Dolca /* Set clock type and frequency */
547a06347c0SRobert Dolca r = fdp_nci_set_clock(ndev, info->clock_type, info->clock_freq);
548a06347c0SRobert Dolca if (r) {
549a06347c0SRobert Dolca nfc_err(dev, "Clock set error %d\n", r);
550a06347c0SRobert Dolca return r;
551a06347c0SRobert Dolca }
552a06347c0SRobert Dolca
553a06347c0SRobert Dolca /*
554a06347c0SRobert Dolca * In order to apply the VSC FDP needs a reset
555a06347c0SRobert Dolca */
556a06347c0SRobert Dolca r = nci_core_reset(ndev);
557a06347c0SRobert Dolca if (r)
558a06347c0SRobert Dolca return r;
559a06347c0SRobert Dolca
560a06347c0SRobert Dolca /**
561a06347c0SRobert Dolca * The nci core was initialized when post setup was called
562a06347c0SRobert Dolca * so we leave it like that
563a06347c0SRobert Dolca */
564a06347c0SRobert Dolca return nci_core_init(ndev);
565a06347c0SRobert Dolca }
566a06347c0SRobert Dolca
fdp_nci_core_reset_ntf_packet(struct nci_dev * ndev,struct sk_buff * skb)567a06347c0SRobert Dolca static int fdp_nci_core_reset_ntf_packet(struct nci_dev *ndev,
568a06347c0SRobert Dolca struct sk_buff *skb)
569a06347c0SRobert Dolca {
570a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
571a06347c0SRobert Dolca
572a06347c0SRobert Dolca info->setup_reset_ntf = 1;
573a06347c0SRobert Dolca wake_up(&info->setup_wq);
574a06347c0SRobert Dolca
575a06347c0SRobert Dolca return 0;
576a06347c0SRobert Dolca }
577a06347c0SRobert Dolca
fdp_nci_prop_patch_ntf_packet(struct nci_dev * ndev,struct sk_buff * skb)578a06347c0SRobert Dolca static int fdp_nci_prop_patch_ntf_packet(struct nci_dev *ndev,
579a06347c0SRobert Dolca struct sk_buff *skb)
580a06347c0SRobert Dolca {
581a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
582a06347c0SRobert Dolca
583a06347c0SRobert Dolca info->setup_patch_ntf = 1;
584a06347c0SRobert Dolca info->setup_patch_status = skb->data[0];
585a06347c0SRobert Dolca wake_up(&info->setup_wq);
586a06347c0SRobert Dolca
587a06347c0SRobert Dolca return 0;
588a06347c0SRobert Dolca }
589a06347c0SRobert Dolca
fdp_nci_prop_patch_rsp_packet(struct nci_dev * ndev,struct sk_buff * skb)590a06347c0SRobert Dolca static int fdp_nci_prop_patch_rsp_packet(struct nci_dev *ndev,
591a06347c0SRobert Dolca struct sk_buff *skb)
592a06347c0SRobert Dolca {
593a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
594a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
595a06347c0SRobert Dolca u8 status = skb->data[0];
596a06347c0SRobert Dolca
597a06347c0SRobert Dolca dev_dbg(dev, "%s: status 0x%x\n", __func__, status);
598a06347c0SRobert Dolca nci_req_complete(ndev, status);
599a06347c0SRobert Dolca
600a06347c0SRobert Dolca return 0;
601a06347c0SRobert Dolca }
602a06347c0SRobert Dolca
fdp_nci_prop_set_production_data_rsp_packet(struct nci_dev * ndev,struct sk_buff * skb)603a06347c0SRobert Dolca static int fdp_nci_prop_set_production_data_rsp_packet(struct nci_dev *ndev,
604a06347c0SRobert Dolca struct sk_buff *skb)
605a06347c0SRobert Dolca {
606a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
607a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
608a06347c0SRobert Dolca u8 status = skb->data[0];
609a06347c0SRobert Dolca
610a06347c0SRobert Dolca dev_dbg(dev, "%s: status 0x%x\n", __func__, status);
611a06347c0SRobert Dolca nci_req_complete(ndev, status);
612a06347c0SRobert Dolca
613a06347c0SRobert Dolca return 0;
614a06347c0SRobert Dolca }
615a06347c0SRobert Dolca
fdp_nci_core_get_config_rsp_packet(struct nci_dev * ndev,struct sk_buff * skb)616a06347c0SRobert Dolca static int fdp_nci_core_get_config_rsp_packet(struct nci_dev *ndev,
617a06347c0SRobert Dolca struct sk_buff *skb)
618a06347c0SRobert Dolca {
619a06347c0SRobert Dolca struct fdp_nci_info *info = nci_get_drvdata(ndev);
620a06347c0SRobert Dolca struct device *dev = &info->phy->i2c_dev->dev;
6213d463dd5SKrzysztof Kozlowski const struct nci_core_get_config_rsp *rsp = (void *) skb->data;
622c3e26b6dSKrzysztof Kozlowski unsigned int i;
6233d463dd5SKrzysztof Kozlowski const u8 *p;
624a06347c0SRobert Dolca
625a06347c0SRobert Dolca if (rsp->status == NCI_STATUS_OK) {
626a06347c0SRobert Dolca
627a06347c0SRobert Dolca p = rsp->data;
628a06347c0SRobert Dolca for (i = 0; i < 4; i++) {
629a06347c0SRobert Dolca
630a06347c0SRobert Dolca switch (*p++) {
631a06347c0SRobert Dolca case NCI_PARAM_ID_FW_RAM_VERSION:
632a06347c0SRobert Dolca p++;
633a06347c0SRobert Dolca info->ram_version = le32_to_cpup((__le32 *) p);
634a06347c0SRobert Dolca p += 4;
635a06347c0SRobert Dolca break;
636a06347c0SRobert Dolca case NCI_PARAM_ID_FW_OTP_VERSION:
637a06347c0SRobert Dolca p++;
638a06347c0SRobert Dolca info->otp_version = le32_to_cpup((__le32 *) p);
639a06347c0SRobert Dolca p += 4;
640a06347c0SRobert Dolca break;
641a06347c0SRobert Dolca case NCI_PARAM_ID_OTP_LIMITED_VERSION:
642a06347c0SRobert Dolca p++;
643a06347c0SRobert Dolca info->otp_version = le32_to_cpup((__le32 *) p);
644a06347c0SRobert Dolca p += 4;
645a06347c0SRobert Dolca break;
646a06347c0SRobert Dolca case NCI_PARAM_ID_KEY_INDEX_ID:
647a06347c0SRobert Dolca p++;
648a06347c0SRobert Dolca info->key_index = *p++;
649a06347c0SRobert Dolca }
650a06347c0SRobert Dolca }
651a06347c0SRobert Dolca }
652a06347c0SRobert Dolca
653a06347c0SRobert Dolca dev_dbg(dev, "OTP version %d\n", info->otp_version);
654a06347c0SRobert Dolca dev_dbg(dev, "RAM version %d\n", info->ram_version);
655a06347c0SRobert Dolca dev_dbg(dev, "key index %d\n", info->key_index);
656a06347c0SRobert Dolca dev_dbg(dev, "%s: status 0x%x\n", __func__, rsp->status);
657a06347c0SRobert Dolca
658a06347c0SRobert Dolca nci_req_complete(ndev, rsp->status);
659a06347c0SRobert Dolca
660a06347c0SRobert Dolca return 0;
661a06347c0SRobert Dolca }
662a06347c0SRobert Dolca
663cb8caa3cSKrzysztof Kozlowski static const struct nci_driver_ops fdp_core_ops[] = {
664a06347c0SRobert Dolca {
665a06347c0SRobert Dolca .opcode = NCI_OP_CORE_GET_CONFIG_RSP,
666a06347c0SRobert Dolca .rsp = fdp_nci_core_get_config_rsp_packet,
667a06347c0SRobert Dolca },
668a06347c0SRobert Dolca {
669a06347c0SRobert Dolca .opcode = NCI_OP_CORE_RESET_NTF,
670a06347c0SRobert Dolca .ntf = fdp_nci_core_reset_ntf_packet,
671a06347c0SRobert Dolca },
672a06347c0SRobert Dolca };
673a06347c0SRobert Dolca
674cb8caa3cSKrzysztof Kozlowski static const struct nci_driver_ops fdp_prop_ops[] = {
675a06347c0SRobert Dolca {
676a06347c0SRobert Dolca .opcode = nci_opcode_pack(NCI_GID_PROP, NCI_OP_PROP_PATCH_OID),
677a06347c0SRobert Dolca .rsp = fdp_nci_prop_patch_rsp_packet,
678a06347c0SRobert Dolca .ntf = fdp_nci_prop_patch_ntf_packet,
679a06347c0SRobert Dolca },
680a06347c0SRobert Dolca {
681a06347c0SRobert Dolca .opcode = nci_opcode_pack(NCI_GID_PROP,
682a06347c0SRobert Dolca NCI_OP_PROP_SET_PDATA_OID),
683a06347c0SRobert Dolca .rsp = fdp_nci_prop_set_production_data_rsp_packet,
684a06347c0SRobert Dolca },
685a06347c0SRobert Dolca };
686a06347c0SRobert Dolca
687b9c28286SKrzysztof Kozlowski static const struct nci_ops nci_ops = {
688a06347c0SRobert Dolca .open = fdp_nci_open,
689a06347c0SRobert Dolca .close = fdp_nci_close,
690a06347c0SRobert Dolca .send = fdp_nci_send,
691a06347c0SRobert Dolca .setup = fdp_nci_setup,
692a06347c0SRobert Dolca .post_setup = fdp_nci_post_setup,
693a06347c0SRobert Dolca .prop_ops = fdp_prop_ops,
694a06347c0SRobert Dolca .n_prop_ops = ARRAY_SIZE(fdp_prop_ops),
695a06347c0SRobert Dolca .core_ops = fdp_core_ops,
696a06347c0SRobert Dolca .n_core_ops = ARRAY_SIZE(fdp_core_ops),
697a06347c0SRobert Dolca };
698a06347c0SRobert Dolca
fdp_nci_probe(struct fdp_i2c_phy * phy,const struct nfc_phy_ops * phy_ops,struct nci_dev ** ndevp,int tx_headroom,int tx_tailroom,u8 clock_type,u32 clock_freq,const u8 * fw_vsc_cfg)6997a5e98daSKrzysztof Kozlowski int fdp_nci_probe(struct fdp_i2c_phy *phy, const struct nfc_phy_ops *phy_ops,
700a06347c0SRobert Dolca struct nci_dev **ndevp, int tx_headroom,
701a06347c0SRobert Dolca int tx_tailroom, u8 clock_type, u32 clock_freq,
7023d463dd5SKrzysztof Kozlowski const u8 *fw_vsc_cfg)
703a06347c0SRobert Dolca {
704a06347c0SRobert Dolca struct device *dev = &phy->i2c_dev->dev;
705a06347c0SRobert Dolca struct fdp_nci_info *info;
706a06347c0SRobert Dolca struct nci_dev *ndev;
707a06347c0SRobert Dolca u32 protocols;
708a06347c0SRobert Dolca int r;
709a06347c0SRobert Dolca
7107b9fcda9SAndy Shevchenko info = devm_kzalloc(dev, sizeof(struct fdp_nci_info), GFP_KERNEL);
7117b9fcda9SAndy Shevchenko if (!info)
7127b9fcda9SAndy Shevchenko return -ENOMEM;
713a06347c0SRobert Dolca
714a06347c0SRobert Dolca info->phy = phy;
715a06347c0SRobert Dolca info->phy_ops = phy_ops;
716a06347c0SRobert Dolca info->clock_type = clock_type;
717a06347c0SRobert Dolca info->clock_freq = clock_freq;
718a06347c0SRobert Dolca info->fw_vsc_cfg = fw_vsc_cfg;
719a06347c0SRobert Dolca
720a06347c0SRobert Dolca init_waitqueue_head(&info->setup_wq);
721a06347c0SRobert Dolca
722a06347c0SRobert Dolca protocols = NFC_PROTO_JEWEL_MASK |
723a06347c0SRobert Dolca NFC_PROTO_MIFARE_MASK |
724a06347c0SRobert Dolca NFC_PROTO_FELICA_MASK |
725a06347c0SRobert Dolca NFC_PROTO_ISO14443_MASK |
726a06347c0SRobert Dolca NFC_PROTO_ISO14443_B_MASK |
727a06347c0SRobert Dolca NFC_PROTO_NFC_DEP_MASK |
728a06347c0SRobert Dolca NFC_PROTO_ISO15693_MASK;
729a06347c0SRobert Dolca
730b9c28286SKrzysztof Kozlowski BUILD_BUG_ON(ARRAY_SIZE(fdp_prop_ops) > NCI_MAX_PROPRIETARY_CMD);
731a06347c0SRobert Dolca ndev = nci_allocate_device(&nci_ops, protocols, tx_headroom,
732a06347c0SRobert Dolca tx_tailroom);
733a06347c0SRobert Dolca if (!ndev) {
734a06347c0SRobert Dolca nfc_err(dev, "Cannot allocate nfc ndev\n");
7357b9fcda9SAndy Shevchenko return -ENOMEM;
736a06347c0SRobert Dolca }
737a06347c0SRobert Dolca
738a06347c0SRobert Dolca r = nci_register_device(ndev);
739a06347c0SRobert Dolca if (r)
740a06347c0SRobert Dolca goto err_regdev;
741a06347c0SRobert Dolca
742a06347c0SRobert Dolca *ndevp = ndev;
743a06347c0SRobert Dolca info->ndev = ndev;
744a06347c0SRobert Dolca
745a06347c0SRobert Dolca nci_set_drvdata(ndev, info);
746a06347c0SRobert Dolca
747a06347c0SRobert Dolca return 0;
748a06347c0SRobert Dolca
749a06347c0SRobert Dolca err_regdev:
750a06347c0SRobert Dolca nci_free_device(ndev);
751a06347c0SRobert Dolca return r;
752a06347c0SRobert Dolca }
753a06347c0SRobert Dolca EXPORT_SYMBOL(fdp_nci_probe);
754a06347c0SRobert Dolca
fdp_nci_remove(struct nci_dev * ndev)755a06347c0SRobert Dolca void fdp_nci_remove(struct nci_dev *ndev)
756a06347c0SRobert Dolca {
757a06347c0SRobert Dolca nci_unregister_device(ndev);
758a06347c0SRobert Dolca nci_free_device(ndev);
759a06347c0SRobert Dolca }
760a06347c0SRobert Dolca EXPORT_SYMBOL(fdp_nci_remove);
761a06347c0SRobert Dolca
762a06347c0SRobert Dolca MODULE_LICENSE("GPL");
763a06347c0SRobert Dolca MODULE_DESCRIPTION("NFC NCI driver for Intel Fields Peak NFC controller");
764a06347c0SRobert Dolca MODULE_AUTHOR("Robert Dolca <robert.dolca@intel.com>");
765*eb09fc2dSJuerg Haefliger
766*eb09fc2dSJuerg Haefliger MODULE_FIRMWARE(FDP_OTP_PATCH_NAME);
767*eb09fc2dSJuerg Haefliger MODULE_FIRMWARE(FDP_RAM_PATCH_NAME);
768