bluetooth: add rtl8723b driver

Change-Id: I5c6ef165210b758a07fcb7b8ce4393d9699cca57
Signed-off-by: Rock Shen <rock_shen@asus.com>

Author: RockShen-ASUS

arch/arm/configs/rockchip_linux_defconfig

@@ -171,8 +171,10 @@ CONFIG_BT_RFCOMM=y
 CONFIG_BT_HIDP=y
 CONFIG_BT_HCIBTUSB=y
 CONFIG_BT_HCIUART=y
-CONFIG_BT_HCIUART_ATH3K=y
-CONFIG_BT_HCIUART_LL=y
+CONFIG_BT_HCIUART_H4=y
+CONFIG_BT_HCIUART_3WIRE=y
+CONFIG_BT_HCIUART_ATH3K=n
+CONFIG_BT_HCIUART_LL=n
 CONFIG_BT_HCIBFUSB=y
 CONFIG_BT_HCIVHCI=y
 CONFIG_BT_MRVL=y

drivers/bluetooth/Makefile

@@ -28,7 +28,7 @@ obj-$(CONFIG_BT_QCA)		+= btqca.o
 btmrvl-y			:= btmrvl_main.o
 btmrvl-$(CONFIG_DEBUG_FS)	+= btmrvl_debugfs.o
 
-hci_uart-y				:= hci_ldisc.o
+hci_uart-y				:= hci_ldisc.o rtk_coex.o
 hci_uart-$(CONFIG_BT_HCIUART_H4)	+= hci_h4.o
 hci_uart-$(CONFIG_BT_HCIUART_BCSP)	+= hci_bcsp.o
 hci_uart-$(CONFIG_BT_HCIUART_LL)	+= hci_ll.o

drivers/bluetooth/hci_h5.c

@@ -30,6 +30,10 @@
 
 #include "hci_uart.h"
 
+#ifdef BTCOEX
+#include "rtk_coex.h"
+#endif
+
 #define HCI_3WIRE_ACK_PKT	0
 #define HCI_3WIRE_LINK_PKT	15
 
@@ -192,7 +196,7 @@ static void h5_peer_reset(struct hci_uart *hu)
 static int h5_open(struct hci_uart *hu)
 {
 	struct h5 *h5;
-	const unsigned char sync[] = { 0x01, 0x7e };
+	/* const unsigned char sync[] = { 0x01, 0x7e }; */
 
 	BT_DBG("hu %p", hu);
 
@@ -214,11 +218,16 @@ static int h5_open(struct hci_uart *hu)
 
 	h5->tx_win = H5_TX_WIN_MAX;
 
-	set_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags);
+	/* set_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags); */
+
+	/* Firmware was already download by userspace app rtk_hciattach */
+	h5->state = H5_ACTIVE;
+	hci_uart_init_ready(hu);
 
 	/* Send initial sync request */
-	h5_link_control(hu, sync, sizeof(sync));
-	mod_timer(&h5->timer, jiffies + H5_SYNC_TIMEOUT);
+	/* h5_link_control(hu, sync, sizeof(sync));
+	 * mod_timer(&h5->timer, jiffies + H5_SYNC_TIMEOUT);
+	 */
 
 	return 0;
 }
@@ -365,6 +374,16 @@ static void h5_complete_rx_pkt(struct hci_uart *hu)
 		/* Remove Three-wire header */
 		skb_pull(h5->rx_skb, 4);
 
+#ifdef BTCOEX
+		if (bt_cb(h5->rx_skb)->pkt_type == HCI_EVENT_PKT)
+			rtk_btcoex_parse_event(h5->rx_skb->data,
+					       h5->rx_skb->len);
+
+		if (bt_cb(h5->rx_skb)->pkt_type == HCI_ACLDATA_PKT)
+			rtk_btcoex_parse_l2cap_data_rx(h5->rx_skb->data,
+						       h5->rx_skb->len);
+#endif
+
 		hci_recv_frame(hu->hdev, h5->rx_skb);
 		h5->rx_skb = NULL;
 
@@ -380,6 +399,11 @@ static void h5_complete_rx_pkt(struct hci_uart *hu)
 
 static int h5_rx_crc(struct hci_uart *hu, unsigned char c)
 {
+	struct h5 *h5 = hu->priv;
+
+	/* TODO: crc check */
+	skb_trim(h5->rx_skb, h5->rx_skb->len - 2);
+
 	h5_complete_rx_pkt(hu);
 
 	return 0;

drivers/bluetooth/hci_ldisc.c

@@ -49,6 +49,10 @@
 #include "btbcm.h"
 #include "hci_uart.h"
 
+#ifdef BTCOEX
+#include "rtk_coex.h"
+#endif
+
 #define VERSION "2.3"
 
 static const struct hci_uart_proto *hup[HCI_UART_MAX_PROTO];
@@ -130,7 +134,7 @@ int hci_uart_tx_wakeup(struct hci_uart *hu)
 
 	BT_DBG("");
 
-	schedule_work(&hu->write_work);
+	schedule_work_on(0, &hu->write_work);
 
 	return 0;
 }
