dsp_pipeline.c 8.33 KB
Newer Older
Karsten Keil's avatar
Karsten Keil committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
/*
 * dsp_pipeline.c: pipelined audio processing
 *
 * Copyright (C) 2007, Nadi Sarrar
 *
 * Nadi Sarrar <nadi@beronet.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; either version 2 of the License, or (at your option)
 * any later version.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc., 59
 * Temple Place - Suite 330, Boston, MA  02111-1307, USA.
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 */

#include <linux/kernel.h>
28
#include <linux/slab.h>
Karsten Keil's avatar
Karsten Keil committed
29 30 31 32
#include <linux/list.h>
#include <linux/string.h>
#include <linux/mISDNif.h>
#include <linux/mISDNdsp.h>
33
#include <linux/export.h>
Karsten Keil's avatar
Karsten Keil committed
34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#include "dsp.h"
#include "dsp_hwec.h"

/* uncomment for debugging */
/*#define PIPELINE_DEBUG*/

struct dsp_pipeline_entry {
	struct mISDN_dsp_element *elem;
	void                *p;
	struct list_head     list;
};
struct dsp_element_entry {
	struct mISDN_dsp_element *elem;
	struct device	     dev;
	struct list_head     list;
};

static LIST_HEAD(dsp_elements);

/* sysfs */
static struct class *elements_class;

static ssize_t
attr_show_args(struct device *dev, struct device_attribute *attr, char *buf)
{
	struct mISDN_dsp_element *elem = dev_get_drvdata(dev);
60 61
	int i;
	char *p = buf;
Karsten Keil's avatar
Karsten Keil committed
62 63

	*buf = 0;
64 65
	for (i = 0; i < elem->num_args; i++)
		p += sprintf(p, "Name:        %s\n%s%s%sDescription: %s\n\n",
66 67 68 69 70
			     elem->args[i].name,
			     elem->args[i].def ? "Default:     " : "",
			     elem->args[i].def ? elem->args[i].def : "",
			     elem->args[i].def ? "\n" : "",
			     elem->args[i].desc);
Karsten Keil's avatar
Karsten Keil committed
71

72
	return p - buf;
Karsten Keil's avatar
Karsten Keil committed
73 74 75 76 77 78
}

static struct device_attribute element_attributes[] = {
	__ATTR(args, 0444, attr_show_args, NULL),
};

79 80 81 82 83 84 85 86 87
static void
mISDN_dsp_dev_release(struct device *dev)
{
	struct dsp_element_entry *entry =
		container_of(dev, struct dsp_element_entry, dev);
	list_del(&entry->list);
	kfree(entry);
}

Karsten Keil's avatar
Karsten Keil committed
88 89 90 91 92 93 94 95
int mISDN_dsp_element_register(struct mISDN_dsp_element *elem)
{
	struct dsp_element_entry *entry;
	int ret, i;

	if (!elem)
		return -EINVAL;

Andreas Eversberg's avatar
Andreas Eversberg committed
96
	entry = kzalloc(sizeof(struct dsp_element_entry), GFP_ATOMIC);
Karsten Keil's avatar
Karsten Keil committed
97 98 99 100 101 102
	if (!entry)
		return -ENOMEM;

	entry->elem = elem;

	entry->dev.class = elements_class;
103
	entry->dev.release = mISDN_dsp_dev_release;
Karsten Keil's avatar
Karsten Keil committed
104
	dev_set_drvdata(&entry->dev, elem);
105
	dev_set_name(&entry->dev, "%s", elem->name);
Karsten Keil's avatar
Karsten Keil committed
106 107 108
	ret = device_register(&entry->dev);
	if (ret) {
		printk(KERN_ERR "%s: failed to register %s\n",
109
		       __func__, elem->name);
Karsten Keil's avatar
Karsten Keil committed
110 111
		goto err1;
	}
112
	list_add_tail(&entry->list, &dsp_elements);
Karsten Keil's avatar
Karsten Keil committed
113

114
	for (i = 0; i < ARRAY_SIZE(element_attributes); ++i) {
Karsten Keil's avatar
Karsten Keil committed
115
		ret = device_create_file(&entry->dev,
116
					 &element_attributes[i]);
Karsten Keil's avatar
Karsten Keil committed
117 118
		if (ret) {
			printk(KERN_ERR "%s: failed to create device file\n",
119
			       __func__);
Karsten Keil's avatar
Karsten Keil committed
120 121
			goto err2;
		}
122
	}
Karsten Keil's avatar
Karsten Keil committed
123

124
#ifdef PIPELINE_DEBUG
Karsten Keil's avatar
Karsten Keil committed
125
	printk(KERN_DEBUG "%s: %s registered\n", __func__, elem->name);
126
#endif
Karsten Keil's avatar
Karsten Keil committed
127 128 129 130 131

	return 0;

err2:
	device_unregister(&entry->dev);
132
	return ret;
Karsten Keil's avatar
Karsten Keil committed
133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148
err1:
	kfree(entry);
	return ret;
}
EXPORT_SYMBOL(mISDN_dsp_element_register);

