1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * dsp_pipeline.c: pipelined audio processing
5 * Copyright (C) 2007, Nadi Sarrar
7 * Nadi Sarrar <nadi@beronet.com>
10 #include <linux/kernel.h>
11 #include <linux/slab.h>
12 #include <linux/list.h>
13 #include <linux/string.h>
14 #include <linux/mISDNif.h>
15 #include <linux/mISDNdsp.h>
16 #include <linux/export.h>
20 /* uncomment for debugging */
21 /*#define PIPELINE_DEBUG*/
23 struct dsp_pipeline_entry {
24 struct mISDN_dsp_element *elem;
26 struct list_head list;
28 struct dsp_element_entry {
29 struct mISDN_dsp_element *elem;
31 struct list_head list;
34 static LIST_HEAD(dsp_elements);
37 static struct class *elements_class;
40 attr_show_args(struct device *dev, struct device_attribute *attr, char *buf)
42 struct mISDN_dsp_element *elem = dev_get_drvdata(dev);
47 for (i = 0; i < elem->num_args; i++)
48 p += sprintf(p, "Name: %s\n%s%s%sDescription: %s\n\n",
50 elem->args[i].def ? "Default: " : "",
51 elem->args[i].def ? elem->args[i].def : "",
52 elem->args[i].def ? "\n" : "",
58 static struct device_attribute element_attributes[] = {
59 __ATTR(args, 0444, attr_show_args, NULL),
63 mISDN_dsp_dev_release(struct device *dev)
65 struct dsp_element_entry *entry =
66 container_of(dev, struct dsp_element_entry, dev);
67 list_del(&entry->list);
71 int mISDN_dsp_element_register(struct mISDN_dsp_element *elem)
73 struct dsp_element_entry *entry;
79 entry = kzalloc(sizeof(struct dsp_element_entry), GFP_ATOMIC);
85 entry->dev.class = elements_class;
86 entry->dev.release = mISDN_dsp_dev_release;
87 dev_set_drvdata(&entry->dev, elem);
88 dev_set_name(&entry->dev, "%s", elem->name);
89 ret = device_register(&entry->dev);
91 printk(KERN_ERR "%s: failed to register %s\n",
92 __func__, elem->name);
95 list_add_tail(&entry->list, &dsp_elements);
97 for (i = 0; i < ARRAY_SIZE(element_attributes); ++i) {
98 ret = device_create_file(&entry->dev,
99 &element_attributes[i]);
101 printk(KERN_ERR "%s: failed to create device file\n",
107 #ifdef PIPELINE_DEBUG
108 printk(KERN_DEBUG "%s: %s registered\n", __func__, elem->name);
114 device_unregister(&entry->dev);
120 EXPORT_SYMBOL(mISDN_dsp_element_register);
122 void mISDN_dsp_element_unregister(struct mISDN_dsp_element *elem)
124 struct dsp_element_entry *entry, *n;
129 list_for_each_entry_safe(entry, n, &dsp_elements, list)
130 if (entry->elem == elem) {
131 device_unregister(&entry->dev);
132 #ifdef PIPELINE_DEBUG
133 printk(KERN_DEBUG "%s: %s unregistered\n",
134 __func__, elem->name);
138 printk(KERN_ERR "%s: element %s not in list.\n", __func__, elem->name);
140 EXPORT_SYMBOL(mISDN_dsp_element_unregister);
142 int dsp_pipeline_module_init(void)
144 elements_class = class_create(THIS_MODULE, "dsp_pipeline");
145 if (IS_ERR(elements_class))
146 return PTR_ERR(elements_class);
148 #ifdef PIPELINE_DEBUG
149 printk(KERN_DEBUG "%s: dsp pipeline module initialized\n", __func__);
157 void dsp_pipeline_module_exit(void)
159 struct dsp_element_entry *entry, *n;
163 class_destroy(elements_class);
165 list_for_each_entry_safe(entry, n, &dsp_elements, list) {
166 list_del(&entry->list);
167 printk(KERN_WARNING "%s: element was still registered: %s\n",
168 __func__, entry->elem->name);
172 #ifdef PIPELINE_DEBUG
173 printk(KERN_DEBUG "%s: dsp pipeline module exited\n", __func__);
177 int dsp_pipeline_init(struct dsp_pipeline *pipeline)
182 INIT_LIST_HEAD(&pipeline->list);
184 #ifdef PIPELINE_DEBUG
185 printk(KERN_DEBUG "%s: dsp pipeline ready\n", __func__);
191 static inline void _dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
193 struct dsp_pipeline_entry *entry, *n;
195 list_for_each_entry_safe(entry, n, &pipeline->list, list) {
196 list_del(&entry->list);
197 if (entry->elem == dsp_hwec)
198 dsp_hwec_disable(container_of(pipeline, struct dsp,
201 entry->elem->free(entry->p);
206 void dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
212 _dsp_pipeline_destroy(pipeline);
214 #ifdef PIPELINE_DEBUG
215 printk(KERN_DEBUG "%s: dsp pipeline destroyed\n", __func__);
219 int dsp_pipeline_build(struct dsp_pipeline *pipeline, const char *cfg)
221 int incomplete = 0, found = 0;
222 char *dup, *tok, *name, *args;
223 struct dsp_element_entry *entry, *n;
224 struct dsp_pipeline_entry *pipeline_entry;
225 struct mISDN_dsp_element *elem;
230 if (!list_empty(&pipeline->list))
231 _dsp_pipeline_destroy(pipeline);
233 dup = kstrdup(cfg, GFP_ATOMIC);
236 while ((tok = strsep(&dup, "|"))) {
239 name = strsep(&tok, "(");
240 args = strsep(&tok, ")");
244 list_for_each_entry_safe(entry, n, &dsp_elements, list)
245 if (!strcmp(entry->elem->name, name)) {
248 pipeline_entry = kmalloc(sizeof(struct
249 dsp_pipeline_entry), GFP_ATOMIC);
250 if (!pipeline_entry) {
251 printk(KERN_ERR "%s: failed to add "
252 "entry to pipeline: %s (out of "
253 "memory)\n", __func__, elem->name);
257 pipeline_entry->elem = elem;
259 if (elem == dsp_hwec) {
260 /* This is a hack to make the hwec
261 available as a pipeline module */
262 dsp_hwec_enable(container_of(pipeline,
263 struct dsp, pipeline), args);
264 list_add_tail(&pipeline_entry->list,
267 pipeline_entry->p = elem->new(args);
268 if (pipeline_entry->p) {
269 list_add_tail(&pipeline_entry->
270 list, &pipeline->list);
271 #ifdef PIPELINE_DEBUG
272 printk(KERN_DEBUG "%s: created "
273 "instance of %s%s%s\n",
274 __func__, name, args ?
275 " with args " : "", args ?
279 printk(KERN_ERR "%s: failed "
280 "to add entry to pipeline: "
281 "%s (new() returned NULL)\n",
282 __func__, elem->name);
283 kfree(pipeline_entry);
294 printk(KERN_ERR "%s: element not found, skipping: "
295 "%s\n", __func__, name);
301 if (!list_empty(&pipeline->list))
306 #ifdef PIPELINE_DEBUG
307 printk(KERN_DEBUG "%s: dsp pipeline built%s: %s\n",
308 __func__, incomplete ? " incomplete" : "", cfg);
314 void dsp_pipeline_process_tx(struct dsp_pipeline *pipeline, u8 *data, int len)
316 struct dsp_pipeline_entry *entry;
321 list_for_each_entry(entry, &pipeline->list, list)
322 if (entry->elem->process_tx)
323 entry->elem->process_tx(entry->p, data, len);
326 void dsp_pipeline_process_rx(struct dsp_pipeline *pipeline, u8 *data, int len,
329 struct dsp_pipeline_entry *entry;
334 list_for_each_entry_reverse(entry, &pipeline->list, list)
335 if (entry->elem->process_rx)
336 entry->elem->process_rx(entry->p, data, len, txlen);