Commit | Line | Data |
---|---|---|
99c926ce | 1 | // SPDX-License-Identifier: GPL-2.0-only |
a86974f7 | 2 | /* |
fb784f05 BZ |
3 | * Marvell Bluetooth driver: debugfs related functions |
4 | * | |
5 | * Copyright (C) 2009, Marvell International Ltd. | |
fb784f05 BZ |
6 | **/ |
7 | ||
8 | #include <linux/debugfs.h> | |
5a0e3ad6 | 9 | #include <linux/slab.h> |
fb784f05 BZ |
10 | |
11 | #include <net/bluetooth/bluetooth.h> | |
12 | #include <net/bluetooth/hci_core.h> | |
13 | ||
14 | #include "btmrvl_drv.h" | |
15 | ||
16 | struct btmrvl_debugfs_data { | |
b914a250 MH |
17 | struct dentry *config_dir; |
18 | struct dentry *status_dir; | |
fb784f05 BZ |
19 | }; |
20 | ||
fb784f05 | 21 | static ssize_t btmrvl_hscfgcmd_write(struct file *file, |
54239903 | 22 | const char __user *ubuf, size_t count, loff_t *ppos) |
fb784f05 | 23 | { |
54239903 | 24 | struct btmrvl_private *priv = file->private_data; |
54239903 | 25 | long result, ret; |
fb784f05 | 26 | |
c2e7f5de | 27 | ret = kstrtol_from_user(ubuf, count, 10, &result); |
26e7acf3 DM |
28 | if (ret) |
29 | return ret; | |
fb784f05 BZ |
30 | |
31 | priv->btmrvl_dev.hscfgcmd = result; | |
32 | ||
33 | if (priv->btmrvl_dev.hscfgcmd) { | |
34 | btmrvl_prepare_command(priv); | |
35 | wake_up_interruptible(&priv->main_thread.wait_q); | |
36 | } | |
37 | ||
38 | return count; | |
39 | } | |
40 | ||
54239903 MH |
41 | static ssize_t btmrvl_hscfgcmd_read(struct file *file, char __user *userbuf, |
42 | size_t count, loff_t *ppos) | |
fb784f05 | 43 | { |
54239903 | 44 | struct btmrvl_private *priv = file->private_data; |
fb784f05 | 45 | char buf[16]; |
54239903 | 46 | int ret; |
fb784f05 BZ |
47 | |
48 | ret = snprintf(buf, sizeof(buf) - 1, "%d\n", | |
54239903 | 49 | priv->btmrvl_dev.hscfgcmd); |
fb784f05 BZ |
50 | |
51 | return simple_read_from_buffer(userbuf, count, ppos, buf, ret); | |
52 | } | |
53 | ||
54 | static const struct file_operations btmrvl_hscfgcmd_fops = { | |
54239903 MH |
55 | .read = btmrvl_hscfgcmd_read, |
56 | .write = btmrvl_hscfgcmd_write, | |
234e3405 | 57 | .open = simple_open, |
6038f373 | 58 | .llseek = default_llseek, |
fb784f05 BZ |
59 | }; |
60 | ||
fb784f05 | 61 | static ssize_t btmrvl_pscmd_write(struct file *file, const char __user *ubuf, |
54239903 | 62 | size_t count, loff_t *ppos) |
fb784f05 | 63 | { |
54239903 | 64 | struct btmrvl_private *priv = file->private_data; |
54239903 | 65 | long result, ret; |
fb784f05 | 66 | |
c2e7f5de | 67 | ret = kstrtol_from_user(ubuf, count, 10, &result); |
26e7acf3 DM |
68 | if (ret) |
69 | return ret; | |
fb784f05 BZ |
70 | |
71 | priv->btmrvl_dev.pscmd = result; | |
72 | ||
73 | if (priv->btmrvl_dev.pscmd) { | |
74 | btmrvl_prepare_command(priv); | |
75 | wake_up_interruptible(&priv->main_thread.wait_q); | |
76 | } | |
77 | ||
78 | return count; | |
79 | ||
80 | } | |
81 | ||
54239903 MH |
82 | static ssize_t btmrvl_pscmd_read(struct file *file, char __user *userbuf, |
83 | size_t count, loff_t *ppos) | |
fb784f05 | 84 | { |
54239903 | 85 | struct btmrvl_private *priv = file->private_data; |
fb784f05 | 86 | char buf[16]; |
54239903 | 87 | int ret; |
fb784f05 BZ |
88 | |
89 | ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.pscmd); | |
90 | ||
91 | return simple_read_from_buffer(userbuf, count, ppos, buf, ret); | |
92 | } | |
93 | ||
94 | static const struct file_operations btmrvl_pscmd_fops = { | |
95 | .read = btmrvl_pscmd_read, | |
96 | .write = btmrvl_pscmd_write, | |
234e3405 | 97 | .open = simple_open, |
6038f373 | 98 | .llseek = default_llseek, |
fb784f05 BZ |
99 | }; |
100 | ||
fb784f05 | 101 | static ssize_t btmrvl_hscmd_write(struct file *file, const char __user *ubuf, |
54239903 | 102 | size_t count, loff_t *ppos) |
fb784f05 | 103 | { |
be60b940 | 104 | struct btmrvl_private *priv = file->private_data; |
54239903 | 105 | long result, ret; |
fb784f05 | 106 | |
c2e7f5de | 107 | ret = kstrtol_from_user(ubuf, count, 10, &result); |
26e7acf3 DM |
108 | if (ret) |
109 | return ret; | |
fb784f05 BZ |
110 | |
111 | priv->btmrvl_dev.hscmd = result; | |
112 | if (priv->btmrvl_dev.hscmd) { | |
113 | btmrvl_prepare_command(priv); | |
114 | wake_up_interruptible(&priv->main_thread.wait_q); | |
115 | } | |
116 | ||
117 | return count; | |
118 | } | |
119 | ||
54239903 MH |
120 | static ssize_t btmrvl_hscmd_read(struct file *file, char __user *userbuf, |
121 | size_t count, loff_t *ppos) | |
fb784f05 | 122 | { |
54239903 | 123 | struct btmrvl_private *priv = file->private_data; |
fb784f05 | 124 | char buf[16]; |
54239903 | 125 | int ret; |
fb784f05 BZ |
126 | |
127 | ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hscmd); | |
128 | ||
129 | return simple_read_from_buffer(userbuf, count, ppos, buf, ret); | |
130 | } | |
131 | ||
132 | static const struct file_operations btmrvl_hscmd_fops = { | |
54239903 MH |
133 | .read = btmrvl_hscmd_read, |
134 | .write = btmrvl_hscmd_write, | |
234e3405 | 135 | .open = simple_open, |
6038f373 | 136 | .llseek = default_llseek, |
fb784f05 BZ |
137 | }; |
138 | ||
fb784f05 BZ |
139 | void btmrvl_debugfs_init(struct hci_dev *hdev) |
140 | { | |
155961e8 | 141 | struct btmrvl_private *priv = hci_get_drvdata(hdev); |
fb784f05 BZ |
142 | struct btmrvl_debugfs_data *dbg; |
143 | ||
b914a250 MH |
144 | if (!hdev->debugfs) |
145 | return; | |
146 | ||
fb784f05 BZ |
147 | dbg = kzalloc(sizeof(*dbg), GFP_KERNEL); |
148 | priv->debugfs_data = dbg; | |
149 | ||
150 | if (!dbg) { | |
151 | BT_ERR("Can not allocate memory for btmrvl_debugfs_data."); | |
152 | return; | |
153 | } | |
154 | ||
b914a250 | 155 | dbg->config_dir = debugfs_create_dir("config", hdev->debugfs); |
fb784f05 | 156 | |
9da226c7 AS |
157 | debugfs_create_u8("psmode", 0644, dbg->config_dir, |
158 | &priv->btmrvl_dev.psmode); | |
159 | debugfs_create_file("pscmd", 0644, dbg->config_dir, | |
160 | priv, &btmrvl_pscmd_fops); | |
161 | debugfs_create_x16("gpiogap", 0644, dbg->config_dir, | |
162 | &priv->btmrvl_dev.gpio_gap); | |
163 | debugfs_create_u8("hsmode", 0644, dbg->config_dir, | |
164 | &priv->btmrvl_dev.hsmode); | |
165 | debugfs_create_file("hscmd", 0644, dbg->config_dir, | |
166 | priv, &btmrvl_hscmd_fops); | |
167 | debugfs_create_file("hscfgcmd", 0644, dbg->config_dir, | |
168 | priv, &btmrvl_hscfgcmd_fops); | |
fb784f05 | 169 | |
b914a250 | 170 | dbg->status_dir = debugfs_create_dir("status", hdev->debugfs); |
9da226c7 AS |
171 | debugfs_create_u8("curpsmode", 0444, dbg->status_dir, |
172 | &priv->adapter->psmode); | |
173 | debugfs_create_u8("psstate", 0444, dbg->status_dir, | |
174 | &priv->adapter->ps_state); | |
175 | debugfs_create_u8("hsstate", 0444, dbg->status_dir, | |
176 | &priv->adapter->hs_state); | |
177 | debugfs_create_u8("txdnldready", 0444, dbg->status_dir, | |
178 | &priv->btmrvl_dev.tx_dnld_rdy); | |
fb784f05 BZ |
179 | } |
180 | ||
181 | void btmrvl_debugfs_remove(struct hci_dev *hdev) | |
182 | { | |
155961e8 | 183 | struct btmrvl_private *priv = hci_get_drvdata(hdev); |
fb784f05 BZ |
184 | struct btmrvl_debugfs_data *dbg = priv->debugfs_data; |
185 | ||
186 | if (!dbg) | |
187 | return; | |
188 | ||
9da226c7 AS |
189 | debugfs_remove_recursive(dbg->config_dir); |
190 | debugfs_remove_recursive(dbg->status_dir); | |
fb784f05 | 191 | |
fb784f05 BZ |
192 | kfree(dbg); |
193 | } |