1 // SPDX-License-Identifier: GPL-2.0
5  * Bluetooth support for MediaTek serial devices
27 #include <net/bluetooth/bluetooth.h>
28 #include <net/bluetooth/hci_core.h>
86 	((bdev)->data->flags & BTMTKUART_FLAG_STANDALONE_HW)
88 	!((bdev)->data->flags & BTMTKUART_FLAG_STANDALONE_HW)
102 	hlen = sizeof(*hdr) + wmt_params->dlen;  in mtk_hci_wmt_sync()
104 		err = -EINVAL;  in mtk_hci_wmt_sync()
110 		err = -ENOMEM;  in mtk_hci_wmt_sync()
114 	hdr = &wc->hdr;  in mtk_hci_wmt_sync()
115 	hdr->dir = 1;  in mtk_hci_wmt_sync()
116 	hdr->op = wmt_params->op;  in mtk_hci_wmt_sync()
117 	hdr->dlen = cpu_to_le16(wmt_params->dlen + 1);  in mtk_hci_wmt_sync()
118 	hdr->flag = wmt_params->flag;  in mtk_hci_wmt_sync()
119 	memcpy(wc->data, wmt_params->data, wmt_params->dlen);  in mtk_hci_wmt_sync()
121 	set_bit(BTMTKUART_TX_WAIT_VND_EVT, &bdev->tx_state);  in mtk_hci_wmt_sync()
125 		clear_bit(BTMTKUART_TX_WAIT_VND_EVT, &bdev->tx_state);  in mtk_hci_wmt_sync()
138 	err = wait_on_bit_timeout(&bdev->tx_state, BTMTKUART_TX_WAIT_VND_EVT,  in mtk_hci_wmt_sync()
140 	if (err == -EINTR) {  in mtk_hci_wmt_sync()
142 		clear_bit(BTMTKUART_TX_WAIT_VND_EVT, &bdev->tx_state);  in mtk_hci_wmt_sync()
148 		clear_bit(BTMTKUART_TX_WAIT_VND_EVT, &bdev->tx_state);  in mtk_hci_wmt_sync()
149 		err = -ETIMEDOUT;  in mtk_hci_wmt_sync()
154 	wmt_evt = (struct btmtk_hci_wmt_evt *)bdev->evt_skb->data;  in mtk_hci_wmt_sync()
155 	if (wmt_evt->whdr.op != hdr->op) {  in mtk_hci_wmt_sync()
157 			   wmt_evt->whdr.op, hdr->op);  in mtk_hci_wmt_sync()
158 		err = -EIO;  in mtk_hci_wmt_sync()
162 	switch (wmt_evt->whdr.op) {  in mtk_hci_wmt_sync()
164 		if (wmt_evt->whdr.flag == 2)  in mtk_hci_wmt_sync()
171 		if (be16_to_cpu(wmt_evt_funcc->status) == 0x404)  in mtk_hci_wmt_sync()
173 		else if (be16_to_cpu(wmt_evt_funcc->status) == 0x420)  in mtk_hci_wmt_sync()
180 	if (wmt_params->status)  in mtk_hci_wmt_sync()
181 		*wmt_params->status = status;  in mtk_hci_wmt_sync()
186 	kfree_skb(bdev->evt_skb);  in mtk_hci_wmt_sync()
187 	bdev->evt_skb = NULL;  in mtk_hci_wmt_sync()
195 	struct hci_event_hdr *hdr = (void *)skb->data;  in btmtkuart_recv_event()
201 	if (test_bit(BTMTKUART_TX_WAIT_VND_EVT, &bdev->tx_state)) {  in btmtkuart_recv_event()
202 		bdev->evt_skb = skb_clone(skb, GFP_KERNEL);  in btmtkuart_recv_event()
203 		if (!bdev->evt_skb) {  in btmtkuart_recv_event()
204 			err = -ENOMEM;  in btmtkuart_recv_event()
213 	if (hdr->evt == HCI_EV_WMT) {  in btmtkuart_recv_event()
215 				       &bdev->tx_state)) {  in btmtkuart_recv_event()
218 			wake_up_bit(&bdev->tx_state, BTMTKUART_TX_WAIT_VND_EVT);  in btmtkuart_recv_event()
225 	kfree_skb(bdev->evt_skb);  in btmtkuart_recv_event()
226 	bdev->evt_skb = NULL;  in btmtkuart_recv_event()
242 	struct serdev_device *serdev = bdev->serdev;  in btmtkuart_tx_work()
243 	struct hci_dev *hdev = bdev->hdev;  in btmtkuart_tx_work()
246 		clear_bit(BTMTKUART_TX_STATE_WAKEUP, &bdev->tx_state);  in btmtkuart_tx_work()
249 			struct sk_buff *skb = skb_dequeue(&bdev->txq);  in btmtkuart_tx_work()
255 			len = serdev_device_write_buf(serdev, skb->data,  in btmtkuart_tx_work()
256 						      skb->len);  in btmtkuart_tx_work()
257 			hdev->stat.byte_tx += len;  in btmtkuart_tx_work()
260 			if (skb->len > 0) {  in btmtkuart_tx_work()
261 				skb_queue_head(&bdev->txq, skb);  in btmtkuart_tx_work()
267 				hdev->stat.cmd_tx++;  in btmtkuart_tx_work()
270 				hdev->stat.acl_tx++;  in btmtkuart_tx_work()
273 				hdev->stat.sco_tx++;  in btmtkuart_tx_work()
280 		if (!test_bit(BTMTKUART_TX_STATE_WAKEUP, &bdev->tx_state))  in btmtkuart_tx_work()
284 	clear_bit(BTMTKUART_TX_STATE_ACTIVE, &bdev->tx_state);  in btmtkuart_tx_work()
289 	if (test_and_set_bit(BTMTKUART_TX_STATE_ACTIVE, &bdev->tx_state))  in btmtkuart_tx_wakeup()
290 		set_bit(BTMTKUART_TX_STATE_WAKEUP, &bdev->tx_state);  in btmtkuart_tx_wakeup()
292 	schedule_work(&bdev->tx_work);  in btmtkuart_tx_wakeup()
302 	if (!bdev->stp_dlen && bdev->stp_cursor >= 6)  in mtk_stp_split()
303 		bdev->stp_cursor = 0;  in mtk_stp_split()
306 	while (bdev->stp_cursor < 6 && count > 0) {  in mtk_stp_split()
307 		bdev->stp_pad[bdev->stp_cursor] = *data;  in mtk_stp_split()
308 		bdev->stp_cursor++;  in mtk_stp_split()
310 		count--;  in mtk_stp_split()
314 	if (!bdev->stp_dlen && bdev->stp_cursor >= 6) {  in mtk_stp_split()
315 		shdr = (struct mtk_stp_hdr *)&bdev->stp_pad[2];  in mtk_stp_split()
316 		bdev->stp_dlen = be16_to_cpu(shdr->dlen) & 0x0fff;  in mtk_stp_split()
319 		if (shdr->prefix != 0x80 || bdev->stp_dlen > 2048) {  in mtk_stp_split()
320 			bt_dev_err(bdev->hdev, "stp format unexpected (%d, %d)",  in mtk_stp_split()
321 				   shdr->prefix, bdev->stp_dlen);  in mtk_stp_split()
322 			bdev->stp_cursor = 2;  in mtk_stp_split()
323 			bdev->stp_dlen = 0;  in mtk_stp_split()
332 	*sz_h4 = min_t(int, count, bdev->stp_dlen);  in mtk_stp_split()
335 	bdev->stp_dlen -= *sz_h4;  in mtk_stp_split()
349 		/*  The serial data received from MT7622 BT controller is  in btmtkuart_recv()
353 		 *   -----------------------------------  in btmtkuart_recv()
355 		 *   -----------------------------------  in btmtkuart_recv()
368 		adv = p_h4 - p_left;  in btmtkuart_recv()
369 		sz_left -= adv;  in btmtkuart_recv()
372 		bdev->rx_skb = h4_recv_buf(&bdev->hu, bdev->rx_skb, p_h4,  in btmtkuart_recv()
375 		if (IS_ERR(bdev->rx_skb)) {  in btmtkuart_recv()
376 			err = PTR_ERR(bdev->rx_skb);  in btmtkuart_recv()
377 			bt_dev_err(bdev->hdev,  in btmtkuart_recv()
379 			bdev->rx_skb = NULL;  in btmtkuart_recv()
383 		sz_left -= sz_h4;  in btmtkuart_recv()
393 	btmtkuart_recv(bdev->hdev, data, count);  in btmtkuart_receive_buf()
395 	bdev->hdev->stat.byte_rx += count;  in btmtkuart_receive_buf()
418 	err = serdev_device_open(bdev->serdev);  in btmtkuart_open()
421 			   dev_name(&bdev->serdev->dev));  in btmtkuart_open()
426 		if (bdev->curr_speed != bdev->desired_speed)  in btmtkuart_open()
427 			err = serdev_device_set_baudrate(bdev->serdev,  in btmtkuart_open()
430 			err = serdev_device_set_baudrate(bdev->serdev,  in btmtkuart_open()
431 							 bdev->desired_speed);  in btmtkuart_open()
435 				   dev_name(&bdev->serdev->dev));  in btmtkuart_open()
439 		serdev_device_set_flow_control(bdev->serdev, false);  in btmtkuart_open()
442 	bdev->stp_cursor = 2;  in btmtkuart_open()
443 	bdev->stp_dlen = 0;  in btmtkuart_open()
445 	dev = &bdev->serdev->dev;  in btmtkuart_open()
453 	err = clk_prepare_enable(bdev->clk);  in btmtkuart_open()
464 	serdev_device_close(bdev->serdev);  in btmtkuart_open()
472 	struct device *dev = &bdev->serdev->dev;  in btmtkuart_close()
475 	clk_disable_unprepare(bdev->clk);  in btmtkuart_close()
479 	serdev_device_close(bdev->serdev);  in btmtkuart_close()
489 	serdev_device_write_flush(bdev->serdev);  in btmtkuart_flush()
490 	skb_queue_purge(&bdev->txq);  in btmtkuart_flush()
492 	cancel_work_sync(&bdev->tx_work);  in btmtkuart_flush()
494 	kfree_skb(bdev->rx_skb);  in btmtkuart_flush()
495 	bdev->rx_skb = NULL;  in btmtkuart_flush()
497 	bdev->stp_cursor = 2;  in btmtkuart_flush()
498 	bdev->stp_dlen = 0;  in btmtkuart_flush()
536 	baudrate = cpu_to_le32(bdev->desired_speed);  in btmtkuart_change_baudrate()
549 	err = serdev_device_set_baudrate(bdev->serdev,  in btmtkuart_change_baudrate()
550 					 bdev->desired_speed);  in btmtkuart_change_baudrate()
557 	serdev_device_set_flow_control(bdev->serdev, false);  in btmtkuart_change_baudrate()
561 	err = serdev_device_write_buf(bdev->serdev, &param, sizeof(param));  in btmtkuart_change_baudrate()
565 	serdev_device_wait_until_sent(bdev->serdev, 0);  in btmtkuart_change_baudrate()
584 	bdev->curr_speed = bdev->desired_speed;  in btmtkuart_change_baudrate()
605 	if (test_bit(BTMTKUART_REQUIRED_WAKEUP, &bdev->tx_state)) {  in btmtkuart_setup()
618 		clear_bit(BTMTKUART_REQUIRED_WAKEUP, &bdev->tx_state);  in btmtkuart_setup()
643 	err = btmtk_setup_firmware(hdev, bdev->data->fwname, mtk_hci_wmt_sync);  in btmtkuart_setup()
652 	/* -ETIMEDOUT happens */  in btmtkuart_setup()
665 	/* Enable Bluetooth protocol */  in btmtkuart_setup()
745 	dlen = skb->len;  in btmtkuart_send_frame()
747 	shdr->prefix = 0x80;  in btmtkuart_send_frame()
748 	shdr->dlen = cpu_to_be16((dlen & 0x0fff) | (type << 12));  in btmtkuart_send_frame()
749 	shdr->cs = 0;		/* MT7622 doesn't care about checksum value */  in btmtkuart_send_frame()
754 	skb_queue_tail(&bdev->txq, skb);  in btmtkuart_send_frame()
763 	struct device_node *node = serdev->dev.of_node;  in btmtkuart_parse_dt()
768 		of_property_read_u32(node, "current-speed", &speed);  in btmtkuart_parse_dt()
770 		bdev->desired_speed = speed;  in btmtkuart_parse_dt()
772 		bdev->vcc = devm_regulator_get(&serdev->dev, "vcc");  in btmtkuart_parse_dt()
773 		if (IS_ERR(bdev->vcc)) {  in btmtkuart_parse_dt()
774 			err = PTR_ERR(bdev->vcc);  in btmtkuart_parse_dt()
778 		bdev->osc = devm_clk_get_optional(&serdev->dev, "osc");  in btmtkuart_parse_dt()
779 		if (IS_ERR(bdev->osc)) {  in btmtkuart_parse_dt()
780 			err = PTR_ERR(bdev->osc);  in btmtkuart_parse_dt()
784 		bdev->boot = devm_gpiod_get_optional(&serdev->dev, "boot",  in btmtkuart_parse_dt()
786 		if (IS_ERR(bdev->boot)) {  in btmtkuart_parse_dt()
787 			err = PTR_ERR(bdev->boot);  in btmtkuart_parse_dt()
791 		bdev->pinctrl = devm_pinctrl_get(&serdev->dev);  in btmtkuart_parse_dt()
792 		if (IS_ERR(bdev->pinctrl)) {  in btmtkuart_parse_dt()
793 			err = PTR_ERR(bdev->pinctrl);  in btmtkuart_parse_dt()
797 		bdev->pins_boot = pinctrl_lookup_state(bdev->pinctrl,  in btmtkuart_parse_dt()
799 		if (IS_ERR(bdev->pins_boot) && !bdev->boot) {  in btmtkuart_parse_dt()
800 			err = PTR_ERR(bdev->pins_boot);  in btmtkuart_parse_dt()
801 			dev_err(&serdev->dev,  in btmtkuart_parse_dt()
806 		bdev->pins_runtime = pinctrl_lookup_state(bdev->pinctrl,  in btmtkuart_parse_dt()
808 		if (IS_ERR(bdev->pins_runtime)) {  in btmtkuart_parse_dt()
809 			err = PTR_ERR(bdev->pins_runtime);  in btmtkuart_parse_dt()
813 		bdev->reset = devm_gpiod_get_optional(&serdev->dev, "reset",  in btmtkuart_parse_dt()
815 		if (IS_ERR(bdev->reset)) {  in btmtkuart_parse_dt()
816 			err = PTR_ERR(bdev->reset);  in btmtkuart_parse_dt()
820 		bdev->clk = devm_clk_get(&serdev->dev, "ref");  in btmtkuart_parse_dt()
821 		if (IS_ERR(bdev->clk))  in btmtkuart_parse_dt()
822 			return PTR_ERR(bdev->clk);  in btmtkuart_parse_dt()
834 	bdev = devm_kzalloc(&serdev->dev, sizeof(*bdev), GFP_KERNEL);  in btmtkuart_probe()
836 		return -ENOMEM;  in btmtkuart_probe()
838 	bdev->data = of_device_get_match_data(&serdev->dev);  in btmtkuart_probe()
839 	if (!bdev->data)  in btmtkuart_probe()
840 		return -ENODEV;  in btmtkuart_probe()
842 	bdev->serdev = serdev;  in btmtkuart_probe()
851 	INIT_WORK(&bdev->tx_work, btmtkuart_tx_work);  in btmtkuart_probe()
852 	skb_queue_head_init(&bdev->txq);  in btmtkuart_probe()
857 		dev_err(&serdev->dev, "Can't allocate HCI device\n");  in btmtkuart_probe()
858 		return -ENOMEM;  in btmtkuart_probe()
861 	bdev->hdev = hdev;  in btmtkuart_probe()
862 	bdev->hu.hdev = hdev;  in btmtkuart_probe()
864 	hdev->bus = HCI_UART;  in btmtkuart_probe()
867 	hdev->open     = btmtkuart_open;  in btmtkuart_probe()
868 	hdev->close    = btmtkuart_close;  in btmtkuart_probe()
869 	hdev->flush    = btmtkuart_flush;  in btmtkuart_probe()
870 	hdev->setup    = btmtkuart_setup;  in btmtkuart_probe()
871 	hdev->shutdown = btmtkuart_shutdown;  in btmtkuart_probe()
872 	hdev->send     = btmtkuart_send_frame;  in btmtkuart_probe()
873 	hdev->set_bdaddr = btmtk_set_bdaddr;  in btmtkuart_probe()
874 	SET_HCIDEV_DEV(hdev, &serdev->dev);  in btmtkuart_probe()
876 	hdev->manufacturer = 70;  in btmtkuart_probe()
880 		err = clk_prepare_enable(bdev->osc);  in btmtkuart_probe()
884 		if (bdev->boot) {  in btmtkuart_probe()
885 			gpiod_set_value_cansleep(bdev->boot, 1);  in btmtkuart_probe()
890 			pinctrl_select_state(bdev->pinctrl, bdev->pins_boot);  in btmtkuart_probe()
894 		err = regulator_enable(bdev->vcc);  in btmtkuart_probe()
898 		/* Reset if the reset-gpios is available otherwise the board  in btmtkuart_probe()
899 		 * -level design should be guaranteed.  in btmtkuart_probe()
901 		if (bdev->reset) {  in btmtkuart_probe()
902 			gpiod_set_value_cansleep(bdev->reset, 1);  in btmtkuart_probe()
904 			gpiod_set_value_cansleep(bdev->reset, 0);  in btmtkuart_probe()
912 		if (bdev->boot)  in btmtkuart_probe()
913 			devm_gpiod_put(&serdev->dev, bdev->boot);  in btmtkuart_probe()
915 		pinctrl_select_state(bdev->pinctrl, bdev->pins_runtime);  in btmtkuart_probe()
920 		pm_runtime_no_callbacks(&serdev->dev);  in btmtkuart_probe()
922 		set_bit(BTMTKUART_REQUIRED_WAKEUP, &bdev->tx_state);  in btmtkuart_probe()
927 		dev_err(&serdev->dev, "Can't register HCI device\n");  in btmtkuart_probe()
935 		regulator_disable(bdev->vcc);  in btmtkuart_probe()
938 		clk_disable_unprepare(bdev->osc);  in btmtkuart_probe()
948 	struct hci_dev *hdev = bdev->hdev;  in btmtkuart_remove()
951 		regulator_disable(bdev->vcc);  in btmtkuart_remove()
952 		clk_disable_unprepare(bdev->osc);  in btmtkuart_remove()
975 	{ .compatible = "mediatek,mt7622-bluetooth", .data = &mt7622_data},
976 	{ .compatible = "mediatek,mt7663u-bluetooth", .data = &mt7663_data},
977 	{ .compatible = "mediatek,mt7668u-bluetooth", .data = &mt7668_data},
995 MODULE_DESCRIPTION("MediaTek Bluetooth Serial driver ver " VERSION);