drivers/bluetooth/btqcomsmd.c

   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");