SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/isdn/mISDN/dsp_pipeline.c

   1 /*
   2  * dsp_pipeline.c: pipelined audio processing
   3  *
   4  * Copyright (C) 2007, Nadi Sarrar
   5  *
   6  * Nadi Sarrar <nadi@beronet.com>
   7  *
   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)
  11  * any later version.
  12  *
  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
  16  * more details.
  17  *
  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.
  21  *
  22  * The full GNU General Public License is included in this distribution in the
  23  * file called LICENSE.
  24  *
  25  */
  26
  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 "dsp.h"
  34 #include "dsp_hwec.h"
  35
  36 /* uncomment for debugging */
  37 /*#define PIPELINE_DEBUG*/
  38
  39 struct dsp_pipeline_entry {
  40         struct mISDN_dsp_element *elem;
  41         void                *p;
  42         struct list_head     list;
  43 };
  44 struct dsp_element_entry {
  45         struct mISDN_dsp_element *elem;
  46         struct device        dev;
  47         struct list_head     list;
  48 };
  49
  50 static LIST_HEAD(dsp_elements);
  51
  52 /* sysfs */
  53 static struct class *elements_class;
  54
  55 static ssize_t
  56 attr_show_args(struct device *dev, struct device_attribute *attr, char *buf)
  57 {
  58         struct mISDN_dsp_element *elem = dev_get_drvdata(dev);
  59         int i;
  60         char *p = buf;
  61
  62         *buf = 0;
  63         for (i = 0; i < elem->num_args; i++)
  64                 p += sprintf(p, "Name:        %s\n%s%s%sDescription: %s\n\n",
  65                           elem->args[i].name,
  66                           elem->args[i].def ? "Default:     " : "",
  67                           elem->args[i].def ? elem->args[i].def : "",
  68                           elem->args[i].def ? "\n" : "",
  69                           elem->args[i].desc);
  70
  71         return p - buf;
  72 }
  73
  74 static struct device_attribute element_attributes[] = {
  75         __ATTR(args, 0444, attr_show_args, NULL),
  76 };
  77
  78 static void
  79 mISDN_dsp_dev_release(struct device *dev)
  80 {
  81         struct dsp_element_entry *entry =
  82                 container_of(dev, struct dsp_element_entry, dev);
  83         list_del(&entry->list);
  84         kfree(entry);
  85 }
  86
  87 int mISDN_dsp_element_register(struct mISDN_dsp_element *elem)
  88 {
  89         struct dsp_element_entry *entry;
  90         int ret, i;
  91
  92         if (!elem)
  93                 return -EINVAL;
  94
  95         entry = kzalloc(sizeof(struct dsp_element_entry), GFP_ATOMIC);
  96         if (!entry)
  97                 return -ENOMEM;
  98
  99         entry->elem = elem;
 100
 101         entry->dev.class = elements_class;
 102         entry->dev.release = mISDN_dsp_dev_release;
 103         dev_set_drvdata(&entry->dev, elem);
 104         dev_set_name(&entry->dev, elem->name);
 105         ret = device_register(&entry->dev);
 106         if (ret) {
 107                 printk(KERN_ERR "%s: failed to register %s\n",
 108                         __func__, elem->name);
 109                 goto err1;
 110         }
 111         list_add_tail(&entry->list, &dsp_elements);
 112
 113         for (i = 0; i < ARRAY_SIZE(element_attributes); ++i) {
 114                 ret = device_create_file(&entry->dev,
 115                                 &element_attributes[i]);
 116                 if (ret) {
 117                         printk(KERN_ERR "%s: failed to create device file\n",
 118                                 __func__);
 119                         goto err2;
 120                 }
 121         }
 122
 123 #ifdef PIPELINE_DEBUG
 124         printk(KERN_DEBUG "%s: %s registered\n", __func__, elem->name);
 125 #endif
 126
 127         return 0;
 128
 129 err2:
 130         device_unregister(&entry->dev);
 131         return ret;
 132 err1:
 133         kfree(entry);
 134         return ret;
 135 }
 136 EXPORT_SYMBOL(mISDN_dsp_element_register);
 137
 138 void mISDN_dsp_element_unregister(struct mISDN_dsp_element *elem)
 139 {
 140         struct dsp_element_entry *entry, *n;
 141
 142         if (!elem)
 143                 return;
 144
 145         list_for_each_entry_safe(entry, n, &dsp_elements, list)
 146                 if (entry->elem == elem) {
 147                         device_unregister(&entry->dev);
 148 #ifdef PIPELINE_DEBUG
 149                         printk(KERN_DEBUG "%s: %s unregistered\n",
 150                                 __func__, elem->name);
 151 #endif
 152                         return;
 153                 }
 154         printk(KERN_ERR "%s: element %s not in list.\n", __func__, elem->name);
 155 }
 156 EXPORT_SYMBOL(mISDN_dsp_element_unregister);
 157
 158 int dsp_pipeline_module_init(void)
 159 {
 160         elements_class = class_create(THIS_MODULE, "dsp_pipeline");
 161         if (IS_ERR(elements_class))
 162                 return PTR_ERR(elements_class);
 163
 164 #ifdef PIPELINE_DEBUG
 165         printk(KERN_DEBUG "%s: dsp pipeline module initialized\n", __func__);
 166 #endif
 167
 168         dsp_hwec_init();
 169
 170         return 0;
 171 }
 172
 173 void dsp_pipeline_module_exit(void)
 174 {
 175         struct dsp_element_entry *entry, *n;
 176
 177         dsp_hwec_exit();
 178
 179         class_destroy(elements_class);
 180
 181         list_for_each_entry_safe(entry, n, &dsp_elements, list) {
 182                 list_del(&entry->list);
 183                 printk(KERN_WARNING "%s: element was still registered: %s\n",
 184                         __func__, entry->elem->name);
 185                 kfree(entry);
 186         }
 187
 188 #ifdef PIPELINE_DEBUG
 189         printk(KERN_DEBUG "%s: dsp pipeline module exited\n", __func__);
 190 #endif
 191 }
 192
 193 int dsp_pipeline_init(struct dsp_pipeline *pipeline)
 194 {
 195         if (!pipeline)
 196                 return -EINVAL;
 197
 198         INIT_LIST_HEAD(&pipeline->list);
 199
 200 #ifdef PIPELINE_DEBUG
 201         printk(KERN_DEBUG "%s: dsp pipeline ready\n", __func__);
 202 #endif
 203
 204         return 0;
 205 }
 206
 207 static inline void _dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
 208 {
 209         struct dsp_pipeline_entry *entry, *n;
 210
 211         list_for_each_entry_safe(entry, n, &pipeline->list, list) {
 212                 list_del(&entry->list);
 213                 if (entry->elem == dsp_hwec)
 214                         dsp_hwec_disable(container_of(pipeline, struct dsp,
 215                                 pipeline));
 216                 else
 217                         entry->elem->free(entry->p);
 218                 kfree(entry);
 219         }
 220 }
 221
 222 void dsp_pipeline_destroy(struct dsp_pipeline *pipeline)
 223 {
 224
 225         if (!pipeline)
 226                 return;
 227
 228         _dsp_pipeline_destroy(pipeline);
 229
 230 #ifdef PIPELINE_DEBUG
 231         printk(KERN_DEBUG "%s: dsp pipeline destroyed\n", __func__);
 232 #endif
 233 }
 234
 235 int dsp_pipeline_build(struct dsp_pipeline *pipeline, const char *cfg)
 236 {
 237         int len, incomplete = 0, found = 0;
 238         char *dup, *tok, *name, *args;
 239         struct dsp_element_entry *entry, *n;
 240         struct dsp_pipeline_entry *pipeline_entry;
 241         struct mISDN_dsp_element *elem;
 242
 243         if (!pipeline)
 244                 return -EINVAL;
 245
 246         if (!list_empty(&pipeline->list))
 247                 _dsp_pipeline_destroy(pipeline);
 248
 249         if (!cfg)
 250                 return 0;
 251
 252         len = strlen(cfg);
 253         if (!len)
 254                 return 0;
 255
 256         dup = kmalloc(len + 1, GFP_ATOMIC);
 257         if (!dup)
 258                 return 0;
 259         strcpy(dup, cfg);
 260         while ((tok = strsep(&dup, "|"))) {
 261                 if (!strlen(tok))
 262                         continue;
 263                 name = strsep(&tok, "(");
 264                 args = strsep(&tok, ")");
 265                 if (args && !*args)
 266                         args = NULL;
 267
 268                 list_for_each_entry_safe(entry, n, &dsp_elements, list)
 269                         if (!strcmp(entry->elem->name, name)) {
 270                                 elem = entry->elem;
 271
 272                                 pipeline_entry = kmalloc(sizeof(struct
 273                                         dsp_pipeline_entry), GFP_ATOMIC);
 274                                 if (!pipeline_entry) {
 275                                         printk(KERN_ERR "%s: failed to add "
 276                                             "entry to pipeline: %s (out of "
 277                                             "memory)\n", __func__, elem->name);
 278                                         incomplete = 1;
 279                                         goto _out;
 280                                 }
 281                                 pipeline_entry->elem = elem;
 282
 283                                 if (elem == dsp_hwec) {
 284                                         /* This is a hack to make the hwec
 285                                            available as a pipeline module */
 286                                         dsp_hwec_enable(container_of(pipeline,
 287                                                 struct dsp, pipeline), args);
 288                                         list_add_tail(&pipeline_entry->list,
 289                                                 &pipeline->list);
 290                                 } else {
 291                                         pipeline_entry->p = elem->new(args);
 292                                         if (pipeline_entry->p) {
 293                                                 list_add_tail(&pipeline_entry->
 294                                                         list, &pipeline->list);
 295 #ifdef PIPELINE_DEBUG
 296                                                 printk(KERN_DEBUG "%s: created "
 297                                                     "instance of %s%s%s\n",
 298                                                     __func__, name, args ?
 299                                                     " with args " : "", args ?
 300                                                     args : "");
 301 #endif
 302                                         } else {
 303                                                 printk(KERN_ERR "%s: failed "
 304                                                   "to add entry to pipeline: "
 305                                                   "%s (new() returned NULL)\n",
 306                                                   __func__, elem->name);
 307                                                 kfree(pipeline_entry);
 308                                                 incomplete = 1;
 309                                         }
 310                                 }
 311                                 found = 1;
 312                                 break;
 313                         }
 314
 315                 if (found)
 316                         found = 0;
 317                 else {
 318                         printk(KERN_ERR "%s: element not found, skipping: "
 319                                 "%s\n", __func__, name);
 320                         incomplete = 1;
 321                 }
 322         }
 323
 324 _out:
 325         if (!list_empty(&pipeline->list))
 326                 pipeline->inuse = 1;
 327         else
 328                 pipeline->inuse = 0;
 329
 330 #ifdef PIPELINE_DEBUG
 331         printk(KERN_DEBUG "%s: dsp pipeline built%s: %s\n",
 332                 __func__, incomplete ? " incomplete" : "", cfg);
 333 #endif
 334         kfree(dup);
 335         return 0;
 336 }
 337
 338 void dsp_pipeline_process_tx(struct dsp_pipeline *pipeline, u8 *data, int len)
 339 {
 340         struct dsp_pipeline_entry *entry;
 341
 342         if (!pipeline)
 343                 return;
 344
 345         list_for_each_entry(entry, &pipeline->list, list)
 346                 if (entry->elem->process_tx)
 347                         entry->elem->process_tx(entry->p, data, len);
 348 }
 349
 350 void dsp_pipeline_process_rx(struct dsp_pipeline *pipeline, u8 *data, int len,
 351         unsigned int txlen)
 352 {
 353         struct dsp_pipeline_entry *entry;
 354
 355         if (!pipeline)
 356                 return;
 357
 358         list_for_each_entry_reverse(entry, &pipeline->list, list)
 359                 if (entry->elem->process_rx)
 360                         entry->elem->process_rx(entry->p, data, len, txlen);
 361 }
 362
 363