1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
|
/*
* Copyright (c) 2015, Sony Mobile Communications Inc.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/soc/qcom/smd.h>
#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>
#include <net/bluetooth/hci.h>
#define EDL_NVM_ACCESS_SET_REQ_CMD 0x01
#define EDL_NVM_ACCESS_OPCODE 0xfc0b
struct btqcomsmd {
struct qcom_smd_channel *acl_channel;
struct qcom_smd_channel *cmd_channel;
};
static int btqcomsmd_recv(struct hci_dev *hdev,
unsigned type,
const void *data,
size_t count)
{
struct sk_buff *skb;
void *buf;
/* Use GFP_ATOMIC as we're in IRQ context */
skb = bt_skb_alloc(count, GFP_ATOMIC);
if (!skb)
return -ENOMEM;
bt_cb(skb)->pkt_type = type;
/* Use io accessor as data might be ioremapped */
buf = skb_put(skb, count);
memcpy_fromio(buf, data, count);
return hci_recv_frame(hdev, skb);
}
static int btqcomsmd_acl_callback(struct qcom_smd_device *qsdev,
const void *data,
size_t count)
{
struct hci_dev *hdev = dev_get_drvdata(&qsdev->dev);
return btqcomsmd_recv(hdev, HCI_ACLDATA_PKT, data, count);
}
static int btqcomsmd_cmd_callback(struct qcom_smd_device *qsdev,
const void *data,
size_t count)
{
struct hci_dev *hdev = dev_get_drvdata(&qsdev->dev);
return btqcomsmd_recv(hdev, HCI_EVENT_PKT, data, count);
}
static int btqcomsmd_send(struct hci_dev *hdev, struct sk_buff *skb)
{
struct btqcomsmd *btq = hci_get_drvdata(hdev);
int ret;
switch (bt_cb(skb)->pkt_type) {
case HCI_ACLDATA_PKT:
case HCI_SCODATA_PKT:
ret = qcom_smd_send(btq->acl_channel, skb->data, skb->len);
break;
case HCI_COMMAND_PKT:
ret = qcom_smd_send(btq->cmd_channel, skb->data, skb->len);
break;
default:
ret = -ENODEV;
break;
}
return ret;
}
static int btqcomsmd_open(struct hci_dev *hdev)
{
set_bit(HCI_RUNNING, &hdev->flags);
return 0;
}
static int btqcomsmd_close(struct hci_dev *hdev)
{
clear_bit(HCI_RUNNING, &hdev->flags);
return 0;
}
static int btqcomsmd_set_bdaddr(struct hci_dev *hdev,
const bdaddr_t *bdaddr)
{
struct sk_buff *skb;
u8 cmd[9];
int err;
cmd[0] = EDL_NVM_ACCESS_SET_REQ_CMD;
cmd[1] = 0x02; /* TAG ID */
cmd[2] = sizeof(bdaddr_t); /* size */
memcpy(cmd + 3, bdaddr, sizeof(bdaddr_t));
skb = __hci_cmd_sync_ev(hdev,
EDL_NVM_ACCESS_OPCODE,
sizeof(cmd), cmd,
HCI_VENDOR_PKT, HCI_INIT_TIMEOUT);
if (IS_ERR(skb)) {
err = PTR_ERR(skb);
BT_ERR("%s: Change address command failed (%d)",
hdev->name, err);
return err;
}
kfree_skb(skb);
return 0;
}
static int btqcomsmd_probe(struct qcom_smd_device *sdev)
{
struct qcom_smd_channel *acl;
struct btqcomsmd *btq;
struct hci_dev *hdev;
int ret;
acl = qcom_smd_open_channel(sdev,
"APPS_RIVA_BT_ACL",
btqcomsmd_acl_callback);
if (IS_ERR(acl))
return PTR_ERR(acl);
btq = devm_kzalloc(&sdev->dev, sizeof(*btq), GFP_KERNEL);
if (!btq)
return -ENOMEM;
btq->acl_channel = acl;
btq->cmd_channel = sdev->channel;
hdev = hci_alloc_dev();
if (!hdev)
return -ENOMEM;
hdev->bus = HCI_SMD;
hdev->open = btqcomsmd_open;
hdev->close = btqcomsmd_close;
hdev->send = btqcomsmd_send;
hdev->set_bdaddr = btqcomsmd_set_bdaddr;
ret = hci_register_dev(hdev);
if (ret < 0) {
hci_free_dev(hdev);
return ret;
}
hci_set_drvdata(hdev, btq);
dev_set_drvdata(&sdev->dev, hdev);
return 0;
}
static void btqcomsmd_remove(struct qcom_smd_device *sdev)
{
struct hci_dev *hdev = dev_get_drvdata(&sdev->dev);;
hci_unregister_dev(hdev);
hci_free_dev(hdev);
}
static const struct qcom_smd_id btqcomsmd_match[] = {
{ .name = "APPS_RIVA_BT_CMD" },
{}
};
static struct qcom_smd_driver btqcomsmd_cmd_driver = {
.probe = btqcomsmd_probe,
.remove = btqcomsmd_remove,
.callback = btqcomsmd_cmd_callback,
.smd_match_table = btqcomsmd_match,
.driver = {
.name = "btqcomsmd",
.owner = THIS_MODULE,
},
};
module_qcom_smd_driver(btqcomsmd_cmd_driver);
MODULE_DESCRIPTION("Qualcomm SMD HCI driver");
MODULE_LICENSE("GPL v2");
|
