blob: cf07d112195620106282fcbaf40059debc17d461 [file] [log] [blame]
Marcel Holtmann16e38872015-04-04 16:13:02 -07001/*
2 *
3 * Bluetooth HCI UART driver for Intel devices
4 *
5 * Copyright (C) 2015 Intel Corporation
6 *
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 *
22 */
23
24#include <linux/kernel.h>
25#include <linux/errno.h>
26#include <linux/skbuff.h>
Loic Poulainca93cee2015-07-01 12:20:26 +020027#include <linux/firmware.h>
Loic Poulain1ab1f232015-08-27 07:21:51 +020028#include <linux/module.h>
Loic Poulainca93cee2015-07-01 12:20:26 +020029#include <linux/wait.h>
Loic Poulain1ab1f232015-08-27 07:21:51 +020030#include <linux/tty.h>
31#include <linux/platform_device.h>
32#include <linux/gpio/consumer.h>
33#include <linux/acpi.h>
Marcel Holtmann16e38872015-04-04 16:13:02 -070034
35#include <net/bluetooth/bluetooth.h>
36#include <net/bluetooth/hci_core.h>
37
38#include "hci_uart.h"
Loic Poulainca93cee2015-07-01 12:20:26 +020039#include "btintel.h"
40
41#define STATE_BOOTLOADER 0
42#define STATE_DOWNLOADING 1
43#define STATE_FIRMWARE_LOADED 2
44#define STATE_FIRMWARE_FAILED 3
45#define STATE_BOOTING 4
46
Loic Poulain1ab1f232015-08-27 07:21:51 +020047struct intel_device {
48 struct list_head list;
49 struct platform_device *pdev;
50 struct gpio_desc *reset;
51};
52
53static LIST_HEAD(intel_device_list);
54static DEFINE_SPINLOCK(intel_device_list_lock);
55
Loic Poulainca93cee2015-07-01 12:20:26 +020056struct intel_data {
57 struct sk_buff *rx_skb;
58 struct sk_buff_head txq;
59 unsigned long flags;
60};
61
Loic Poulainff289552015-08-25 17:55:44 +020062static u8 intel_convert_speed(unsigned int speed)
63{
64 switch (speed) {
65 case 9600:
66 return 0x00;
67 case 19200:
68 return 0x01;
69 case 38400:
70 return 0x02;
71 case 57600:
72 return 0x03;
73 case 115200:
74 return 0x04;
75 case 230400:
76 return 0x05;
77 case 460800:
78 return 0x06;
79 case 921600:
80 return 0x07;
81 case 1843200:
82 return 0x08;
83 case 3250000:
84 return 0x09;
85 case 2000000:
86 return 0x0a;
87 case 3000000:
88 return 0x0b;
89 default:
90 return 0xff;
91 }
92}
93
Loic Poulain1ab1f232015-08-27 07:21:51 +020094static int intel_wait_booting(struct hci_uart *hu)
95{
96 struct intel_data *intel = hu->priv;
97 int err;
98
99 err = wait_on_bit_timeout(&intel->flags, STATE_BOOTING,
100 TASK_INTERRUPTIBLE,
101 msecs_to_jiffies(1000));
102
103 if (err == 1) {
104 BT_ERR("%s: Device boot interrupted", hu->hdev->name);
105 return -EINTR;
106 }
107
108 if (err) {
109 BT_ERR("%s: Device boot timeout", hu->hdev->name);
110 return -ETIMEDOUT;
111 }
112
113 return err;
114}
115
116static int intel_set_power(struct hci_uart *hu, bool powered)
117{
118 struct list_head *p;
119 int err = -ENODEV;
120
121 spin_lock(&intel_device_list_lock);
122
123 list_for_each(p, &intel_device_list) {
124 struct intel_device *idev = list_entry(p, struct intel_device,
125 list);
126
127 /* tty device and pdev device should share the same parent
128 * which is the UART port.
129 */
130 if (hu->tty->dev->parent != idev->pdev->dev.parent)
131 continue;
132
133 if (!idev->reset) {
134 err = -ENOTSUPP;
135 break;
136 }
137
138 BT_INFO("hu %p, Switching compatible pm device (%s) to %u",
139 hu, dev_name(&idev->pdev->dev), powered);
140
141 gpiod_set_value(idev->reset, powered);
142 }
143
144 spin_unlock(&intel_device_list_lock);
145
146 return err;
147}
148
Loic Poulainca93cee2015-07-01 12:20:26 +0200149static int intel_open(struct hci_uart *hu)
150{
151 struct intel_data *intel;
152
153 BT_DBG("hu %p", hu);
154
155 intel = kzalloc(sizeof(*intel), GFP_KERNEL);
156 if (!intel)
157 return -ENOMEM;
158
159 skb_queue_head_init(&intel->txq);
160
161 hu->priv = intel;
Loic Poulain1ab1f232015-08-27 07:21:51 +0200162
163 if (!intel_set_power(hu, true))
164 set_bit(STATE_BOOTING, &intel->flags);
165
Loic Poulainca93cee2015-07-01 12:20:26 +0200166 return 0;
167}
168
169static int intel_close(struct hci_uart *hu)
170{
171 struct intel_data *intel = hu->priv;
172
173 BT_DBG("hu %p", hu);
174
Loic Poulain1ab1f232015-08-27 07:21:51 +0200175 intel_set_power(hu, false);
176
Loic Poulainca93cee2015-07-01 12:20:26 +0200177 skb_queue_purge(&intel->txq);
178 kfree_skb(intel->rx_skb);
179 kfree(intel);
180
181 hu->priv = NULL;
182 return 0;
183}
184
185static int intel_flush(struct hci_uart *hu)
186{
187 struct intel_data *intel = hu->priv;
188
189 BT_DBG("hu %p", hu);
190
191 skb_queue_purge(&intel->txq);
192
193 return 0;
194}
195
196static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode)
197{
198 struct sk_buff *skb;
199 struct hci_event_hdr *hdr;
200 struct hci_ev_cmd_complete *evt;
201
202 skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_ATOMIC);
203 if (!skb)
204 return -ENOMEM;
205
206 hdr = (struct hci_event_hdr *)skb_put(skb, sizeof(*hdr));
207 hdr->evt = HCI_EV_CMD_COMPLETE;
208 hdr->plen = sizeof(*evt) + 1;
209
210 evt = (struct hci_ev_cmd_complete *)skb_put(skb, sizeof(*evt));
211 evt->ncmd = 0x01;
212 evt->opcode = cpu_to_le16(opcode);
213
214 *skb_put(skb, 1) = 0x00;
215
216 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
217
218 return hci_recv_frame(hdev, skb);
219}
220
Loic Poulainff289552015-08-25 17:55:44 +0200221static int intel_set_baudrate(struct hci_uart *hu, unsigned int speed)
222{
223 struct intel_data *intel = hu->priv;
224 struct hci_dev *hdev = hu->hdev;
225 u8 speed_cmd[] = { 0x06, 0xfc, 0x01, 0x00 };
226 struct sk_buff *skb;
Loic Poulain1ab1f232015-08-27 07:21:51 +0200227 int err;
228
229 /* This can be the first command sent to the chip, check
230 * that the controller is ready.
231 */
232 err = intel_wait_booting(hu);
233
234 clear_bit(STATE_BOOTING, &intel->flags);
235
236 /* In case of timeout, try to continue anyway */
237 if (err && err != ETIMEDOUT)
238 return err;
Loic Poulainff289552015-08-25 17:55:44 +0200239
240 BT_INFO("%s: Change controller speed to %d", hdev->name, speed);
241
242 speed_cmd[3] = intel_convert_speed(speed);
243 if (speed_cmd[3] == 0xff) {
244 BT_ERR("%s: Unsupported speed", hdev->name);
245 return -EINVAL;
246 }
247
248 /* Device will not accept speed change if Intel version has not been
249 * previously requested.
250 */
251 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
252 if (IS_ERR(skb)) {
253 BT_ERR("%s: Reading Intel version information failed (%ld)",
254 hdev->name, PTR_ERR(skb));
255 return PTR_ERR(skb);
256 }
257 kfree_skb(skb);
258
259 skb = bt_skb_alloc(sizeof(speed_cmd), GFP_KERNEL);
260 if (!skb) {
261 BT_ERR("%s: Failed to allocate memory for baudrate packet",
262 hdev->name);
263 return -ENOMEM;
264 }
265
266 memcpy(skb_put(skb, sizeof(speed_cmd)), speed_cmd, sizeof(speed_cmd));
267 bt_cb(skb)->pkt_type = HCI_COMMAND_PKT;
268
269 hci_uart_set_flow_control(hu, true);
270
271 skb_queue_tail(&intel->txq, skb);
272 hci_uart_tx_wakeup(hu);
273
274 /* wait 100ms to change baudrate on controller side */
275 msleep(100);
276
277 hci_uart_set_baudrate(hu, speed);
278 hci_uart_set_flow_control(hu, false);
279
280 return 0;
281}
282
Loic Poulainca93cee2015-07-01 12:20:26 +0200283static int intel_setup(struct hci_uart *hu)
284{
285 static const u8 reset_param[] = { 0x00, 0x01, 0x00, 0x01,
286 0x00, 0x08, 0x04, 0x00 };
287 struct intel_data *intel = hu->priv;
288 struct hci_dev *hdev = hu->hdev;
289 struct sk_buff *skb;
290 struct intel_version *ver;
291 struct intel_boot_params *params;
292 const struct firmware *fw;
293 const u8 *fw_ptr;
294 char fwname[64];
295 u32 frag_len;
296 ktime_t calltime, delta, rettime;
297 unsigned long long duration;
Loic Poulainff289552015-08-25 17:55:44 +0200298 unsigned int init_speed, oper_speed;
299 int speed_change = 0;
Loic Poulainca93cee2015-07-01 12:20:26 +0200300 int err;
301
302 BT_DBG("%s", hdev->name);
303
Marcel Holtmann35ab8152015-07-05 14:37:40 +0200304 hu->hdev->set_bdaddr = btintel_set_bdaddr;
305
Loic Poulainca93cee2015-07-01 12:20:26 +0200306 calltime = ktime_get();
307
Loic Poulainff289552015-08-25 17:55:44 +0200308 if (hu->init_speed)
309 init_speed = hu->init_speed;
310 else
311 init_speed = hu->proto->init_speed;
312
313 if (hu->oper_speed)
314 oper_speed = hu->oper_speed;
315 else
316 oper_speed = hu->proto->oper_speed;
317
318 if (oper_speed && init_speed && oper_speed != init_speed)
319 speed_change = 1;
320
Loic Poulain1ab1f232015-08-27 07:21:51 +0200321 /* Check that the controller is ready */
322 err = intel_wait_booting(hu);
323
324 clear_bit(STATE_BOOTING, &intel->flags);
325
326 /* In case of timeout, try to continue anyway */
327 if (err && err != ETIMEDOUT)
328 return err;
329
Loic Poulainca93cee2015-07-01 12:20:26 +0200330 set_bit(STATE_BOOTLOADER, &intel->flags);
331
332 /* Read the Intel version information to determine if the device
333 * is in bootloader mode or if it already has operational firmware
334 * loaded.
335 */
336 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
337 if (IS_ERR(skb)) {
338 BT_ERR("%s: Reading Intel version information failed (%ld)",
339 hdev->name, PTR_ERR(skb));
340 return PTR_ERR(skb);
341 }
342
343 if (skb->len != sizeof(*ver)) {
344 BT_ERR("%s: Intel version event size mismatch", hdev->name);
345 kfree_skb(skb);
346 return -EILSEQ;
347 }
348
349 ver = (struct intel_version *)skb->data;
350 if (ver->status) {
351 BT_ERR("%s: Intel version command failure (%02x)",
352 hdev->name, ver->status);
353 err = -bt_to_errno(ver->status);
354 kfree_skb(skb);
355 return err;
356 }
357
358 /* The hardware platform number has a fixed value of 0x37 and
359 * for now only accept this single value.
360 */
361 if (ver->hw_platform != 0x37) {
362 BT_ERR("%s: Unsupported Intel hardware platform (%u)",
363 hdev->name, ver->hw_platform);
364 kfree_skb(skb);
365 return -EINVAL;
366 }
367
368 /* At the moment only the hardware variant iBT 3.0 (LnP/SfP) is
369 * supported by this firmware loading method. This check has been
370 * put in place to ensure correct forward compatibility options
371 * when newer hardware variants come along.
372 */
373 if (ver->hw_variant != 0x0b) {
374 BT_ERR("%s: Unsupported Intel hardware variant (%u)",
375 hdev->name, ver->hw_variant);
376 kfree_skb(skb);
377 return -EINVAL;
378 }
379
Marcel Holtmann7feb99e2015-07-05 15:02:07 +0200380 btintel_version_info(hdev, ver);
Loic Poulainca93cee2015-07-01 12:20:26 +0200381
382 /* The firmware variant determines if the device is in bootloader
383 * mode or is running operational firmware. The value 0x06 identifies
384 * the bootloader and the value 0x23 identifies the operational
385 * firmware.
386 *
387 * When the operational firmware is already present, then only
388 * the check for valid Bluetooth device address is needed. This
389 * determines if the device will be added as configured or
390 * unconfigured controller.
391 *
392 * It is not possible to use the Secure Boot Parameters in this
393 * case since that command is only available in bootloader mode.
394 */
395 if (ver->fw_variant == 0x23) {
396 kfree_skb(skb);
397 clear_bit(STATE_BOOTLOADER, &intel->flags);
398 btintel_check_bdaddr(hdev);
399 return 0;
400 }
401
402 /* If the device is not in bootloader mode, then the only possible
403 * choice is to return an error and abort the device initialization.
404 */
405 if (ver->fw_variant != 0x06) {
406 BT_ERR("%s: Unsupported Intel firmware variant (%u)",
407 hdev->name, ver->fw_variant);
408 kfree_skb(skb);
409 return -ENODEV;
410 }
411
412 kfree_skb(skb);
413
414 /* Read the secure boot parameters to identify the operating
415 * details of the bootloader.
416 */
417 skb = __hci_cmd_sync(hdev, 0xfc0d, 0, NULL, HCI_INIT_TIMEOUT);
418 if (IS_ERR(skb)) {
419 BT_ERR("%s: Reading Intel boot parameters failed (%ld)",
420 hdev->name, PTR_ERR(skb));
421 return PTR_ERR(skb);
422 }
423
424 if (skb->len != sizeof(*params)) {
425 BT_ERR("%s: Intel boot parameters size mismatch", hdev->name);
426 kfree_skb(skb);
427 return -EILSEQ;
428 }
429
430 params = (struct intel_boot_params *)skb->data;
431 if (params->status) {
432 BT_ERR("%s: Intel boot parameters command failure (%02x)",
433 hdev->name, params->status);
434 err = -bt_to_errno(params->status);
435 kfree_skb(skb);
436 return err;
437 }
438
439 BT_INFO("%s: Device revision is %u", hdev->name,
440 le16_to_cpu(params->dev_revid));
441
442 BT_INFO("%s: Secure boot is %s", hdev->name,
443 params->secure_boot ? "enabled" : "disabled");
444
445 BT_INFO("%s: Minimum firmware build %u week %u %u", hdev->name,
446 params->min_fw_build_nn, params->min_fw_build_cw,
447 2000 + params->min_fw_build_yy);
448
449 /* It is required that every single firmware fragment is acknowledged
450 * with a command complete event. If the boot parameters indicate
451 * that this bootloader does not send them, then abort the setup.
452 */
453 if (params->limited_cce != 0x00) {
454 BT_ERR("%s: Unsupported Intel firmware loading method (%u)",
455 hdev->name, params->limited_cce);
456 kfree_skb(skb);
457 return -EINVAL;
458 }
459
460 /* If the OTP has no valid Bluetooth device address, then there will
461 * also be no valid address for the operational firmware.
462 */
463 if (!bacmp(&params->otp_bdaddr, BDADDR_ANY)) {
464 BT_INFO("%s: No device address configured", hdev->name);
465 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
466 }
467
468 /* With this Intel bootloader only the hardware variant and device
469 * revision information are used to select the right firmware.
470 *
471 * Currently this bootloader support is limited to hardware variant
472 * iBT 3.0 (LnP/SfP) which is identified by the value 11 (0x0b).
473 */
474 snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.sfi",
475 le16_to_cpu(params->dev_revid));
476
477 err = request_firmware(&fw, fwname, &hdev->dev);
478 if (err < 0) {
479 BT_ERR("%s: Failed to load Intel firmware file (%d)",
480 hdev->name, err);
481 kfree_skb(skb);
482 return err;
483 }
484
485 BT_INFO("%s: Found device firmware: %s", hdev->name, fwname);
486
487 kfree_skb(skb);
488
489 if (fw->size < 644) {
490 BT_ERR("%s: Invalid size of firmware file (%zu)",
491 hdev->name, fw->size);
492 err = -EBADF;
493 goto done;
494 }
495
496 set_bit(STATE_DOWNLOADING, &intel->flags);
497
498 /* Start the firmware download transaction with the Init fragment
499 * represented by the 128 bytes of CSS header.
500 */
Marcel Holtmann09df1232015-07-05 14:55:36 +0200501 err = btintel_secure_send(hdev, 0x00, 128, fw->data);
Loic Poulainca93cee2015-07-01 12:20:26 +0200502 if (err < 0) {
503 BT_ERR("%s: Failed to send firmware header (%d)",
504 hdev->name, err);
505 goto done;
506 }
507
508 /* Send the 256 bytes of public key information from the firmware
509 * as the PKey fragment.
510 */
Marcel Holtmann09df1232015-07-05 14:55:36 +0200511 err = btintel_secure_send(hdev, 0x03, 256, fw->data + 128);
Loic Poulainca93cee2015-07-01 12:20:26 +0200512 if (err < 0) {
513 BT_ERR("%s: Failed to send firmware public key (%d)",
514 hdev->name, err);
515 goto done;
516 }
517
518 /* Send the 256 bytes of signature information from the firmware
519 * as the Sign fragment.
520 */
Marcel Holtmann09df1232015-07-05 14:55:36 +0200521 err = btintel_secure_send(hdev, 0x02, 256, fw->data + 388);
Loic Poulainca93cee2015-07-01 12:20:26 +0200522 if (err < 0) {
523 BT_ERR("%s: Failed to send firmware signature (%d)",
524 hdev->name, err);
525 goto done;
526 }
527
528 fw_ptr = fw->data + 644;
529 frag_len = 0;
530
531 while (fw_ptr - fw->data < fw->size) {
532 struct hci_command_hdr *cmd = (void *)(fw_ptr + frag_len);
533
534 frag_len += sizeof(*cmd) + cmd->plen;
535
536 BT_DBG("%s: patching %td/%zu", hdev->name,
537 (fw_ptr - fw->data), fw->size);
538
539 /* The parameter length of the secure send command requires
540 * a 4 byte alignment. It happens so that the firmware file
541 * contains proper Intel_NOP commands to align the fragments
542 * as needed.
543 *
544 * Send set of commands with 4 byte alignment from the
545 * firmware data buffer as a single Data fragement.
546 */
547 if (frag_len % 4)
548 continue;
549
550 /* Send each command from the firmware data buffer as
551 * a single Data fragment.
552 */
Marcel Holtmann09df1232015-07-05 14:55:36 +0200553 err = btintel_secure_send(hdev, 0x01, frag_len, fw_ptr);
Loic Poulainca93cee2015-07-01 12:20:26 +0200554 if (err < 0) {
555 BT_ERR("%s: Failed to send firmware data (%d)",
556 hdev->name, err);
557 goto done;
558 }
559
560 fw_ptr += frag_len;
561 frag_len = 0;
562 }
563
564 set_bit(STATE_FIRMWARE_LOADED, &intel->flags);
565
566 BT_INFO("%s: Waiting for firmware download to complete", hdev->name);
567
568 /* Before switching the device into operational mode and with that
569 * booting the loaded firmware, wait for the bootloader notification
570 * that all fragments have been successfully received.
571 *
572 * When the event processing receives the notification, then the
573 * STATE_DOWNLOADING flag will be cleared.
574 *
575 * The firmware loading should not take longer than 5 seconds
576 * and thus just timeout if that happens and fail the setup
577 * of this device.
578 */
579 err = wait_on_bit_timeout(&intel->flags, STATE_DOWNLOADING,
580 TASK_INTERRUPTIBLE,
581 msecs_to_jiffies(5000));
582 if (err == 1) {
583 BT_ERR("%s: Firmware loading interrupted", hdev->name);
584 err = -EINTR;
585 goto done;
586 }
587
588 if (err) {
589 BT_ERR("%s: Firmware loading timeout", hdev->name);
590 err = -ETIMEDOUT;
591 goto done;
592 }
593
594 if (test_bit(STATE_FIRMWARE_FAILED, &intel->flags)) {
595 BT_ERR("%s: Firmware loading failed", hdev->name);
596 err = -ENOEXEC;
597 goto done;
598 }
599
600 rettime = ktime_get();
601 delta = ktime_sub(rettime, calltime);
602 duration = (unsigned long long) ktime_to_ns(delta) >> 10;
603
604 BT_INFO("%s: Firmware loaded in %llu usecs", hdev->name, duration);
605
606done:
607 release_firmware(fw);
608
609 if (err < 0)
610 return err;
611
Loic Poulainff289552015-08-25 17:55:44 +0200612 /* We need to restore the default speed before Intel reset */
613 if (speed_change) {
614 err = intel_set_baudrate(hu, init_speed);
615 if (err)
616 return err;
617 }
618
Loic Poulainca93cee2015-07-01 12:20:26 +0200619 calltime = ktime_get();
620
621 set_bit(STATE_BOOTING, &intel->flags);
622
623 skb = __hci_cmd_sync(hdev, 0xfc01, sizeof(reset_param), reset_param,
624 HCI_INIT_TIMEOUT);
625 if (IS_ERR(skb))
626 return PTR_ERR(skb);
627
628 kfree_skb(skb);
629
630 /* The bootloader will not indicate when the device is ready. This
631 * is done by the operational firmware sending bootup notification.
632 *
633 * Booting into operational firmware should not take longer than
634 * 1 second. However if that happens, then just fail the setup
635 * since something went wrong.
636 */
637 BT_INFO("%s: Waiting for device to boot", hdev->name);
638
Loic Poulain1ab1f232015-08-27 07:21:51 +0200639 err = intel_wait_booting(hu);
640 if (err)
641 return err;
Loic Poulainca93cee2015-07-01 12:20:26 +0200642
Loic Poulain1ab1f232015-08-27 07:21:51 +0200643 clear_bit(STATE_BOOTING, &intel->flags);
Loic Poulainca93cee2015-07-01 12:20:26 +0200644
645 rettime = ktime_get();
646 delta = ktime_sub(rettime, calltime);
647 duration = (unsigned long long) ktime_to_ns(delta) >> 10;
648
649 BT_INFO("%s: Device booted in %llu usecs", hdev->name, duration);
650
Loic Poulainff289552015-08-25 17:55:44 +0200651 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_CMD_TIMEOUT);
652 if (IS_ERR(skb))
653 return PTR_ERR(skb);
654 kfree_skb(skb);
655
656 if (speed_change) {
657 err = intel_set_baudrate(hu, oper_speed);
658 if (err)
659 return err;
660 }
661
662 BT_INFO("%s: Setup complete", hdev->name);
663
Loic Poulainca93cee2015-07-01 12:20:26 +0200664 clear_bit(STATE_BOOTLOADER, &intel->flags);
665
666 return 0;
667}
668
669static int intel_recv_event(struct hci_dev *hdev, struct sk_buff *skb)
670{
671 struct hci_uart *hu = hci_get_drvdata(hdev);
672 struct intel_data *intel = hu->priv;
673 struct hci_event_hdr *hdr;
674
Loic Poulain1ab1f232015-08-27 07:21:51 +0200675 if (!test_bit(STATE_BOOTLOADER, &intel->flags) &&
676 !test_bit(STATE_BOOTING, &intel->flags))
Loic Poulainca93cee2015-07-01 12:20:26 +0200677 goto recv;
678
679 hdr = (void *)skb->data;
680
681 /* When the firmware loading completes the device sends
682 * out a vendor specific event indicating the result of
683 * the firmware loading.
684 */
685 if (skb->len == 7 && hdr->evt == 0xff && hdr->plen == 0x05 &&
686 skb->data[2] == 0x06) {
687 if (skb->data[3] != 0x00)
688 set_bit(STATE_FIRMWARE_FAILED, &intel->flags);
689
690 if (test_and_clear_bit(STATE_DOWNLOADING, &intel->flags) &&
691 test_bit(STATE_FIRMWARE_LOADED, &intel->flags)) {
692 smp_mb__after_atomic();
693 wake_up_bit(&intel->flags, STATE_DOWNLOADING);
694 }
695
696 /* When switching to the operational firmware the device
697 * sends a vendor specific event indicating that the bootup
698 * completed.
699 */
700 } else if (skb->len == 9 && hdr->evt == 0xff && hdr->plen == 0x07 &&
701 skb->data[2] == 0x02) {
702 if (test_and_clear_bit(STATE_BOOTING, &intel->flags)) {
703 smp_mb__after_atomic();
704 wake_up_bit(&intel->flags, STATE_BOOTING);
705 }
706 }
707recv:
708 return hci_recv_frame(hdev, skb);
709}
710
711static const struct h4_recv_pkt intel_recv_pkts[] = {
712 { H4_RECV_ACL, .recv = hci_recv_frame },
713 { H4_RECV_SCO, .recv = hci_recv_frame },
714 { H4_RECV_EVENT, .recv = intel_recv_event },
715};
716
717static int intel_recv(struct hci_uart *hu, const void *data, int count)
718{
719 struct intel_data *intel = hu->priv;
720
721 if (!test_bit(HCI_UART_REGISTERED, &hu->flags))
722 return -EUNATCH;
723
724 intel->rx_skb = h4_recv_buf(hu->hdev, intel->rx_skb, data, count,
725 intel_recv_pkts,
726 ARRAY_SIZE(intel_recv_pkts));
727 if (IS_ERR(intel->rx_skb)) {
728 int err = PTR_ERR(intel->rx_skb);
729 BT_ERR("%s: Frame reassembly failed (%d)", hu->hdev->name, err);
730 intel->rx_skb = NULL;
731 return err;
732 }
733
734 return count;
735}
736
737static int intel_enqueue(struct hci_uart *hu, struct sk_buff *skb)
738{
739 struct intel_data *intel = hu->priv;
740
741 BT_DBG("hu %p skb %p", hu, skb);
742
743 skb_queue_tail(&intel->txq, skb);
744
745 return 0;
746}
747
748static struct sk_buff *intel_dequeue(struct hci_uart *hu)
749{
750 struct intel_data *intel = hu->priv;
751 struct sk_buff *skb;
752
753 skb = skb_dequeue(&intel->txq);
754 if (!skb)
755 return skb;
756
757 if (test_bit(STATE_BOOTLOADER, &intel->flags) &&
758 (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT)) {
759 struct hci_command_hdr *cmd = (void *)skb->data;
760 __u16 opcode = le16_to_cpu(cmd->opcode);
761
762 /* When the 0xfc01 command is issued to boot into
763 * the operational firmware, it will actually not
764 * send a command complete event. To keep the flow
765 * control working inject that event here.
766 */
767 if (opcode == 0xfc01)
768 inject_cmd_complete(hu->hdev, opcode);
769 }
770
771 /* Prepend skb with frame type */
772 memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1);
773
774 return skb;
775}
776
777static const struct hci_uart_proto intel_proto = {
778 .id = HCI_UART_INTEL,
779 .name = "Intel",
780 .init_speed = 115200,
Loic Poulainff289552015-08-25 17:55:44 +0200781 .oper_speed = 3000000,
Loic Poulainca93cee2015-07-01 12:20:26 +0200782 .open = intel_open,
783 .close = intel_close,
784 .flush = intel_flush,
785 .setup = intel_setup,
Loic Poulainff289552015-08-25 17:55:44 +0200786 .set_baudrate = intel_set_baudrate,
Loic Poulainca93cee2015-07-01 12:20:26 +0200787 .recv = intel_recv,
788 .enqueue = intel_enqueue,
789 .dequeue = intel_dequeue,
790};
791
Loic Poulain1ab1f232015-08-27 07:21:51 +0200792#ifdef CONFIG_ACPI
793static const struct acpi_device_id intel_acpi_match[] = {
794 { "INT33E1", 0 },
795 { },
796};
797MODULE_DEVICE_TABLE(acpi, intel_acpi_match);
798
799static int intel_acpi_probe(struct intel_device *idev)
800{
801 const struct acpi_device_id *id;
802
803 id = acpi_match_device(intel_acpi_match, &idev->pdev->dev);
804 if (!id)
805 return -ENODEV;
806
807 return 0;
808}
809#else
810static int intel_acpi_probe(struct intel_device *idev)
811{
812 return -ENODEV;
813}
814#endif
815
816static int intel_probe(struct platform_device *pdev)
817{
818 struct intel_device *idev;
819
820 idev = devm_kzalloc(&pdev->dev, sizeof(*idev), GFP_KERNEL);
821 if (!idev)
822 return -ENOMEM;
823
824 idev->pdev = pdev;
825
826 if (ACPI_HANDLE(&pdev->dev)) {
827 int err = intel_acpi_probe(idev);
828 if (err)
829 return err;
830 } else {
831 return -ENODEV;
832 }
833
834 idev->reset = devm_gpiod_get_optional(&pdev->dev, "reset",
835 GPIOD_OUT_LOW);
836 if (IS_ERR(idev->reset)) {
837 dev_err(&pdev->dev, "Unable to retrieve gpio\n");
838 return PTR_ERR(idev->reset);
839 }
840
841 platform_set_drvdata(pdev, idev);
842
843 /* Place this instance on the device list */
844 spin_lock(&intel_device_list_lock);
845 list_add_tail(&idev->list, &intel_device_list);
846 spin_unlock(&intel_device_list_lock);
847
848 dev_info(&pdev->dev, "registered.\n");
849
850 return 0;
851}
852
853static int intel_remove(struct platform_device *pdev)
854{
855 struct intel_device *idev = platform_get_drvdata(pdev);
856
857 spin_lock(&intel_device_list_lock);
858 list_del(&idev->list);
859 spin_unlock(&intel_device_list_lock);
860
861 dev_info(&pdev->dev, "unregistered.\n");
862
863 return 0;
864}
865
866static struct platform_driver intel_driver = {
867 .probe = intel_probe,
868 .remove = intel_remove,
869 .driver = {
870 .name = "hci_intel",
871 .acpi_match_table = ACPI_PTR(intel_acpi_match),
872 },
873};
874
Loic Poulainca93cee2015-07-01 12:20:26 +0200875int __init intel_init(void)
876{
Loic Poulain1ab1f232015-08-27 07:21:51 +0200877 platform_driver_register(&intel_driver);
878
Loic Poulainca93cee2015-07-01 12:20:26 +0200879 return hci_uart_register_proto(&intel_proto);
880}
881
882int __exit intel_deinit(void)
883{
Loic Poulain1ab1f232015-08-27 07:21:51 +0200884 platform_driver_unregister(&intel_driver);
885
Loic Poulainca93cee2015-07-01 12:20:26 +0200886 return hci_uart_unregister_proto(&intel_proto);
887}