@@ -142,11 +146,6 @@ static void hci_uart_write_work(struct work_struct *work)
 	struct hci_dev *hdev = hu->hdev;
 	struct sk_buff *skb;
 
-	if (!test_bit(HCI_UART_PROTO_READY, &hu->flags)) {
-		clear_bit(HCI_UART_SENDING, &hu->tx_state);
-		return;
-	}
-
 	/* REVISIT: should we cope with bad skbs or ->write() returning
 	 * and error value ?
 	 */
@@ -212,6 +211,10 @@ static int hci_uart_open(struct hci_dev *hdev)
 {
 	BT_DBG("%s %p", hdev->name, hdev);
 
+#ifdef BTCOEX
+	rtk_btcoex_open(hdev);
+#endif
+
 	/* Nothing to do for UART driver */
 	return 0;
 }
@@ -245,6 +248,11 @@ static int hci_uart_close(struct hci_dev *hdev)
 
 	hci_uart_flush(hdev);
 	hdev->flush = NULL;
+
+#ifdef BTCOEX
+	rtk_btcoex_close();
+#endif
+
 	return 0;
 }
 
@@ -255,8 +263,12 @@ static int hci_uart_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
 
 	BT_DBG("%s: type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len);
 
-	if (!test_bit(HCI_UART_PROTO_READY, &hu->flags))
-		return -EUNATCH;
+#ifdef BTCOEX
+	if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT)
+		rtk_btcoex_parse_cmd(skb->data, skb->len);
+	if (bt_cb(skb)->pkt_type == HCI_ACLDATA_PKT)
+		rtk_btcoex_parse_l2cap_data_tx(skb->data, skb->len);
+#endif
 
 	hu->proto->enqueue(hu, skb);
 
@@ -512,9 +524,9 @@ static void hci_uart_tty_close(struct tty_struct *tty)
 	if (hdev)
 		hci_uart_close(hdev);
 
-	if (test_and_clear_bit(HCI_UART_PROTO_READY, &hu->flags)) {
-		cancel_work_sync(&hu->write_work);
+	cancel_work_sync(&hu->write_work);
 
+	if (test_and_clear_bit(HCI_UART_PROTO_READY, &hu->flags)) {
 		if (hdev) {
 			if (test_bit(HCI_UART_REGISTERED, &hu->flags))
 				hci_unregister_dev(hdev);
@@ -644,6 +656,10 @@ static int hci_uart_register_dev(struct hci_uart *hu)
 
 	set_bit(HCI_UART_REGISTERED, &hu->flags);
 
+#ifdef BTCOEX
+	rtk_btcoex_probe(hdev);
+#endif
+
 	return 0;
 }
 
@@ -661,15 +677,15 @@ static int hci_uart_set_proto(struct hci_uart *hu, int id)
 		return err;
 
 	hu->proto = p;
+	set_bit(HCI_UART_PROTO_READY, &hu->flags);
 
 	err = hci_uart_register_dev(hu);
 	if (err) {
+		clear_bit(HCI_UART_PROTO_READY, &hu->flags);
 		p->close(hu);
 		return err;
 	}
 
-	set_bit(HCI_UART_PROTO_READY, &hu->flags);
-
 	return 0;
 }
 
@@ -830,6 +846,10 @@ static int __init hci_uart_init(void)
 	qca_init();
 #endif
 
+#ifdef BTCOEX
+	rtk_btcoex_init();
+#endif
+
 	return 0;
 }
 
@@ -866,6 +886,11 @@ static void __exit hci_uart_exit(void)
 	err = tty_unregister_ldisc(N_HCI);
 	if (err)
 		BT_ERR("Can't unregister HCI line discipline (%d)", err);
+
+#ifdef BTCOEX
+	rtk_btcoex_exit();
+#endif
+
 }
 
 module_init(hci_uart_init);

drivers/bluetooth/hci_uart.h

@@ -27,6 +27,8 @@
 #define N_HCI	15
 #endif
 
+#define BTCOEX
+
 /* Ioctls */
 #define HCIUARTSETPROTO		_IOW('U', 200, int)
 #define HCIUARTGETPROTO		_IOR('U', 201, int)