void mISDN_dsp_element_unregister(struct mISDN_dsp_element *elem)
{
	struct dsp_element_entry *entry, *n;

	if (!elem)
		return;

	list_for_each_entry_safe(entry, n, &dsp_elements, list)
		if (entry->elem == elem) {
			device_unregister(&entry->dev);
149
#ifdef PIPELINE_DEBUG
Karsten Keil's avatar
Karsten Keil committed
150
			printk(KERN_DEBUG "%s: %s unregistered\n",
151
			       __func__, elem->name);
152
#endif
Karsten Keil's avatar
Karsten Keil committed
153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
			return;
		}
	printk(KERN_ERR "%s: element %s not in list.\n", __func__, elem->name);
}
EXPORT_SYMBOL(mISDN_dsp_element_unregister);

int dsp_pipeline_module_init(void)
{
	elements_class = class_create(THIS_MODULE, "dsp_pipeline");
	if (IS_ERR(elements_class))
		return PTR_ERR(elements_class);

#ifdef PIPELINE_DEBUG
	printk(KERN_DEBUG "%s: dsp pipeline module initialized\n", __func__);
#endif

	dsp_hwec_init();

	return 0;
}

void dsp_pipeline_module_exit(void)
{
	struct dsp_element_entry *entry, *n;

	dsp_hwec_exit();

	class_destroy(elements_class);

	list_for_each_entry_safe(entry, n, &dsp_elements, list) {
		list_del(&entry->list);
		printk(KERN_WARNING "%s: element was still registered: %s\n",
185
		       __func__, entry->elem->name);
Karsten Keil's avatar
Karsten Keil committed
186 187 188
		kfree(entry);
	}

189
#ifdef PIPELINE_DEBUG
Karsten Keil's avatar
Karsten Keil committed
190
	printk(KERN_DEBUG "%s: dsp pipeline module exited\n", __func__);
191
#endif
Karsten Keil's avatar
Karsten Keil committed
192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215
}

int dsp_pipeline_init(struct dsp_pipeline *pipeline)
{
	if (!pipeline)
		return -EINVAL;

	INIT_LIST_HEAD(&pipeline->list);

#ifdef PIPELINE_DEBUG
	printk(KERN_DEBUG "%s: dsp pipeline ready\n", __func__);
#endif

	return 0;
}

static inline void _dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
{
	struct dsp_pipeline_entry *entry, *n;

	list_for_each_entry_safe(entry, n, &pipeline->list, list) {
		list_del(&entry->list);
		if (entry->elem == dsp_hwec)
			dsp_hwec_disable(container_of(pipeline, struct dsp,
216
						      pipeline));
Karsten Keil's avatar
Karsten Keil committed
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256
		else
			entry->elem->free(entry->p);
		kfree(entry);
	}
}

void dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
{

	if (!pipeline)
		return;

	_dsp_pipeline_destroy(pipeline);

#ifdef PIPELINE_DEBUG
	printk(KERN_DEBUG "%s: dsp pipeline destroyed\n", __func__);
#endif
}

