Commit | Line | Data |
---|---|---|
7f8f209f SK |
1 | /* |
2 | * Qualcomm Technologies HIDMA Management SYS interface | |
3 | * | |
4 | * Copyright (c) 2015, The Linux Foundation. All rights reserved. | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 and | |
8 | * only version 2 as published by the Free Software Foundation. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | */ | |
15 | ||
16 | #include <linux/sysfs.h> | |
17 | #include <linux/platform_device.h> | |
18 | ||
19 | #include "hidma_mgmt.h" | |
20 | ||
21 | struct hidma_chan_attr { | |
22 | struct hidma_mgmt_dev *mdev; | |
23 | int index; | |
24 | struct kobj_attribute attr; | |
25 | }; | |
26 | ||
27 | struct hidma_mgmt_fileinfo { | |
28 | char *name; | |
29 | int mode; | |
30 | int (*get)(struct hidma_mgmt_dev *mdev); | |
31 | int (*set)(struct hidma_mgmt_dev *mdev, u64 val); | |
32 | }; | |
33 | ||
34 | #define IMPLEMENT_GETSET(name) \ | |
35 | static int get_##name(struct hidma_mgmt_dev *mdev) \ | |
36 | { \ | |
37 | return mdev->name; \ | |
38 | } \ | |
39 | static int set_##name(struct hidma_mgmt_dev *mdev, u64 val) \ | |
40 | { \ | |
41 | u64 tmp; \ | |
42 | int rc; \ | |
43 | \ | |
44 | tmp = mdev->name; \ | |
45 | mdev->name = val; \ | |
46 | rc = hidma_mgmt_setup(mdev); \ | |
47 | if (rc) \ | |
48 | mdev->name = tmp; \ | |
49 | return rc; \ | |
50 | } | |
51 | ||
52 | #define DECLARE_ATTRIBUTE(name, mode) \ | |
53 | {#name, mode, get_##name, set_##name} | |
54 | ||
55 | IMPLEMENT_GETSET(hw_version_major) | |
56 | IMPLEMENT_GETSET(hw_version_minor) | |
57 | IMPLEMENT_GETSET(max_wr_xactions) | |
58 | IMPLEMENT_GETSET(max_rd_xactions) | |
59 | IMPLEMENT_GETSET(max_write_request) | |
60 | IMPLEMENT_GETSET(max_read_request) | |
61 | IMPLEMENT_GETSET(dma_channels) | |
62 | IMPLEMENT_GETSET(chreset_timeout_cycles) | |
63 | ||
64 | static int set_priority(struct hidma_mgmt_dev *mdev, unsigned int i, u64 val) | |
65 | { | |
66 | u64 tmp; | |
67 | int rc; | |
68 | ||
69 | if (i >= mdev->dma_channels) | |
70 | return -EINVAL; | |
71 | ||
72 | tmp = mdev->priority[i]; | |
73 | mdev->priority[i] = val; | |
74 | rc = hidma_mgmt_setup(mdev); | |
75 | if (rc) | |
76 | mdev->priority[i] = tmp; | |
77 | return rc; | |
78 | } | |
79 | ||
80 | static int set_weight(struct hidma_mgmt_dev *mdev, unsigned int i, u64 val) | |
81 | { | |
82 | u64 tmp; | |
83 | int rc; | |
84 | ||
85 | if (i >= mdev->dma_channels) | |
86 | return -EINVAL; | |
87 | ||
88 | tmp = mdev->weight[i]; | |
89 | mdev->weight[i] = val; | |
90 | rc = hidma_mgmt_setup(mdev); | |
91 | if (rc) | |
92 | mdev->weight[i] = tmp; | |
93 | return rc; | |
94 | } | |
95 | ||
96 | static struct hidma_mgmt_fileinfo hidma_mgmt_files[] = { | |
97 | DECLARE_ATTRIBUTE(hw_version_major, S_IRUGO), | |
98 | DECLARE_ATTRIBUTE(hw_version_minor, S_IRUGO), | |
99 | DECLARE_ATTRIBUTE(dma_channels, S_IRUGO), | |
100 | DECLARE_ATTRIBUTE(chreset_timeout_cycles, S_IRUGO), | |
101 | DECLARE_ATTRIBUTE(max_wr_xactions, S_IRUGO), | |
102 | DECLARE_ATTRIBUTE(max_rd_xactions, S_IRUGO), | |
103 | DECLARE_ATTRIBUTE(max_write_request, S_IRUGO), | |
104 | DECLARE_ATTRIBUTE(max_read_request, S_IRUGO), | |
105 | }; | |
106 | ||
107 | static ssize_t show_values(struct device *dev, struct device_attribute *attr, | |
108 | char *buf) | |
109 | { | |
110 | struct platform_device *pdev = to_platform_device(dev); | |
111 | struct hidma_mgmt_dev *mdev = platform_get_drvdata(pdev); | |
112 | unsigned int i; | |
113 | ||
114 | buf[0] = 0; | |
115 | ||
116 | for (i = 0; i < ARRAY_SIZE(hidma_mgmt_files); i++) { | |
117 | if (strcmp(attr->attr.name, hidma_mgmt_files[i].name) == 0) { | |
118 | sprintf(buf, "%d\n", hidma_mgmt_files[i].get(mdev)); | |
119 | break; | |
120 | } | |
121 | } | |
122 | return strlen(buf); | |
123 | } | |
124 | ||
125 | static ssize_t set_values(struct device *dev, struct device_attribute *attr, | |
126 | const char *buf, size_t count) | |
127 | { | |
128 | struct platform_device *pdev = to_platform_device(dev); | |
129 | struct hidma_mgmt_dev *mdev = platform_get_drvdata(pdev); | |
130 | unsigned long tmp; | |
131 | unsigned int i; | |
132 | int rc; | |
133 | ||
134 | rc = kstrtoul(buf, 0, &tmp); | |
135 | if (rc) | |
136 | return rc; | |
137 | ||
138 | for (i = 0; i < ARRAY_SIZE(hidma_mgmt_files); i++) { | |
139 | if (strcmp(attr->attr.name, hidma_mgmt_files[i].name) == 0) { | |
140 | rc = hidma_mgmt_files[i].set(mdev, tmp); | |
141 | if (rc) | |
142 | return rc; | |
143 | ||
144 | break; | |
145 | } | |
146 | } | |
147 | return count; | |
148 | } | |
149 | ||
150 | static ssize_t show_values_channel(struct kobject *kobj, | |
151 | struct kobj_attribute *attr, char *buf) | |
152 | { | |
153 | struct hidma_chan_attr *chattr; | |
154 | struct hidma_mgmt_dev *mdev; | |
155 | ||
156 | buf[0] = 0; | |
157 | chattr = container_of(attr, struct hidma_chan_attr, attr); | |
158 | mdev = chattr->mdev; | |
159 | if (strcmp(attr->attr.name, "priority") == 0) | |
160 | sprintf(buf, "%d\n", mdev->priority[chattr->index]); | |
161 | else if (strcmp(attr->attr.name, "weight") == 0) | |
162 | sprintf(buf, "%d\n", mdev->weight[chattr->index]); | |
163 | ||
164 | return strlen(buf); | |
165 | } | |
166 | ||
167 | static ssize_t set_values_channel(struct kobject *kobj, | |
168 | struct kobj_attribute *attr, const char *buf, | |
169 | size_t count) | |
170 | { | |
171 | struct hidma_chan_attr *chattr; | |
172 | struct hidma_mgmt_dev *mdev; | |
173 | unsigned long tmp; | |
174 | int rc; | |
175 | ||
176 | chattr = container_of(attr, struct hidma_chan_attr, attr); | |
177 | mdev = chattr->mdev; | |
178 | ||
179 | rc = kstrtoul(buf, 0, &tmp); | |
180 | if (rc) | |
181 | return rc; | |
182 | ||
183 | if (strcmp(attr->attr.name, "priority") == 0) { | |
184 | rc = set_priority(mdev, chattr->index, tmp); | |
185 | if (rc) | |
186 | return rc; | |
187 | } else if (strcmp(attr->attr.name, "weight") == 0) { | |
188 | rc = set_weight(mdev, chattr->index, tmp); | |
189 | if (rc) | |
190 | return rc; | |
191 | } | |
192 | return count; | |
193 | } | |
194 | ||
195 | static int create_sysfs_entry(struct hidma_mgmt_dev *dev, char *name, int mode) | |
196 | { | |
197 | struct device_attribute *attrs; | |
198 | char *name_copy; | |
199 | ||
200 | attrs = devm_kmalloc(&dev->pdev->dev, | |
201 | sizeof(struct device_attribute), GFP_KERNEL); | |
202 | if (!attrs) | |
203 | return -ENOMEM; | |
204 | ||
205 | name_copy = devm_kstrdup(&dev->pdev->dev, name, GFP_KERNEL); | |
206 | if (!name_copy) | |
207 | return -ENOMEM; | |
208 | ||
209 | attrs->attr.name = name_copy; | |
210 | attrs->attr.mode = mode; | |
211 | attrs->show = show_values; | |
212 | attrs->store = set_values; | |
213 | sysfs_attr_init(&attrs->attr); | |
214 | ||
215 | return device_create_file(&dev->pdev->dev, attrs); | |
216 | } | |
217 | ||
218 | static int create_sysfs_entry_channel(struct hidma_mgmt_dev *mdev, char *name, | |
219 | int mode, int index, | |
220 | struct kobject *parent) | |
221 | { | |
222 | struct hidma_chan_attr *chattr; | |
223 | char *name_copy; | |
224 | ||
225 | chattr = devm_kmalloc(&mdev->pdev->dev, sizeof(*chattr), GFP_KERNEL); | |
226 | if (!chattr) | |
227 | return -ENOMEM; | |
228 | ||
229 | name_copy = devm_kstrdup(&mdev->pdev->dev, name, GFP_KERNEL); | |
230 | if (!name_copy) | |
231 | return -ENOMEM; | |
232 | ||
233 | chattr->mdev = mdev; | |
234 | chattr->index = index; | |
235 | chattr->attr.attr.name = name_copy; | |
236 | chattr->attr.attr.mode = mode; | |
237 | chattr->attr.show = show_values_channel; | |
238 | chattr->attr.store = set_values_channel; | |
239 | sysfs_attr_init(&chattr->attr.attr); | |
240 | ||
241 | return sysfs_create_file(parent, &chattr->attr.attr); | |
242 | } | |
243 | ||
244 | int hidma_mgmt_init_sys(struct hidma_mgmt_dev *mdev) | |
245 | { | |
246 | unsigned int i; | |
247 | int rc; | |
248 | int required; | |
249 | struct kobject *chanops; | |
250 | ||
251 | required = sizeof(*mdev->chroots) * mdev->dma_channels; | |
252 | mdev->chroots = devm_kmalloc(&mdev->pdev->dev, required, GFP_KERNEL); | |
253 | if (!mdev->chroots) | |
254 | return -ENOMEM; | |
255 | ||
256 | chanops = kobject_create_and_add("chanops", &mdev->pdev->dev.kobj); | |
257 | if (!chanops) | |
258 | return -ENOMEM; | |
259 | ||
260 | /* create each channel directory here */ | |
261 | for (i = 0; i < mdev->dma_channels; i++) { | |
262 | char name[20]; | |
263 | ||
264 | snprintf(name, sizeof(name), "chan%d", i); | |
265 | mdev->chroots[i] = kobject_create_and_add(name, chanops); | |
266 | if (!mdev->chroots[i]) | |
267 | return -ENOMEM; | |
268 | } | |
269 | ||
270 | /* populate common parameters */ | |
271 | for (i = 0; i < ARRAY_SIZE(hidma_mgmt_files); i++) { | |
272 | rc = create_sysfs_entry(mdev, hidma_mgmt_files[i].name, | |
273 | hidma_mgmt_files[i].mode); | |
274 | if (rc) | |
275 | return rc; | |
276 | } | |
277 | ||
278 | /* populate parameters that are per channel */ | |
279 | for (i = 0; i < mdev->dma_channels; i++) { | |
280 | rc = create_sysfs_entry_channel(mdev, "priority", | |
281 | (S_IRUGO | S_IWUGO), i, | |
282 | mdev->chroots[i]); | |
283 | if (rc) | |
284 | return rc; | |
285 | ||
286 | rc = create_sysfs_entry_channel(mdev, "weight", | |
287 | (S_IRUGO | S_IWUGO), i, | |
288 | mdev->chroots[i]); | |
289 | if (rc) | |
290 | return rc; | |
291 | } | |
292 | ||
293 | return 0; | |
294 | } | |
295 | EXPORT_SYMBOL_GPL(hidma_mgmt_init_sys); |