1 /* 2 * Copyright (c) 2016, Linaro Ltd. 3 * Copyright (c) 2015, Sony Mobile Communications Inc. 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License version 2 and 7 * only version 2 as published by the Free Software Foundation. 8 * 9 * This program is distributed in the hope that it will be useful, 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12 * GNU General Public License for more details. 13 */ 14 15 #include <linux/module.h> 16 #include <linux/slab.h> 17 #include <linux/rpmsg.h> 18 #include <linux/soc/qcom/wcnss_ctrl.h> 19 #include <linux/platform_device.h> 20 21 #include <net/bluetooth/bluetooth.h> 22 #include <net/bluetooth/hci_core.h> 23 24 #include "btqca.h" 25 26 struct btqcomsmd { 27 struct hci_dev *hdev; 28 29 struct rpmsg_endpoint *acl_channel; 30 struct rpmsg_endpoint *cmd_channel; 31 }; 32 33 static int btqcomsmd_recv(struct hci_dev *hdev, unsigned int type, 34 const void *data, size_t count) 35 { 36 struct sk_buff *skb; 37 38 /* Use GFP_ATOMIC as we're in IRQ context */ 39 skb = bt_skb_alloc(count, GFP_ATOMIC); 40 if (!skb) { 41 hdev->stat.err_rx++; 42 return -ENOMEM; 43 } 44 45 hci_skb_pkt_type(skb) = type; 46 memcpy(skb_put(skb, count), data, count); 47 48 return hci_recv_frame(hdev, skb); 49 } 50 51 static int btqcomsmd_acl_callback(struct rpmsg_device *rpdev, void *data, 52 int count, void *priv, u32 addr) 53 { 54 struct btqcomsmd *btq = priv; 55 56 btq->hdev->stat.byte_rx += count; 57 return btqcomsmd_recv(btq->hdev, HCI_ACLDATA_PKT, data, count); 58 } 59 60 static int btqcomsmd_cmd_callback(struct rpmsg_device *rpdev, void *data, 61 int count, void *priv, u32 addr) 62 { 63 struct btqcomsmd *btq = priv; 64 65 return btqcomsmd_recv(btq->hdev, HCI_EVENT_PKT, data, count); 66 } 67 68 static int btqcomsmd_send(struct hci_dev *hdev, struct sk_buff *skb) 69 { 70 struct btqcomsmd *btq = hci_get_drvdata(hdev); 71 int ret; 72 73 switch (hci_skb_pkt_type(skb)) { 74 case HCI_ACLDATA_PKT: 75 ret = rpmsg_send(btq->acl_channel, skb->data, skb->len); 76 hdev->stat.acl_tx++; 77 hdev->stat.byte_tx += skb->len; 78 break; 79 case HCI_COMMAND_PKT: 80 ret = rpmsg_send(btq->cmd_channel, skb->data, skb->len); 81 hdev->stat.cmd_tx++; 82 break; 83 default: 84 ret = -EILSEQ; 85 break; 86 } 87 88 kfree_skb(skb); 89 90 return ret; 91 } 92 93 static int btqcomsmd_open(struct hci_dev *hdev) 94 { 95 return 0; 96 } 97 98 static int btqcomsmd_close(struct hci_dev *hdev) 99 { 100 return 0; 101 } 102 103 static int btqcomsmd_probe(struct platform_device *pdev) 104 { 105 struct btqcomsmd *btq; 106 struct hci_dev *hdev; 107 void *wcnss; 108 int ret; 109 110 btq = devm_kzalloc(&pdev->dev, sizeof(*btq), GFP_KERNEL); 111 if (!btq) 112 return -ENOMEM; 113 114 wcnss = dev_get_drvdata(pdev->dev.parent); 115 116 btq->acl_channel = qcom_wcnss_open_channel(wcnss, "APPS_RIVA_BT_ACL", 117 btqcomsmd_acl_callback, btq); 118 if (IS_ERR(btq->acl_channel)) 119 return PTR_ERR(btq->acl_channel); 120 121 btq->cmd_channel = qcom_wcnss_open_channel(wcnss, "APPS_RIVA_BT_CMD", 122 btqcomsmd_cmd_callback, btq); 123 if (IS_ERR(btq->cmd_channel)) 124 return PTR_ERR(btq->cmd_channel); 125 126 hdev = hci_alloc_dev(); 127 if (!hdev) 128 return -ENOMEM; 129 130 hci_set_drvdata(hdev, btq); 131 btq->hdev = hdev; 132 SET_HCIDEV_DEV(hdev, &pdev->dev); 133 134 hdev->bus = HCI_SMD; 135 hdev->open = btqcomsmd_open; 136 hdev->close = btqcomsmd_close; 137 hdev->send = btqcomsmd_send; 138 hdev->set_bdaddr = qca_set_bdaddr_rome; 139 140 ret = hci_register_dev(hdev); 141 if (ret < 0) { 142 hci_free_dev(hdev); 143 return ret; 144 } 145 146 platform_set_drvdata(pdev, btq); 147 148 return 0; 149 } 150 151 static int btqcomsmd_remove(struct platform_device *pdev) 152 { 153 struct btqcomsmd *btq = platform_get_drvdata(pdev); 154 155 hci_unregister_dev(btq->hdev); 156 hci_free_dev(btq->hdev); 157 158 rpmsg_destroy_ept(btq->cmd_channel); 159 rpmsg_destroy_ept(btq->acl_channel); 160 161 return 0; 162 } 163 164 static const struct of_device_id btqcomsmd_of_match[] = { 165 { .compatible = "qcom,wcnss-bt", }, 166 { }, 167 }; 168 MODULE_DEVICE_TABLE(of, btqcomsmd_of_match); 169 170 static struct platform_driver btqcomsmd_driver = { 171 .probe = btqcomsmd_probe, 172 .remove = btqcomsmd_remove, 173 .driver = { 174 .name = "btqcomsmd", 175 .of_match_table = btqcomsmd_of_match, 176 }, 177 }; 178 179 module_platform_driver(btqcomsmd_driver); 180 181 MODULE_AUTHOR("Bjorn Andersson <bjorn.andersson@sonymobile.com>"); 182 MODULE_DESCRIPTION("Qualcomm SMD HCI driver"); 183 MODULE_LICENSE("GPL v2"); 184