1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/debugfs.h>
22#include <linux/slab.h>
23
24#include <net/bluetooth/bluetooth.h>
25#include <net/bluetooth/hci_core.h>
26
27#include "btmrvl_drv.h"
28
29struct btmrvl_debugfs_data {
30 struct dentry *config_dir;
31 struct dentry *status_dir;
32
33
34 struct dentry *psmode;
35 struct dentry *pscmd;
36 struct dentry *hsmode;
37 struct dentry *hscmd;
38 struct dentry *gpiogap;
39 struct dentry *hscfgcmd;
40
41
42 struct dentry *curpsmode;
43 struct dentry *hsstate;
44 struct dentry *psstate;
45 struct dentry *txdnldready;
46};
47
48static int btmrvl_open_generic(struct inode *inode, struct file *file)
49{
50 file->private_data = inode->i_private;
51 return 0;
52}
53
54static ssize_t btmrvl_hscfgcmd_write(struct file *file,
55 const char __user *ubuf, size_t count, loff_t *ppos)
56{
57 struct btmrvl_private *priv = file->private_data;
58 char buf[16];
59 long result, ret;
60
61 memset(buf, 0, sizeof(buf));
62
63 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
64 return -EFAULT;
65
66 ret = strict_strtol(buf, 10, &result);
67
68 priv->btmrvl_dev.hscfgcmd = result;
69
70 if (priv->btmrvl_dev.hscfgcmd) {
71 btmrvl_prepare_command(priv);
72 wake_up_interruptible(&priv->main_thread.wait_q);
73 }
74
75 return count;
76}
77
78static ssize_t btmrvl_hscfgcmd_read(struct file *file, char __user *userbuf,
79 size_t count, loff_t *ppos)
80{
81 struct btmrvl_private *priv = file->private_data;
82 char buf[16];
83 int ret;
84
85 ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
86 priv->btmrvl_dev.hscfgcmd);
87
88 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
89}
90
91static const struct file_operations btmrvl_hscfgcmd_fops = {
92 .read = btmrvl_hscfgcmd_read,
93 .write = btmrvl_hscfgcmd_write,
94 .open = btmrvl_open_generic,
95 .llseek = default_llseek,
96};
97
98static ssize_t btmrvl_psmode_write(struct file *file, const char __user *ubuf,
99 size_t count, loff_t *ppos)
100{
101 struct btmrvl_private *priv = file->private_data;
102 char buf[16];
103 long result, ret;
104
105 memset(buf, 0, sizeof(buf));
106
107 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
108 return -EFAULT;
109
110 ret = strict_strtol(buf, 10, &result);
111
112 priv->btmrvl_dev.psmode = result;
113
114 return count;
115}
116
117static ssize_t btmrvl_psmode_read(struct file *file, char __user *userbuf,
118 size_t count, loff_t *ppos)
119{
120 struct btmrvl_private *priv = file->private_data;
121 char buf[16];
122 int ret;
123
124 ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
125 priv->btmrvl_dev.psmode);
126
127 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
128}
129
130static const struct file_operations btmrvl_psmode_fops = {
131 .read = btmrvl_psmode_read,
132 .write = btmrvl_psmode_write,
133 .open = btmrvl_open_generic,
134 .llseek = default_llseek,
135};
136
137static ssize_t btmrvl_pscmd_write(struct file *file, const char __user *ubuf,
138 size_t count, loff_t *ppos)
139{
140 struct btmrvl_private *priv = file->private_data;
141 char buf[16];
142 long result, ret;
143
144 memset(buf, 0, sizeof(buf));
145
146 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
147 return -EFAULT;
148
149 ret = strict_strtol(buf, 10, &result);
150
151 priv->btmrvl_dev.pscmd = result;
152
153 if (priv->btmrvl_dev.pscmd) {
154 btmrvl_prepare_command(priv);
155 wake_up_interruptible(&priv->main_thread.wait_q);
156 }
157
158 return count;
159
160}
161
162static ssize_t btmrvl_pscmd_read(struct file *file, char __user *userbuf,
163 size_t count, loff_t *ppos)
164{
165 struct btmrvl_private *priv = file->private_data;
166 char buf[16];
167 int ret;
168
169 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.pscmd);
170
171 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
172}
173
174static const struct file_operations btmrvl_pscmd_fops = {
175 .read = btmrvl_pscmd_read,
176 .write = btmrvl_pscmd_write,
177 .open = btmrvl_open_generic,
178 .llseek = default_llseek,
179};
180
181static ssize_t btmrvl_gpiogap_write(struct file *file, const char __user *ubuf,
182 size_t count, loff_t *ppos)
183{
184 struct btmrvl_private *priv = file->private_data;
185 char buf[16];
186 long result, ret;
187
188 memset(buf, 0, sizeof(buf));
189
190 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
191 return -EFAULT;
192
193 ret = strict_strtol(buf, 16, &result);
194
195 priv->btmrvl_dev.gpio_gap = result;
196
197 return count;
198}
199
200static ssize_t btmrvl_gpiogap_read(struct file *file, char __user *userbuf,
201 size_t count, loff_t *ppos)
202{
203 struct btmrvl_private *priv = file->private_data;
204 char buf[16];
205 int ret;
206
207 ret = snprintf(buf, sizeof(buf) - 1, "0x%x\n",
208 priv->btmrvl_dev.gpio_gap);
209
210 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
211}
212
213static const struct file_operations btmrvl_gpiogap_fops = {
214 .read = btmrvl_gpiogap_read,
215 .write = btmrvl_gpiogap_write,
216 .open = btmrvl_open_generic,
217 .llseek = default_llseek,
218};
219
220static ssize_t btmrvl_hscmd_write(struct file *file, const char __user *ubuf,
221 size_t count, loff_t *ppos)
222{
223 struct btmrvl_private *priv = file->private_data;
224 char buf[16];
225 long result, ret;
226
227 memset(buf, 0, sizeof(buf));
228
229 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
230 return -EFAULT;
231
232 ret = strict_strtol(buf, 10, &result);
233
234 priv->btmrvl_dev.hscmd = result;
235 if (priv->btmrvl_dev.hscmd) {
236 btmrvl_prepare_command(priv);
237 wake_up_interruptible(&priv->main_thread.wait_q);
238 }
239
240 return count;
241}
242
243static ssize_t btmrvl_hscmd_read(struct file *file, char __user *userbuf,
244 size_t count, loff_t *ppos)
245{
246 struct btmrvl_private *priv = file->private_data;
247 char buf[16];
248 int ret;
249
250 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hscmd);
251
252 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
253}
254
255static const struct file_operations btmrvl_hscmd_fops = {
256 .read = btmrvl_hscmd_read,
257 .write = btmrvl_hscmd_write,
258 .open = btmrvl_open_generic,
259 .llseek = default_llseek,
260};
261
262static ssize_t btmrvl_hsmode_write(struct file *file, const char __user *ubuf,
263 size_t count, loff_t *ppos)
264{
265 struct btmrvl_private *priv = file->private_data;
266 char buf[16];
267 long result, ret;
268
269 memset(buf, 0, sizeof(buf));
270
271 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
272 return -EFAULT;
273
274 ret = strict_strtol(buf, 10, &result);
275
276 priv->btmrvl_dev.hsmode = result;
277
278 return count;
279}
280
281static ssize_t btmrvl_hsmode_read(struct file *file, char __user * userbuf,
282 size_t count, loff_t *ppos)
283{
284 struct btmrvl_private *priv = file->private_data;
285 char buf[16];
286 int ret;
287
288 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hsmode);
289
290 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
291}
292
293static const struct file_operations btmrvl_hsmode_fops = {
294 .read = btmrvl_hsmode_read,
295 .write = btmrvl_hsmode_write,
296 .open = btmrvl_open_generic,
297 .llseek = default_llseek,
298};
299
300static ssize_t btmrvl_curpsmode_read(struct file *file, char __user *userbuf,
301 size_t count, loff_t *ppos)
302{
303 struct btmrvl_private *priv = file->private_data;
304 char buf[16];
305 int ret;
306
307 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->psmode);
308
309 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
310}
311
312static const struct file_operations btmrvl_curpsmode_fops = {
313 .read = btmrvl_curpsmode_read,
314 .open = btmrvl_open_generic,
315 .llseek = default_llseek,
316};
317
318static ssize_t btmrvl_psstate_read(struct file *file, char __user * userbuf,
319 size_t count, loff_t *ppos)
320{
321 struct btmrvl_private *priv = file->private_data;
322 char buf[16];
323 int ret;
324
325 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->ps_state);
326
327 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
328}
329
330static const struct file_operations btmrvl_psstate_fops = {
331 .read = btmrvl_psstate_read,
332 .open = btmrvl_open_generic,
333 .llseek = default_llseek,
334};
335
336static ssize_t btmrvl_hsstate_read(struct file *file, char __user *userbuf,
337 size_t count, loff_t *ppos)
338{
339 struct btmrvl_private *priv = file->private_data;
340 char buf[16];
341 int ret;
342
343 ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->hs_state);
344
345 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
346}
347
348static const struct file_operations btmrvl_hsstate_fops = {
349 .read = btmrvl_hsstate_read,
350 .open = btmrvl_open_generic,
351 .llseek = default_llseek,
352};
353
354static ssize_t btmrvl_txdnldready_read(struct file *file, char __user *userbuf,
355 size_t count, loff_t *ppos)
356{
357 struct btmrvl_private *priv = file->private_data;
358 char buf[16];
359 int ret;
360
361 ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
362 priv->btmrvl_dev.tx_dnld_rdy);
363
364 return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
365}
366
367static const struct file_operations btmrvl_txdnldready_fops = {
368 .read = btmrvl_txdnldready_read,
369 .open = btmrvl_open_generic,
370 .llseek = default_llseek,
371};
372
373void btmrvl_debugfs_init(struct hci_dev *hdev)
374{
375 struct btmrvl_private *priv = hdev->driver_data;
376 struct btmrvl_debugfs_data *dbg;
377
378 if (!hdev->debugfs)
379 return;
380
381 dbg = kzalloc(sizeof(*dbg), GFP_KERNEL);
382 priv->debugfs_data = dbg;
383
384 if (!dbg) {
385 BT_ERR("Can not allocate memory for btmrvl_debugfs_data.");
386 return;
387 }
388
389 dbg->config_dir = debugfs_create_dir("config", hdev->debugfs);
390
391 dbg->psmode = debugfs_create_file("psmode", 0644, dbg->config_dir,
392 hdev->driver_data, &btmrvl_psmode_fops);
393 dbg->pscmd = debugfs_create_file("pscmd", 0644, dbg->config_dir,
394 hdev->driver_data, &btmrvl_pscmd_fops);
395 dbg->gpiogap = debugfs_create_file("gpiogap", 0644, dbg->config_dir,
396 hdev->driver_data, &btmrvl_gpiogap_fops);
397 dbg->hsmode = debugfs_create_file("hsmode", 0644, dbg->config_dir,
398 hdev->driver_data, &btmrvl_hsmode_fops);
399 dbg->hscmd = debugfs_create_file("hscmd", 0644, dbg->config_dir,
400 hdev->driver_data, &btmrvl_hscmd_fops);
401 dbg->hscfgcmd = debugfs_create_file("hscfgcmd", 0644, dbg->config_dir,
402 hdev->driver_data, &btmrvl_hscfgcmd_fops);
403
404 dbg->status_dir = debugfs_create_dir("status", hdev->debugfs);
405 dbg->curpsmode = debugfs_create_file("curpsmode", 0444,
406 dbg->status_dir,
407 hdev->driver_data,
408 &btmrvl_curpsmode_fops);
409 dbg->psstate = debugfs_create_file("psstate", 0444, dbg->status_dir,
410 hdev->driver_data, &btmrvl_psstate_fops);
411 dbg->hsstate = debugfs_create_file("hsstate", 0444, dbg->status_dir,
412 hdev->driver_data, &btmrvl_hsstate_fops);
413 dbg->txdnldready = debugfs_create_file("txdnldready", 0444,
414 dbg->status_dir,
415 hdev->driver_data,
416 &btmrvl_txdnldready_fops);
417}
418
419void btmrvl_debugfs_remove(struct hci_dev *hdev)
420{
421 struct btmrvl_private *priv = hdev->driver_data;
422 struct btmrvl_debugfs_data *dbg = priv->debugfs_data;
423
424 if (!dbg)
425 return;
426
427 debugfs_remove(dbg->psmode);
428 debugfs_remove(dbg->pscmd);
429 debugfs_remove(dbg->gpiogap);
430 debugfs_remove(dbg->hsmode);
431 debugfs_remove(dbg->hscmd);
432 debugfs_remove(dbg->hscfgcmd);
433 debugfs_remove(dbg->config_dir);
434
435 debugfs_remove(dbg->curpsmode);
436 debugfs_remove(dbg->psstate);
437 debugfs_remove(dbg->hsstate);
438 debugfs_remove(dbg->txdnldready);
439 debugfs_remove(dbg->status_dir);
440
441 kfree(dbg);
442}
443