int dsp_pipeline_build(struct dsp_pipeline *pipeline, const char *cfg)
{
	int len, incomplete = 0, found = 0;
	char *dup, *tok, *name, *args;
	struct dsp_element_entry *entry, *n;
	struct dsp_pipeline_entry *pipeline_entry;
	struct mISDN_dsp_element *elem;

	if (!pipeline)
		return -EINVAL;

	if (!list_empty(&pipeline->list))
		_dsp_pipeline_destroy(pipeline);

	if (!cfg)
		return 0;

	len = strlen(cfg);
	if (!len)
		return 0;

Andreas Eversberg's avatar
Andreas Eversberg committed
257
	dup = kmalloc(len + 1, GFP_ATOMIC);
Karsten Keil's avatar
Karsten Keil committed
258 259 260 261 262 263 264 265 266
	if (!dup)
		return 0;
	strcpy(dup, cfg);
	while ((tok = strsep(&dup, "|"))) {
		if (!strlen(tok))
			continue;
		name = strsep(&tok, "(");
		args = strsep(&tok, ")");
		if (args && !*args)
267
			args = NULL;
Karsten Keil's avatar
Karsten Keil committed
268 269 270 271 272 273

		list_for_each_entry_safe(entry, n, &dsp_elements, list)
			if (!strcmp(entry->elem->name, name)) {
				elem = entry->elem;

				pipeline_entry = kmalloc(sizeof(struct
274
								dsp_pipeline_entry), GFP_ATOMIC);
Karsten Keil's avatar
Karsten Keil committed
275
				if (!pipeline_entry) {
276
					printk(KERN_ERR "%s: failed to add "
277 278
					       "entry to pipeline: %s (out of "
					       "memory)\n", __func__, elem->name);
Karsten Keil's avatar
Karsten Keil committed
279 280 281 282 283 284 285 286 287
					incomplete = 1;
					goto _out;
				}
				pipeline_entry->elem = elem;

				if (elem == dsp_hwec) {
					/* This is a hack to make the hwec
					   available as a pipeline module */
					dsp_hwec_enable(container_of(pipeline,
288
								     struct dsp, pipeline), args);
Karsten Keil's avatar
Karsten Keil committed
289
					list_add_tail(&pipeline_entry->list,
290
						      &pipeline->list);
Karsten Keil's avatar
Karsten Keil committed
291 292 293 294
				} else {
					pipeline_entry->p = elem->new(args);
					if (pipeline_entry->p) {
						list_add_tail(&pipeline_entry->
295
							      list, &pipeline->list);
Karsten Keil's avatar
Karsten Keil committed
296 297
#ifdef PIPELINE_DEBUG
						printk(KERN_DEBUG "%s: created "
298 299 300 301
						       "instance of %s%s%s\n",
						       __func__, name, args ?
						       " with args " : "", args ?
						       args : "");
Karsten Keil's avatar
Karsten Keil committed
302 303
#endif
					} else {
304
						printk(KERN_ERR "%s: failed "
305 306 307
						       "to add entry to pipeline: "
						       "%s (new() returned NULL)\n",
						       __func__, elem->name);
Karsten Keil's avatar
Karsten Keil committed
308 309 310 311 312 313 314 315 316 317 318
						kfree(pipeline_entry);
						incomplete = 1;
					}
				}
				found = 1;
				break;
			}

		if (found)
			found = 0;
		else {
319
			printk(KERN_ERR "%s: element not found, skipping: "
320
			       "%s\n", __func__, name);
Karsten Keil's avatar
Karsten Keil committed
321 322 323 324 325 326 327 328 329 330 331 332
			incomplete = 1;
		}
	}

_out:
	if (!list_empty(&pipeline->list))
		pipeline->inuse = 1;
	else
		pipeline->inuse = 0;

#ifdef PIPELINE_DEBUG
	printk(KERN_DEBUG "%s: dsp pipeline built%s: %s\n",
333
	       __func__, incomplete ? " incomplete" : "", cfg);
Karsten Keil's avatar
Karsten Keil committed
334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350
#endif
	kfree(dup);
	return 0;
}

void dsp_pipeline_process_tx(struct dsp_pipeline *pipeline, u8 *data, int len)
{
	struct dsp_pipeline_entry *entry;

	if (!pipeline)
		return;

	list_for_each_entry(entry, &pipeline->list, list)
		if (entry->elem->process_tx)
			entry->elem->process_tx(entry->p, data, len);
}

351
void dsp_pipeline_process_rx(struct dsp_pipeline *pipeline, u8 *data, int len,
352
			     unsigned int txlen)
Karsten Keil's avatar
Karsten Keil committed
353 354 355 356 357 358 359 360
{
	struct dsp_pipeline_entry *entry;

	if (!pipeline)
		return;

	list_for_each_entry_reverse(entry, &pipeline->list, list)
		if (entry->elem->process_rx)
361
			entry->elem->process_rx(entry->p, data, len, txlen);
Karsten Keil's avatar
Karsten Keil committed
362
}