2
* dsp_pipeline.c: pipelined audio processing
4
* Copyright (C) 2007, Nadi Sarrar
6
* Nadi Sarrar <nadi@beronet.com>
8
* This program is free software; you can redistribute it and/or modify it
9
* under the terms of the GNU General Public License as published by the Free
10
* Software Foundation; either version 2 of the License, or (at your option)
13
* This program is distributed in the hope that it will be useful, but WITHOUT
14
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
18
* You should have received a copy of the GNU General Public License along with
19
* this program; if not, write to the Free Software Foundation, Inc., 59
20
* Temple Place - Suite 330, Boston, MA 02111-1307, USA.
22
* The full GNU General Public License is included in this distribution in the
23
* file called LICENSE.
27
#include <linux/kernel.h>
28
#include <linux/slab.h>
29
#include <linux/list.h>
30
#include <linux/string.h>
31
#include <linux/mISDNif.h>
32
#include <linux/mISDNdsp.h>
33
#include <linux/export.h>
37
/* uncomment for debugging */
38
/*#define PIPELINE_DEBUG*/
40
struct dsp_pipeline_entry {
41
struct mISDN_dsp_element *elem;
43
struct list_head list;
45
struct dsp_element_entry {
46
struct mISDN_dsp_element *elem;
48
struct list_head list;
51
static LIST_HEAD(dsp_elements);
54
static struct class *elements_class;
57
attr_show_args(struct device *dev, struct device_attribute *attr, char *buf)
59
struct mISDN_dsp_element *elem = dev_get_drvdata(dev);
64
for (i = 0; i < elem->num_args; i++)
65
p += sprintf(p, "Name: %s\n%s%s%sDescription: %s\n\n",
67
elem->args[i].def ? "Default: " : "",
68
elem->args[i].def ? elem->args[i].def : "",
69
elem->args[i].def ? "\n" : "",
75
static struct device_attribute element_attributes[] = {
76
__ATTR(args, 0444, attr_show_args, NULL),
80
mISDN_dsp_dev_release(struct device *dev)
82
struct dsp_element_entry *entry =
83
container_of(dev, struct dsp_element_entry, dev);
84
list_del(&entry->list);
88
int mISDN_dsp_element_register(struct mISDN_dsp_element *elem)
90
struct dsp_element_entry *entry;
96
entry = kzalloc(sizeof(struct dsp_element_entry), GFP_ATOMIC);
102
entry->dev.class = elements_class;
103
entry->dev.release = mISDN_dsp_dev_release;
104
dev_set_drvdata(&entry->dev, elem);
105
dev_set_name(&entry->dev, "%s", elem->name);
106
ret = device_register(&entry->dev);
108
printk(KERN_ERR "%s: failed to register %s\n",
109
__func__, elem->name);
112
list_add_tail(&entry->list, &dsp_elements);
114
for (i = 0; i < ARRAY_SIZE(element_attributes); ++i) {
115
ret = device_create_file(&entry->dev,
116
&element_attributes[i]);
118
printk(KERN_ERR "%s: failed to create device file\n",
124
#ifdef PIPELINE_DEBUG
125
printk(KERN_DEBUG "%s: %s registered\n", __func__, elem->name);
131
device_unregister(&entry->dev);
137
EXPORT_SYMBOL(mISDN_dsp_element_register);
139
void mISDN_dsp_element_unregister(struct mISDN_dsp_element *elem)
141
struct dsp_element_entry *entry, *n;
146
list_for_each_entry_safe(entry, n, &dsp_elements, list)
147
if (entry->elem == elem) {
148
device_unregister(&entry->dev);
149
#ifdef PIPELINE_DEBUG
150
printk(KERN_DEBUG "%s: %s unregistered\n",
151
__func__, elem->name);
155
printk(KERN_ERR "%s: element %s not in list.\n", __func__, elem->name);
157
EXPORT_SYMBOL(mISDN_dsp_element_unregister);
159
int dsp_pipeline_module_init(void)
161
elements_class = class_create(THIS_MODULE, "dsp_pipeline");
162
if (IS_ERR(elements_class))
163
return PTR_ERR(elements_class);
165
#ifdef PIPELINE_DEBUG
166
printk(KERN_DEBUG "%s: dsp pipeline module initialized\n", __func__);
174
void dsp_pipeline_module_exit(void)
176
struct dsp_element_entry *entry, *n;
180
class_destroy(elements_class);
182
list_for_each_entry_safe(entry, n, &dsp_elements, list) {
183
list_del(&entry->list);
184
printk(KERN_WARNING "%s: element was still registered: %s\n",
185
__func__, entry->elem->name);
189
#ifdef PIPELINE_DEBUG
190
printk(KERN_DEBUG "%s: dsp pipeline module exited\n", __func__);
194
int dsp_pipeline_init(struct dsp_pipeline *pipeline)
199
INIT_LIST_HEAD(&pipeline->list);
201
#ifdef PIPELINE_DEBUG
202
printk(KERN_DEBUG "%s: dsp pipeline ready\n", __func__);
208
static inline void _dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
210
struct dsp_pipeline_entry *entry, *n;
212
list_for_each_entry_safe(entry, n, &pipeline->list, list) {
213
list_del(&entry->list);
214
if (entry->elem == dsp_hwec)
215
dsp_hwec_disable(container_of(pipeline, struct dsp,
218
entry->elem->free(entry->p);
223
void dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
229
_dsp_pipeline_destroy(pipeline);
231
#ifdef PIPELINE_DEBUG
232
printk(KERN_DEBUG "%s: dsp pipeline destroyed\n", __func__);
236
int dsp_pipeline_build(struct dsp_pipeline *pipeline, const char *cfg)
238
int len, incomplete = 0, found = 0;
239
char *dup, *tok, *name, *args;
240
struct dsp_element_entry *entry, *n;
241
struct dsp_pipeline_entry *pipeline_entry;
242
struct mISDN_dsp_element *elem;
247
if (!list_empty(&pipeline->list))
248
_dsp_pipeline_destroy(pipeline);
257
dup = kmalloc(len + 1, GFP_ATOMIC);
261
while ((tok = strsep(&dup, "|"))) {
264
name = strsep(&tok, "(");
265
args = strsep(&tok, ")");
269
list_for_each_entry_safe(entry, n, &dsp_elements, list)
270
if (!strcmp(entry->elem->name, name)) {
273
pipeline_entry = kmalloc(sizeof(struct
274
dsp_pipeline_entry), GFP_ATOMIC);
275
if (!pipeline_entry) {
276
printk(KERN_ERR "%s: failed to add "
277
"entry to pipeline: %s (out of "
278
"memory)\n", __func__, elem->name);
282
pipeline_entry->elem = elem;
284
if (elem == dsp_hwec) {
285
/* This is a hack to make the hwec
286
available as a pipeline module */
287
dsp_hwec_enable(container_of(pipeline,
288
struct dsp, pipeline), args);
289
list_add_tail(&pipeline_entry->list,
292
pipeline_entry->p = elem->new(args);
293
if (pipeline_entry->p) {
294
list_add_tail(&pipeline_entry->
295
list, &pipeline->list);
296
#ifdef PIPELINE_DEBUG
297
printk(KERN_DEBUG "%s: created "
298
"instance of %s%s%s\n",
299
__func__, name, args ?
300
" with args " : "", args ?
304
printk(KERN_ERR "%s: failed "
305
"to add entry to pipeline: "
306
"%s (new() returned NULL)\n",
307
__func__, elem->name);
308
kfree(pipeline_entry);
319
printk(KERN_ERR "%s: element not found, skipping: "
320
"%s\n", __func__, name);
326
if (!list_empty(&pipeline->list))
331
#ifdef PIPELINE_DEBUG
332
printk(KERN_DEBUG "%s: dsp pipeline built%s: %s\n",
333
__func__, incomplete ? " incomplete" : "", cfg);
339
void dsp_pipeline_process_tx(struct dsp_pipeline *pipeline, u8 *data, int len)
341
struct dsp_pipeline_entry *entry;
346
list_for_each_entry(entry, &pipeline->list, list)
347
if (entry->elem->process_tx)
348
entry->elem->process_tx(entry->p, data, len);
351
void dsp_pipeline_process_rx(struct dsp_pipeline *pipeline, u8 *data, int len,
354
struct dsp_pipeline_entry *entry;
359
list_for_each_entry_reverse(entry, &pipeline->list, list)
360
if (entry->elem->process_rx)
361
entry->elem->process_rx(entry->p, data, len, txlen);