Linux Audio

Check our new training course

Loading...
v6.8
   1/*
   2 * Audio crossconnecting/conferrencing (hardware level).
   3 *
   4 * Copyright 2002 by Andreas Eversberg (jolly@eversberg.eu)
   5 *
   6 * This software may be used and distributed according to the terms
   7 * of the GNU General Public License, incorporated herein by reference.
   8 *
   9 */
  10
  11/*
  12 * The process of adding and removing parties to/from a conference:
  13 *
  14 * There is a chain of struct dsp_conf which has one or more members in a chain
  15 * of struct dsp_conf_member.
  16 *
  17 * After a party is added, the conference is checked for hardware capability.
  18 * Also if a party is removed, the conference is checked again.
  19 *
  20 * There are 3 different solutions: -1 = software, 0 = hardware-crossconnect
  21 * 1-n = hardware-conference. The n will give the conference number.
  22 *
  23 * Depending on the change after removal or insertion of a party, hardware
  24 * commands are given.
  25 *
  26 * The current solution is stored within the struct dsp_conf entry.
  27 */
  28
  29/*
  30 * HOW THE CMX WORKS:
  31 *
  32 * There are 3 types of interaction: One member is alone, in this case only
  33 * data flow from upper to lower layer is done.
  34 * Two members will also exchange their data so they are crossconnected.
  35 * Three or more members will be added in a conference and will hear each
  36 * other but will not receive their own speech (echo) if not enabled.
  37 *
  38 * Features of CMX are:
  39 *  - Crossconnecting or even conference, if more than two members are together.
  40 *  - Force mixing of transmit data with other crossconnect/conference members.
  41 *  - Echo generation to benchmark the delay of audio processing.
  42 *  - Use hardware to minimize cpu load, disable FIFO load and minimize delay.
  43 *  - Dejittering and clock generation.
  44 *
  45 * There are 2 buffers:
  46 *
  47 *
  48 * RX-Buffer
  49 *                 R             W
  50 *                 |             |
  51 * ----------------+-------------+-------------------
  52 *
  53 * The rx-buffer is a ring buffer used to store the received data for each
  54 * individual member. This is only the case if data needs to be dejittered
  55 * or in case of a conference where different clocks require reclocking.
  56 * The transmit-clock (R) will read the buffer.
  57 * If the clock overruns the write-pointer, we will have a buffer underrun.
  58 * If the write pointer always has a certain distance from the transmit-
  59 * clock, we will have a delay. The delay will dynamically be increased and
  60 * reduced.
  61 *
  62 *
  63 * TX-Buffer
  64 *                  R        W
  65 *                  |        |
  66 * -----------------+--------+-----------------------
  67 *
  68 * The tx-buffer is a ring buffer to queue the transmit data from user space
  69 * until it will be mixed or sent. There are two pointers, R and W. If the write
  70 * pointer W would reach or overrun R, the buffer would overrun. In this case
  71 * (some) data is dropped so that it will not overrun.
  72 * Additionally a dynamic dejittering can be enabled. this allows data from
  73 * user space that have jitter and different clock source.
  74 *
  75 *
  76 * Clock:
  77 *
  78 * A Clock is not required, if the data source has exactly one clock. In this
  79 * case the data source is forwarded to the destination.
  80 *
  81 * A Clock is required, because the data source
  82 *  - has multiple clocks.
  83 *  - has no usable clock due to jitter or packet loss (VoIP).
  84 * In this case the system's clock is used. The clock resolution depends on
  85 * the jiffie resolution.
  86 *
  87 * If a member joins a conference:
  88 *
  89 * - If a member joins, its rx_buff is set to silence and change read pointer
  90 *   to transmit clock.
  91 *
  92 * The procedure of received data from card is explained in cmx_receive.
  93 * The procedure of received data from user space is explained in cmx_transmit.
  94 * The procedure of transmit data to card is cmx_send.
  95 *
  96 *
  97 * Interaction with other features:
  98 *
  99 * DTMF:
 100 * DTMF decoding is done before the data is crossconnected.
 101 *
 102 * Volume change:
 103 * Changing rx-volume is done before the data is crossconnected. The tx-volume
 104 * must be changed whenever data is transmitted to the card by the cmx.
 105 *
 106 * Tones:
 107 * If a tone is enabled, it will be processed whenever data is transmitted to
 108 * the card. It will replace the tx-data from the user space.
 109 * If tones are generated by hardware, this conference member is removed for
 110 * this time.
 111 *
 112 * Disable rx-data:
 113 * If cmx is realized in hardware, rx data will be disabled if requested by
 114 * the upper layer. If dtmf decoding is done by software and enabled, rx data
 115 * will not be disabled but blocked to the upper layer.
 116 *
 117 * HFC conference engine:
 118 * If it is possible to realize all features using hardware, hardware will be
 119 * used if not forbidden by control command. Disabling rx-data provides
 120 * absolutely traffic free audio processing. (except for the quick 1-frame
 121 * upload of a tone loop, only once for a new tone)
 122 *
 123 */
 124
 125/* delay.h is required for hw_lock.h */
 126
 127#include <linux/slab.h>
 128#include <linux/delay.h>
 129#include <linux/mISDNif.h>
 130#include <linux/mISDNdsp.h>
 131#include "core.h"
 132#include "dsp.h"
 133/*
 134 * debugging of multi party conference,
 135 * by using conference even with two members
 136 */
 137
 138/* #define CMX_CONF_DEBUG */
 139
 140/*#define CMX_DEBUG * massive read/write pointer output */
 141/*#define CMX_DELAY_DEBUG * gives rx-buffer delay overview */
 142/*#define CMX_TX_DEBUG * massive read/write on tx-buffer with content */
 143
 
 
 
 
 
 
 
 
 
 
 
 144/*
 145 * debug cmx memory structure
 146 */
 147void
 148dsp_cmx_debug(struct dsp *dsp)
 149{
 150	struct dsp_conf	*conf;
 151	struct dsp_conf_member	*member;
 152	struct dsp		*odsp;
 153
 154	printk(KERN_DEBUG "-----Current DSP\n");
 155	list_for_each_entry(odsp, &dsp_ilist, list) {
 156		printk(KERN_DEBUG "* %s hardecho=%d softecho=%d txmix=%d",
 157		       odsp->name, odsp->echo.hardware, odsp->echo.software,
 158		       odsp->tx_mix);
 159		if (odsp->conf)
 160			printk(" (Conf %d)", odsp->conf->id);
 161		if (dsp == odsp)
 162			printk(" *this*");
 163		printk("\n");
 164	}
 165	printk(KERN_DEBUG "-----Current Conf:\n");
 166	list_for_each_entry(conf, &conf_ilist, list) {
 167		printk(KERN_DEBUG "* Conf %d (%p)\n", conf->id, conf);
 168		list_for_each_entry(member, &conf->mlist, list) {
 169			printk(KERN_DEBUG
 170			       "  - member = %s (slot_tx %d, bank_tx %d, "
 171			       "slot_rx %d, bank_rx %d hfc_conf %d "
 172			       "tx_data %d rx_is_off %d)%s\n",
 173			       member->dsp->name, member->dsp->pcm_slot_tx,
 174			       member->dsp->pcm_bank_tx, member->dsp->pcm_slot_rx,
 175			       member->dsp->pcm_bank_rx, member->dsp->hfc_conf,
 176			       member->dsp->tx_data, member->dsp->rx_is_off,
 177			       (member->dsp == dsp) ? " *this*" : "");
 178		}
 179	}
 180	printk(KERN_DEBUG "-----end\n");
 181}
 182
 183/*
 184 * search conference
 185 */
 186static struct dsp_conf *
 187dsp_cmx_search_conf(u32 id)
 188{
 189	struct dsp_conf *conf;
 190
 191	if (!id) {
 192		printk(KERN_WARNING "%s: conference ID is 0.\n", __func__);
 193		return NULL;
 194	}
 195
 196	/* search conference */
 197	list_for_each_entry(conf, &conf_ilist, list)
 198		if (conf->id == id)
 199			return conf;
 200
 201	return NULL;
 202}
 203
 204
 205/*
 206 * add member to conference
 207 */
 208static int
 209dsp_cmx_add_conf_member(struct dsp *dsp, struct dsp_conf *conf)
 210{
 211	struct dsp_conf_member *member;
 212
 213	if (!conf || !dsp) {
 214		printk(KERN_WARNING "%s: conf or dsp is 0.\n", __func__);
 215		return -EINVAL;
 216	}
 217	if (dsp->member) {
 218		printk(KERN_WARNING "%s: dsp is already member in a conf.\n",
 219		       __func__);
 220		return -EINVAL;
 221	}
 222
 223	if (dsp->conf) {
 224		printk(KERN_WARNING "%s: dsp is already in a conf.\n",
 225		       __func__);
 226		return -EINVAL;
 227	}
 228
 229	member = kzalloc(sizeof(struct dsp_conf_member), GFP_ATOMIC);
 230	if (!member) {
 231		printk(KERN_ERR "kzalloc struct dsp_conf_member failed\n");
 232		return -ENOMEM;
 233	}
 234	member->dsp = dsp;
 235	/* clear rx buffer */
 236	memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
 237	dsp->rx_init = 1; /* rx_W and rx_R will be adjusted on first frame */
 238	dsp->rx_W = 0;
 239	dsp->rx_R = 0;
 240
 241	list_add_tail(&member->list, &conf->mlist);
 242
 243	dsp->conf = conf;
 244	dsp->member = member;
 245
 246	return 0;
 247}
 248
 249
 250/*
 251 * del member from conference
 252 */
 253int
 254dsp_cmx_del_conf_member(struct dsp *dsp)
 255{
 256	struct dsp_conf_member *member;
 257
 258	if (!dsp) {
 259		printk(KERN_WARNING "%s: dsp is 0.\n",
 260		       __func__);
 261		return -EINVAL;
 262	}
 263
 264	if (!dsp->conf) {
 265		printk(KERN_WARNING "%s: dsp is not in a conf.\n",
 266		       __func__);
 267		return -EINVAL;
 268	}
 269
 270	if (list_empty(&dsp->conf->mlist)) {
 271		printk(KERN_WARNING "%s: dsp has linked an empty conf.\n",
 272		       __func__);
 273		return -EINVAL;
 274	}
 275
 276	/* find us in conf */
 277	list_for_each_entry(member, &dsp->conf->mlist, list) {
 278		if (member->dsp == dsp) {
 279			list_del(&member->list);
 280			dsp->conf = NULL;
 281			dsp->member = NULL;
 282			kfree(member);
 283			return 0;
 284		}
 285	}
 286	printk(KERN_WARNING
 287	       "%s: dsp is not present in its own conf_member list.\n",
 288	       __func__);
 289
 290	return -EINVAL;
 291}
 292
 293
 294/*
 295 * new conference
 296 */
 297static struct dsp_conf
 298*dsp_cmx_new_conf(u32 id)
 299{
 300	struct dsp_conf *conf;
 301
 302	if (!id) {
 303		printk(KERN_WARNING "%s: id is 0.\n",
 304		       __func__);
 305		return NULL;
 306	}
 307
 308	conf = kzalloc(sizeof(struct dsp_conf), GFP_ATOMIC);
 309	if (!conf) {
 310		printk(KERN_ERR "kzalloc struct dsp_conf failed\n");
 311		return NULL;
 312	}
 313	INIT_LIST_HEAD(&conf->mlist);
 314	conf->id = id;
 315
 316	list_add_tail(&conf->list, &conf_ilist);
 317
 318	return conf;
 319}
 320
 321
 322/*
 323 * del conference
 324 */
 325int
 326dsp_cmx_del_conf(struct dsp_conf *conf)
 327{
 328	if (!conf) {
 329		printk(KERN_WARNING "%s: conf is null.\n",
 330		       __func__);
 331		return -EINVAL;
 332	}
 333
 334	if (!list_empty(&conf->mlist)) {
 335		printk(KERN_WARNING "%s: conf not empty.\n",
 336		       __func__);
 337		return -EINVAL;
 338	}
 339	list_del(&conf->list);
 340	kfree(conf);
 341
 342	return 0;
 343}
 344
 345
 346/*
 347 * send HW message to hfc card
 348 */
 349static void
 350dsp_cmx_hw_message(struct dsp *dsp, u32 message, u32 param1, u32 param2,
 351		   u32 param3, u32 param4)
 352{
 353	struct mISDN_ctrl_req cq;
 354
 355	memset(&cq, 0, sizeof(cq));
 356	cq.op = message;
 357	cq.p1 = param1 | (param2 << 8);
 358	cq.p2 = param3 | (param4 << 8);
 359	if (dsp->ch.peer)
 360		dsp->ch.peer->ctrl(dsp->ch.peer, CONTROL_CHANNEL, &cq);
 361}
 362
 363
 364/*
 365 * do hardware update and set the software/hardware flag
 366 *
 367 * either a conference or a dsp instance can be given
 368 * if only dsp instance is given, the instance is not associated with a conf
 369 * and therefore removed. if a conference is given, the dsp is expected to
 370 * be member of that conference.
 371 */
 372void
 373dsp_cmx_hardware(struct dsp_conf *conf, struct dsp *dsp)
 374{
 375	struct dsp_conf_member	*member, *nextm;
 376	struct dsp		*finddsp;
 377	int		memb = 0, i, ii, i1, i2;
 378	int		freeunits[8];
 379	u_char		freeslots[256];
 380	int		same_hfc = -1, same_pcm = -1, current_conf = -1,
 381		all_conf = 1, tx_data = 0;
 382
 383	/* dsp gets updated (no conf) */
 384	if (!conf) {
 385		if (!dsp)
 386			return;
 387		if (dsp_debug & DEBUG_DSP_CMX)
 388			printk(KERN_DEBUG "%s checking dsp %s\n",
 389			       __func__, dsp->name);
 390	one_member:
 391		/* remove HFC conference if enabled */
 392		if (dsp->hfc_conf >= 0) {
 393			if (dsp_debug & DEBUG_DSP_CMX)
 394				printk(KERN_DEBUG
 395				       "%s removing %s from HFC conf %d "
 396				       "because dsp is split\n", __func__,
 397				       dsp->name, dsp->hfc_conf);
 398			dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_CONF_SPLIT,
 399					   0, 0, 0, 0);
 400			dsp->hfc_conf = -1;
 401		}
 402		/* process hw echo */
 403		if (dsp->features.pcm_banks < 1)
 404			return;
 405		if (!dsp->echo.software && !dsp->echo.hardware) {
 406			/* NO ECHO: remove PCM slot if assigned */
 407			if (dsp->pcm_slot_tx >= 0 || dsp->pcm_slot_rx >= 0) {
 408				if (dsp_debug & DEBUG_DSP_CMX)
 409					printk(KERN_DEBUG "%s removing %s from"
 410					       " PCM slot %d (TX) %d (RX) because"
 411					       " dsp is split (no echo)\n",
 412					       __func__, dsp->name,
 413					       dsp->pcm_slot_tx, dsp->pcm_slot_rx);
 414				dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_DISC,
 415						   0, 0, 0, 0);
 416				dsp->pcm_slot_tx = -1;
 417				dsp->pcm_bank_tx = -1;
 418				dsp->pcm_slot_rx = -1;
 419				dsp->pcm_bank_rx = -1;
 420			}
 421			return;
 422		}
 423		/* echo is enabled, find out if we use soft or hardware */
 424		dsp->echo.software = dsp->tx_data;
 425		dsp->echo.hardware = 0;
 426		/* ECHO: already echo */
 427		if (dsp->pcm_slot_tx >= 0 && dsp->pcm_slot_rx < 0 &&
 428		    dsp->pcm_bank_tx == 2 && dsp->pcm_bank_rx == 2) {
 429			dsp->echo.hardware = 1;
 430			return;
 431		}
 432		/* ECHO: if slot already assigned */
 433		if (dsp->pcm_slot_tx >= 0) {
 434			dsp->pcm_slot_rx = dsp->pcm_slot_tx;
 435			dsp->pcm_bank_tx = 2; /* 2 means loop */
 436			dsp->pcm_bank_rx = 2;
 437			if (dsp_debug & DEBUG_DSP_CMX)
 438				printk(KERN_DEBUG
 439				       "%s refresh %s for echo using slot %d\n",
 440				       __func__, dsp->name,
 441				       dsp->pcm_slot_tx);
 442			dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_CONN,
 443					   dsp->pcm_slot_tx, 2, dsp->pcm_slot_rx, 2);
 444			dsp->echo.hardware = 1;
 445			return;
 446		}
 447		/* ECHO: find slot */
 448		dsp->pcm_slot_tx = -1;
 449		dsp->pcm_slot_rx = -1;
 450		memset(freeslots, 1, sizeof(freeslots));
 451		list_for_each_entry(finddsp, &dsp_ilist, list) {
 452			if (finddsp->features.pcm_id == dsp->features.pcm_id) {
 453				if (finddsp->pcm_slot_rx >= 0 &&
 454				    finddsp->pcm_slot_rx < sizeof(freeslots))
 455					freeslots[finddsp->pcm_slot_rx] = 0;
 456				if (finddsp->pcm_slot_tx >= 0 &&
 457				    finddsp->pcm_slot_tx < sizeof(freeslots))
 458					freeslots[finddsp->pcm_slot_tx] = 0;
 459			}
 460		}
 461		i = 0;
 462		ii = dsp->features.pcm_slots;
 463		while (i < ii) {
 464			if (freeslots[i])
 465				break;
 466			i++;
 467		}
 468		if (i == ii) {
 469			if (dsp_debug & DEBUG_DSP_CMX)
 470				printk(KERN_DEBUG
 471				       "%s no slot available for echo\n",
 472				       __func__);
 473			/* no more slots available */
 474			dsp->echo.software = 1;
 475			return;
 476		}
 477		/* assign free slot */
 478		dsp->pcm_slot_tx = i;
 479		dsp->pcm_slot_rx = i;
 480		dsp->pcm_bank_tx = 2; /* loop */
 481		dsp->pcm_bank_rx = 2;
 482		if (dsp_debug & DEBUG_DSP_CMX)
 483			printk(KERN_DEBUG
 484			       "%s assign echo for %s using slot %d\n",
 485			       __func__, dsp->name, dsp->pcm_slot_tx);
 486		dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_CONN,
 487				   dsp->pcm_slot_tx, 2, dsp->pcm_slot_rx, 2);
 488		dsp->echo.hardware = 1;
 489		return;
 490	}
 491
 492	/* conf gets updated (all members) */
 493	if (dsp_debug & DEBUG_DSP_CMX)
 494		printk(KERN_DEBUG "%s checking conference %d\n",
 495		       __func__, conf->id);
 496
 497	if (list_empty(&conf->mlist)) {
 498		printk(KERN_ERR "%s: conference without members\n",
 499		       __func__);
 500		return;
 501	}
 502	member = list_entry(conf->mlist.next, struct dsp_conf_member, list);
 503	same_hfc = member->dsp->features.hfc_id;
 504	same_pcm = member->dsp->features.pcm_id;
 505	/* check all members in our conference */
 506	list_for_each_entry(member, &conf->mlist, list) {
 507		/* check if member uses mixing */
 508		if (member->dsp->tx_mix) {
 509			if (dsp_debug & DEBUG_DSP_CMX)
 510				printk(KERN_DEBUG
 511				       "%s dsp %s cannot form a conf, because "
 512				       "tx_mix is turned on\n", __func__,
 513				       member->dsp->name);
 514		conf_software:
 515			list_for_each_entry(member, &conf->mlist, list) {
 516				dsp = member->dsp;
 517				/* remove HFC conference if enabled */
 518				if (dsp->hfc_conf >= 0) {
 519					if (dsp_debug & DEBUG_DSP_CMX)
 520						printk(KERN_DEBUG
 521						       "%s removing %s from HFC "
 522						       "conf %d because not "
 523						       "possible with hardware\n",
 524						       __func__,
 525						       dsp->name,
 526						       dsp->hfc_conf);
 527					dsp_cmx_hw_message(dsp,
 528							   MISDN_CTRL_HFC_CONF_SPLIT,
 529							   0, 0, 0, 0);
 530					dsp->hfc_conf = -1;
 531				}
 532				/* remove PCM slot if assigned */
 533				if (dsp->pcm_slot_tx >= 0 ||
 534				    dsp->pcm_slot_rx >= 0) {
 535					if (dsp_debug & DEBUG_DSP_CMX)
 536						printk(KERN_DEBUG "%s removing "
 537						       "%s from PCM slot %d (TX)"
 538						       " slot %d (RX) because not"
 539						       " possible with hardware\n",
 540						       __func__,
 541						       dsp->name,
 542						       dsp->pcm_slot_tx,
 543						       dsp->pcm_slot_rx);
 544					dsp_cmx_hw_message(dsp,
 545							   MISDN_CTRL_HFC_PCM_DISC,
 546							   0, 0, 0, 0);
 547					dsp->pcm_slot_tx = -1;
 548					dsp->pcm_bank_tx = -1;
 549					dsp->pcm_slot_rx = -1;
 550					dsp->pcm_bank_rx = -1;
 551				}
 552			}
 553			conf->hardware = 0;
 554			conf->software = 1;
 555			return;
 556		}
 557		/* check if member has echo turned on */
 558		if (member->dsp->echo.hardware || member->dsp->echo.software) {
 559			if (dsp_debug & DEBUG_DSP_CMX)
 560				printk(KERN_DEBUG
 561				       "%s dsp %s cannot form a conf, because "
 562				       "echo is turned on\n", __func__,
 563				       member->dsp->name);
 564			goto conf_software;
 565		}
 566		/* check if member has tx_mix turned on */
 567		if (member->dsp->tx_mix) {
 568			if (dsp_debug & DEBUG_DSP_CMX)
 569				printk(KERN_DEBUG
 570				       "%s dsp %s cannot form a conf, because "
 571				       "tx_mix is turned on\n",
 572				       __func__, member->dsp->name);
 573			goto conf_software;
 574		}
 575		/* check if member changes volume at an not suppoted level */
 576		if (member->dsp->tx_volume) {
 577			if (dsp_debug & DEBUG_DSP_CMX)
 578				printk(KERN_DEBUG
 579				       "%s dsp %s cannot form a conf, because "
 580				       "tx_volume is changed\n",
 581				       __func__, member->dsp->name);
 582			goto conf_software;
 583		}
 584		if (member->dsp->rx_volume) {
 585			if (dsp_debug & DEBUG_DSP_CMX)
 586				printk(KERN_DEBUG
 587				       "%s dsp %s cannot form a conf, because "
 588				       "rx_volume is changed\n",
 589				       __func__, member->dsp->name);
 590			goto conf_software;
 591		}
 592		/* check if tx-data turned on */
 593		if (member->dsp->tx_data) {
 594			if (dsp_debug & DEBUG_DSP_CMX)
 595				printk(KERN_DEBUG
 596				       "%s dsp %s tx_data is turned on\n",
 597				       __func__, member->dsp->name);
 598			tx_data = 1;
 599		}
 600		/* check if pipeline exists */
 601		if (member->dsp->pipeline.inuse) {
 602			if (dsp_debug & DEBUG_DSP_CMX)
 603				printk(KERN_DEBUG
 604				       "%s dsp %s cannot form a conf, because "
 605				       "pipeline exists\n", __func__,
 606				       member->dsp->name);
 607			goto conf_software;
 608		}
 609		/* check if encryption is enabled */
 610		if (member->dsp->bf_enable) {
 611			if (dsp_debug & DEBUG_DSP_CMX)
 612				printk(KERN_DEBUG "%s dsp %s cannot form a "
 613				       "conf, because encryption is enabled\n",
 614				       __func__, member->dsp->name);
 615			goto conf_software;
 616		}
 617		/* check if member is on a card with PCM support */
 618		if (member->dsp->features.pcm_id < 0) {
 619			if (dsp_debug & DEBUG_DSP_CMX)
 620				printk(KERN_DEBUG
 621				       "%s dsp %s cannot form a conf, because "
 622				       "dsp has no PCM bus\n",
 623				       __func__, member->dsp->name);
 624			goto conf_software;
 625		}
 626		/* check if relations are on the same PCM bus */
 627		if (member->dsp->features.pcm_id != same_pcm) {
 628			if (dsp_debug & DEBUG_DSP_CMX)
 629				printk(KERN_DEBUG
 630				       "%s dsp %s cannot form a conf, because "
 631				       "dsp is on a different PCM bus than the "
 632				       "first dsp\n",
 633				       __func__, member->dsp->name);
 634			goto conf_software;
 635		}
 636		/* determine if members are on the same hfc chip */
 637		if (same_hfc != member->dsp->features.hfc_id)
 638			same_hfc = -1;
 639		/* if there are members already in a conference */
 640		if (current_conf < 0 && member->dsp->hfc_conf >= 0)
 641			current_conf = member->dsp->hfc_conf;
 642		/* if any member is not in a conference */
 643		if (member->dsp->hfc_conf < 0)
 644			all_conf = 0;
 645
 646		memb++;
 647	}
 648
 649	/* if no member, this is an error */
 650	if (memb < 1)
 651		return;
 652
 653	/* one member */
 654	if (memb == 1) {
 655		if (dsp_debug & DEBUG_DSP_CMX)
 656			printk(KERN_DEBUG
 657			       "%s conf %d cannot form a HW conference, "
 658			       "because dsp is alone\n", __func__, conf->id);
 659		conf->hardware = 0;
 660		conf->software = 0;
 661		member = list_entry(conf->mlist.next, struct dsp_conf_member,
 662				    list);
 663		dsp = member->dsp;
 664		goto one_member;
 665	}
 666
 667	/*
 668	 * ok, now we are sure that all members are on the same pcm.
 669	 * now we will see if we have only two members, so we can do
 670	 * crossconnections, which don't have any limitations.
 671	 */
 672
 673	/* if we have only two members */
 674	if (memb == 2) {
 675		member = list_entry(conf->mlist.next, struct dsp_conf_member,
 676				    list);
 677		nextm = list_entry(member->list.next, struct dsp_conf_member,
 678				   list);
 679		/* remove HFC conference if enabled */
 680		if (member->dsp->hfc_conf >= 0) {
 681			if (dsp_debug & DEBUG_DSP_CMX)
 682				printk(KERN_DEBUG
 683				       "%s removing %s from HFC conf %d because "
 684				       "two parties require only a PCM slot\n",
 685				       __func__, member->dsp->name,
 686				       member->dsp->hfc_conf);
 687			dsp_cmx_hw_message(member->dsp,
 688					   MISDN_CTRL_HFC_CONF_SPLIT, 0, 0, 0, 0);
 689			member->dsp->hfc_conf = -1;
 690		}
 691		if (nextm->dsp->hfc_conf >= 0) {
 692			if (dsp_debug & DEBUG_DSP_CMX)
 693				printk(KERN_DEBUG
 694				       "%s removing %s from HFC conf %d because "
 695				       "two parties require only a PCM slot\n",
 696				       __func__, nextm->dsp->name,
 697				       nextm->dsp->hfc_conf);
 698			dsp_cmx_hw_message(nextm->dsp,
 699					   MISDN_CTRL_HFC_CONF_SPLIT, 0, 0, 0, 0);
 700			nextm->dsp->hfc_conf = -1;
 701		}
 702		/* if members have two banks (and not on the same chip) */
 703		if (member->dsp->features.pcm_banks > 1 &&
 704		    nextm->dsp->features.pcm_banks > 1 &&
 705		    member->dsp->features.hfc_id !=
 706		    nextm->dsp->features.hfc_id) {
 707			/* if both members have same slots with crossed banks */
 708			if (member->dsp->pcm_slot_tx >= 0 &&
 709			    member->dsp->pcm_slot_rx >= 0 &&
 710			    nextm->dsp->pcm_slot_tx >= 0 &&
 711			    nextm->dsp->pcm_slot_rx >= 0 &&
 712			    nextm->dsp->pcm_slot_tx ==
 713			    member->dsp->pcm_slot_rx &&
 714			    nextm->dsp->pcm_slot_rx ==
 715			    member->dsp->pcm_slot_tx &&
 716			    nextm->dsp->pcm_slot_tx ==
 717			    member->dsp->pcm_slot_tx &&
 718			    member->dsp->pcm_bank_tx !=
 719			    member->dsp->pcm_bank_rx &&
 720			    nextm->dsp->pcm_bank_tx !=
 721			    nextm->dsp->pcm_bank_rx) {
 722				/* all members have same slot */
 723				if (dsp_debug & DEBUG_DSP_CMX)
 724					printk(KERN_DEBUG
 725					       "%s dsp %s & %s stay joined on "
 726					       "PCM slot %d bank %d (TX) bank %d "
 727					       "(RX) (on different chips)\n",
 728					       __func__,
 729					       member->dsp->name,
 730					       nextm->dsp->name,
 731					       member->dsp->pcm_slot_tx,
 732					       member->dsp->pcm_bank_tx,
 733					       member->dsp->pcm_bank_rx);
 734				conf->hardware = 1;
 735				conf->software = tx_data;
 736				return;
 737			}
 738			/* find a new slot */
 739			memset(freeslots, 1, sizeof(freeslots));
 740			list_for_each_entry(dsp, &dsp_ilist, list) {
 741				if (dsp != member->dsp &&
 742				    dsp != nextm->dsp &&
 743				    member->dsp->features.pcm_id ==
 744				    dsp->features.pcm_id) {
 745					if (dsp->pcm_slot_rx >= 0 &&
 746					    dsp->pcm_slot_rx <
 747					    sizeof(freeslots))
 748						freeslots[dsp->pcm_slot_rx] = 0;
 749					if (dsp->pcm_slot_tx >= 0 &&
 750					    dsp->pcm_slot_tx <
 751					    sizeof(freeslots))
 752						freeslots[dsp->pcm_slot_tx] = 0;
 753				}
 754			}
 755			i = 0;
 756			ii = member->dsp->features.pcm_slots;
 757			while (i < ii) {
 758				if (freeslots[i])
 759					break;
 760				i++;
 761			}
 762			if (i == ii) {
 763				if (dsp_debug & DEBUG_DSP_CMX)
 764					printk(KERN_DEBUG
 765					       "%s no slot available for "
 766					       "%s & %s\n", __func__,
 767					       member->dsp->name,
 768					       nextm->dsp->name);
 769				/* no more slots available */
 770				goto conf_software;
 771			}
 772			/* assign free slot */
 773			member->dsp->pcm_slot_tx = i;
 774			member->dsp->pcm_slot_rx = i;
 775			nextm->dsp->pcm_slot_tx = i;
 776			nextm->dsp->pcm_slot_rx = i;
 777			member->dsp->pcm_bank_rx = 0;
 778			member->dsp->pcm_bank_tx = 1;
 779			nextm->dsp->pcm_bank_rx = 1;
 780			nextm->dsp->pcm_bank_tx = 0;
 781			if (dsp_debug & DEBUG_DSP_CMX)
 782				printk(KERN_DEBUG
 783				       "%s adding %s & %s to new PCM slot %d "
 784				       "(TX and RX on different chips) because "
 785				       "both members have not same slots\n",
 786				       __func__,
 787				       member->dsp->name,
 788				       nextm->dsp->name,
 789				       member->dsp->pcm_slot_tx);
 790			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
 791					   member->dsp->pcm_slot_tx, member->dsp->pcm_bank_tx,
 792					   member->dsp->pcm_slot_rx, member->dsp->pcm_bank_rx);
 793			dsp_cmx_hw_message(nextm->dsp, MISDN_CTRL_HFC_PCM_CONN,
 794					   nextm->dsp->pcm_slot_tx, nextm->dsp->pcm_bank_tx,
 795					   nextm->dsp->pcm_slot_rx, nextm->dsp->pcm_bank_rx);
 796			conf->hardware = 1;
 797			conf->software = tx_data;
 798			return;
 799			/* if members have one bank (or on the same chip) */
 800		} else {
 801			/* if both members have different crossed slots */
 802			if (member->dsp->pcm_slot_tx >= 0 &&
 803			    member->dsp->pcm_slot_rx >= 0 &&
 804			    nextm->dsp->pcm_slot_tx >= 0 &&
 805			    nextm->dsp->pcm_slot_rx >= 0 &&
 806			    nextm->dsp->pcm_slot_tx ==
 807			    member->dsp->pcm_slot_rx &&
 808			    nextm->dsp->pcm_slot_rx ==
 809			    member->dsp->pcm_slot_tx &&
 810			    member->dsp->pcm_slot_tx !=
 811			    member->dsp->pcm_slot_rx &&
 812			    member->dsp->pcm_bank_tx == 0 &&
 813			    member->dsp->pcm_bank_rx == 0 &&
 814			    nextm->dsp->pcm_bank_tx == 0 &&
 815			    nextm->dsp->pcm_bank_rx == 0) {
 816				/* all members have same slot */
 817				if (dsp_debug & DEBUG_DSP_CMX)
 818					printk(KERN_DEBUG
 819					       "%s dsp %s & %s stay joined on PCM "
 820					       "slot %d (TX) %d (RX) on same chip "
 821					       "or one bank PCM)\n", __func__,
 822					       member->dsp->name,
 823					       nextm->dsp->name,
 824					       member->dsp->pcm_slot_tx,
 825					       member->dsp->pcm_slot_rx);
 826				conf->hardware = 1;
 827				conf->software = tx_data;
 828				return;
 829			}
 830			/* find two new slot */
 831			memset(freeslots, 1, sizeof(freeslots));
 832			list_for_each_entry(dsp, &dsp_ilist, list) {
 833				if (dsp != member->dsp &&
 834				    dsp != nextm->dsp &&
 835				    member->dsp->features.pcm_id ==
 836				    dsp->features.pcm_id) {
 837					if (dsp->pcm_slot_rx >= 0 &&
 838					    dsp->pcm_slot_rx <
 839					    sizeof(freeslots))
 840						freeslots[dsp->pcm_slot_rx] = 0;
 841					if (dsp->pcm_slot_tx >= 0 &&
 842					    dsp->pcm_slot_tx <
 843					    sizeof(freeslots))
 844						freeslots[dsp->pcm_slot_tx] = 0;
 845				}
 846			}
 847			i1 = 0;
 848			ii = member->dsp->features.pcm_slots;
 849			while (i1 < ii) {
 850				if (freeslots[i1])
 851					break;
 852				i1++;
 853			}
 854			if (i1 == ii) {
 855				if (dsp_debug & DEBUG_DSP_CMX)
 856					printk(KERN_DEBUG
 857					       "%s no slot available "
 858					       "for %s & %s\n", __func__,
 859					       member->dsp->name,
 860					       nextm->dsp->name);
 861				/* no more slots available */
 862				goto conf_software;
 863			}
 864			i2 = i1 + 1;
 865			while (i2 < ii) {
 866				if (freeslots[i2])
 867					break;
 868				i2++;
 869			}
 870			if (i2 == ii) {
 871				if (dsp_debug & DEBUG_DSP_CMX)
 872					printk(KERN_DEBUG
 873					       "%s no slot available "
 874					       "for %s & %s\n",
 875					       __func__,
 876					       member->dsp->name,
 877					       nextm->dsp->name);
 878				/* no more slots available */
 879				goto conf_software;
 880			}
 881			/* assign free slots */
 882			member->dsp->pcm_slot_tx = i1;
 883			member->dsp->pcm_slot_rx = i2;
 884			nextm->dsp->pcm_slot_tx = i2;
 885			nextm->dsp->pcm_slot_rx = i1;
 886			member->dsp->pcm_bank_rx = 0;
 887			member->dsp->pcm_bank_tx = 0;
 888			nextm->dsp->pcm_bank_rx = 0;
 889			nextm->dsp->pcm_bank_tx = 0;
 890			if (dsp_debug & DEBUG_DSP_CMX)
 891				printk(KERN_DEBUG
 892				       "%s adding %s & %s to new PCM slot %d "
 893				       "(TX) %d (RX) on same chip or one bank "
 894				       "PCM, because both members have not "
 895				       "crossed slots\n", __func__,
 896				       member->dsp->name,
 897				       nextm->dsp->name,
 898				       member->dsp->pcm_slot_tx,
 899				       member->dsp->pcm_slot_rx);
 900			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
 901					   member->dsp->pcm_slot_tx, member->dsp->pcm_bank_tx,
 902					   member->dsp->pcm_slot_rx, member->dsp->pcm_bank_rx);
 903			dsp_cmx_hw_message(nextm->dsp, MISDN_CTRL_HFC_PCM_CONN,
 904					   nextm->dsp->pcm_slot_tx, nextm->dsp->pcm_bank_tx,
 905					   nextm->dsp->pcm_slot_rx, nextm->dsp->pcm_bank_rx);
 906			conf->hardware = 1;
 907			conf->software = tx_data;
 908			return;
 909		}
 910	}
 911
 912	/*
 913	 * if we have more than two, we may check if we have a conference
 914	 * unit available on the chip. also all members must be on the same
 915	 */
 916
 917	/* if not the same HFC chip */
 918	if (same_hfc < 0) {
 919		if (dsp_debug & DEBUG_DSP_CMX)
 920			printk(KERN_DEBUG
 921			       "%s conference %d cannot be formed, because "
 922			       "members are on different chips or not "
 923			       "on HFC chip\n",
 924			       __func__, conf->id);
 925		goto conf_software;
 926	}
 927
 928	/* for more than two members.. */
 929
 930	/* if all members already have the same conference */
 931	if (all_conf) {
 932		conf->hardware = 1;
 933		conf->software = tx_data;
 934		return;
 935	}
 936
 937	/*
 938	 * if there is an existing conference, but not all members have joined
 939	 */
 940	if (current_conf >= 0) {
 941	join_members:
 942		list_for_each_entry(member, &conf->mlist, list) {
 943			/* if no conference engine on our chip, change to
 944			 * software */
 945			if (!member->dsp->features.hfc_conf)
 946				goto conf_software;
 947			/* in case of hdlc, change to software */
 948			if (member->dsp->hdlc)
 949				goto conf_software;
 950			/* join to current conference */
 951			if (member->dsp->hfc_conf == current_conf)
 952				continue;
 953			/* get a free timeslot first */
 954			memset(freeslots, 1, sizeof(freeslots));
 955			list_for_each_entry(dsp, &dsp_ilist, list) {
 956				/*
 957				 * not checking current member, because
 958				 * slot will be overwritten.
 959				 */
 960				if (
 961					dsp != member->dsp &&
 962					/* dsp must be on the same PCM */
 963					member->dsp->features.pcm_id ==
 964					dsp->features.pcm_id) {
 965					/* dsp must be on a slot */
 966					if (dsp->pcm_slot_tx >= 0 &&
 967					    dsp->pcm_slot_tx <
 968					    sizeof(freeslots))
 969						freeslots[dsp->pcm_slot_tx] = 0;
 970					if (dsp->pcm_slot_rx >= 0 &&
 971					    dsp->pcm_slot_rx <
 972					    sizeof(freeslots))
 973						freeslots[dsp->pcm_slot_rx] = 0;
 974				}
 975			}
 976			i = 0;
 977			ii = member->dsp->features.pcm_slots;
 978			while (i < ii) {
 979				if (freeslots[i])
 980					break;
 981				i++;
 982			}
 983			if (i == ii) {
 984				/* no more slots available */
 985				if (dsp_debug & DEBUG_DSP_CMX)
 986					printk(KERN_DEBUG
 987					       "%s conference %d cannot be formed,"
 988					       " because no slot free\n",
 989					       __func__, conf->id);
 990				goto conf_software;
 991			}
 992			if (dsp_debug & DEBUG_DSP_CMX)
 993				printk(KERN_DEBUG
 994				       "%s changing dsp %s to HW conference "
 995				       "%d slot %d\n", __func__,
 996				       member->dsp->name, current_conf, i);
 997			/* assign free slot & set PCM & join conf */
 998			member->dsp->pcm_slot_tx = i;
 999			member->dsp->pcm_slot_rx = i;
1000			member->dsp->pcm_bank_tx = 2; /* loop */
1001			member->dsp->pcm_bank_rx = 2;
1002			member->dsp->hfc_conf = current_conf;
1003			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
1004					   i, 2, i, 2);
1005			dsp_cmx_hw_message(member->dsp,
1006					   MISDN_CTRL_HFC_CONF_JOIN, current_conf, 0, 0, 0);
1007		}
1008		conf->hardware = 1;
1009		conf->software = tx_data;
1010		return;
1011	}
1012
1013	/*
1014	 * no member is in a conference yet, so we find a free one
1015	 */
1016	memset(freeunits, 1, sizeof(freeunits));
1017	list_for_each_entry(dsp, &dsp_ilist, list) {
1018		/* dsp must be on the same chip */
1019		if (dsp->features.hfc_id == same_hfc &&
1020		    /* dsp must have joined a HW conference */
1021		    dsp->hfc_conf >= 0 &&
1022		    /* slot must be within range */
1023		    dsp->hfc_conf < 8)
1024			freeunits[dsp->hfc_conf] = 0;
1025	}
1026	i = 0;
1027	ii = 8;
1028	while (i < ii) {
1029		if (freeunits[i])
1030			break;
1031		i++;
1032	}
1033	if (i == ii) {
1034		/* no more conferences available */
1035		if (dsp_debug & DEBUG_DSP_CMX)
1036			printk(KERN_DEBUG
1037			       "%s conference %d cannot be formed, because "
1038			       "no conference number free\n",
1039			       __func__, conf->id);
1040		goto conf_software;
1041	}
1042	/* join all members */
1043	current_conf = i;
1044	goto join_members;
1045}
1046
1047
1048/*
1049 * conf_id != 0: join or change conference
1050 * conf_id == 0: split from conference if not already
1051 */
1052int
1053dsp_cmx_conf(struct dsp *dsp, u32 conf_id)
1054{
1055	int err;
1056	struct dsp_conf *conf;
1057	struct dsp_conf_member	*member;
1058
1059	/* if conference doesn't change */
1060	if (dsp->conf_id == conf_id)
1061		return 0;
1062
1063	/* first remove us from current conf */
1064	if (dsp->conf_id) {
1065		if (dsp_debug & DEBUG_DSP_CMX)
1066			printk(KERN_DEBUG "removing us from conference %d\n",
1067			       dsp->conf->id);
1068		/* remove us from conf */
1069		conf = dsp->conf;
1070		err = dsp_cmx_del_conf_member(dsp);
1071		if (err)
1072			return err;
1073		dsp->conf_id = 0;
1074
1075		/* update hardware */
1076		dsp_cmx_hardware(NULL, dsp);
1077
1078		/* conf now empty? */
1079		if (list_empty(&conf->mlist)) {
1080			if (dsp_debug & DEBUG_DSP_CMX)
1081				printk(KERN_DEBUG
1082				       "conference is empty, so we remove it.\n");
1083			err = dsp_cmx_del_conf(conf);
1084			if (err)
1085				return err;
1086		} else {
1087			/* update members left on conf */
1088			dsp_cmx_hardware(conf, NULL);
1089		}
1090	}
1091
1092	/* if split */
1093	if (!conf_id)
1094		return 0;
1095
1096	/* now add us to conf */
1097	if (dsp_debug & DEBUG_DSP_CMX)
1098		printk(KERN_DEBUG "searching conference %d\n",
1099		       conf_id);
1100	conf = dsp_cmx_search_conf(conf_id);
1101	if (!conf) {
1102		if (dsp_debug & DEBUG_DSP_CMX)
1103			printk(KERN_DEBUG
1104			       "conference doesn't exist yet, creating.\n");
1105		/* the conference doesn't exist, so we create */
1106		conf = dsp_cmx_new_conf(conf_id);
1107		if (!conf)
1108			return -EINVAL;
1109	} else if (!list_empty(&conf->mlist)) {
1110		member = list_entry(conf->mlist.next, struct dsp_conf_member,
1111				    list);
1112		if (dsp->hdlc && !member->dsp->hdlc) {
1113			if (dsp_debug & DEBUG_DSP_CMX)
1114				printk(KERN_DEBUG
1115				       "cannot join transparent conference.\n");
1116			return -EINVAL;
1117		}
1118		if (!dsp->hdlc && member->dsp->hdlc) {
1119			if (dsp_debug & DEBUG_DSP_CMX)
1120				printk(KERN_DEBUG
1121				       "cannot join hdlc conference.\n");
1122			return -EINVAL;
1123		}
1124	}
1125	/* add conference member */
1126	err = dsp_cmx_add_conf_member(dsp, conf);
1127	if (err)
1128		return err;
1129	dsp->conf_id = conf_id;
1130
1131	/* if we are alone, we do nothing! */
1132	if (list_empty(&conf->mlist)) {
1133		if (dsp_debug & DEBUG_DSP_CMX)
1134			printk(KERN_DEBUG
1135			       "we are alone in this conference, so exit.\n");
1136		/* update hardware */
1137		dsp_cmx_hardware(NULL, dsp);
1138		return 0;
1139	}
1140
1141	/* update members on conf */
1142	dsp_cmx_hardware(conf, NULL);
1143
1144	return 0;
1145}
1146
1147#ifdef CMX_DELAY_DEBUG
1148int delaycount;
1149static void
1150showdelay(struct dsp *dsp, int samples, int delay)
1151{
1152	char bar[] = "--------------------------------------------------|";
1153	int sdelay;
1154
1155	delaycount += samples;
1156	if (delaycount < 8000)
1157		return;
1158	delaycount = 0;
1159
1160	sdelay = delay * 50 / (dsp_poll << 2);
1161
1162	printk(KERN_DEBUG "DELAY (%s) %3d >%s\n", dsp->name, delay,
1163	       sdelay > 50 ? "..." : bar + 50 - sdelay);
1164}
1165#endif
1166
1167/*
1168 * audio data is received from card
1169 */
1170void
1171dsp_cmx_receive(struct dsp *dsp, struct sk_buff *skb)
1172{
1173	u8 *d, *p;
1174	int len = skb->len;
1175	struct mISDNhead *hh = mISDN_HEAD_P(skb);
1176	int w, i, ii;
1177
1178	/* check if we have sompen */
1179	if (len < 1)
1180		return;
1181
1182	/* half of the buffer should be larger than maximum packet size */
1183	if (len >= CMX_BUFF_HALF) {
1184		printk(KERN_ERR
1185		       "%s line %d: packet from card is too large (%d bytes). "
1186		       "please make card send smaller packets OR increase "
1187		       "CMX_BUFF_SIZE\n", __FILE__, __LINE__, len);
1188		return;
1189	}
1190
1191	/*
1192	 * initialize pointers if not already -
1193	 * also add delay if requested by PH_SIGNAL
1194	 */
1195	if (dsp->rx_init) {
1196		dsp->rx_init = 0;
1197		if (dsp->features.unordered) {
1198			dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1199			if (dsp->cmx_delay)
1200				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1201					& CMX_BUFF_MASK;
1202			else
1203				dsp->rx_W = (dsp->rx_R + (dsp_poll >> 1))
1204					& CMX_BUFF_MASK;
1205		} else {
1206			dsp->rx_R = 0;
1207			if (dsp->cmx_delay)
1208				dsp->rx_W = dsp->cmx_delay;
1209			else
1210				dsp->rx_W = dsp_poll >> 1;
1211		}
1212	}
1213	/* if frame contains time code, write directly */
1214	if (dsp->features.unordered) {
1215		dsp->rx_W = (hh->id & CMX_BUFF_MASK);
1216		/* printk(KERN_DEBUG "%s %08x\n", dsp->name, hh->id); */
1217	}
1218	/*
1219	 * if we underrun (or maybe overrun),
1220	 * we set our new read pointer, and write silence to buffer
1221	 */
1222	if (((dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK) >= CMX_BUFF_HALF) {
1223		if (dsp_debug & DEBUG_DSP_CLOCK)
1224			printk(KERN_DEBUG
1225			       "cmx_receive(dsp=%lx): UNDERRUN (or overrun the "
1226			       "maximum delay), adjusting read pointer! "
1227			       "(inst %s)\n", (u_long)dsp, dsp->name);
1228		/* flush rx buffer and set delay to dsp_poll / 2 */
1229		if (dsp->features.unordered) {
1230			dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1231			if (dsp->cmx_delay)
1232				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1233					& CMX_BUFF_MASK;
1234			else
1235				dsp->rx_W = (dsp->rx_R + (dsp_poll >> 1))
1236					& CMX_BUFF_MASK;
1237		} else {
1238			dsp->rx_R = 0;
1239			if (dsp->cmx_delay)
1240				dsp->rx_W = dsp->cmx_delay;
1241			else
1242				dsp->rx_W = dsp_poll >> 1;
1243		}
1244		memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
1245	}
1246	/* if we have reached double delay, jump back to middle */
1247	if (dsp->cmx_delay)
1248		if (((dsp->rx_W - dsp->rx_R) & CMX_BUFF_MASK) >=
1249		    (dsp->cmx_delay << 1)) {
1250			if (dsp_debug & DEBUG_DSP_CLOCK)
1251				printk(KERN_DEBUG
1252				       "cmx_receive(dsp=%lx): OVERRUN (because "
1253				       "twice the delay is reached), adjusting "
1254				       "read pointer! (inst %s)\n",
1255				       (u_long)dsp, dsp->name);
1256			/* flush buffer */
1257			if (dsp->features.unordered) {
1258				dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1259				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1260					& CMX_BUFF_MASK;
1261			} else {
1262				dsp->rx_R = 0;
1263				dsp->rx_W = dsp->cmx_delay;
1264			}
1265			memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
1266		}
1267
1268	/* show where to write */
1269#ifdef CMX_DEBUG
1270	printk(KERN_DEBUG
1271	       "cmx_receive(dsp=%lx): rx_R(dsp)=%05x rx_W(dsp)=%05x len=%d %s\n",
1272	       (u_long)dsp, dsp->rx_R, dsp->rx_W, len, dsp->name);
1273#endif
1274
1275	/* write data into rx_buffer */
1276	p = skb->data;
1277	d = dsp->rx_buff;
1278	w = dsp->rx_W;
1279	i = 0;
1280	ii = len;
1281	while (i < ii) {
1282		d[w++ & CMX_BUFF_MASK] = *p++;
1283		i++;
1284	}
1285
1286	/* increase write-pointer */
1287	dsp->rx_W = ((dsp->rx_W + len) & CMX_BUFF_MASK);
1288#ifdef CMX_DELAY_DEBUG
1289	showdelay(dsp, len, (dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK);
1290#endif
1291}
1292
1293
1294/*
1295 * send (mixed) audio data to card and control jitter
1296 */
1297static void
1298dsp_cmx_send_member(struct dsp *dsp, int len, s32 *c, int members)
1299{
1300	struct dsp_conf *conf = dsp->conf;
1301	struct dsp *member, *other;
1302	register s32 sample;
1303	u8 *d, *p, *q, *o_q;
1304	struct sk_buff *nskb, *txskb;
1305	int r, rr, t, tt, o_r, o_rr;
1306	int preload = 0;
1307	struct mISDNhead *hh, *thh;
1308	int tx_data_only = 0;
1309
1310	/* don't process if: */
1311	if (!dsp->b_active) { /* if not active */
1312		dsp->last_tx = 0;
1313		return;
1314	}
1315	if (((dsp->conf && dsp->conf->hardware) || /* hardware conf */
1316	     dsp->echo.hardware) && /* OR hardware echo */
1317	    dsp->tx_R == dsp->tx_W && /* AND no tx-data */
1318	    !(dsp->tone.tone && dsp->tone.software)) { /* AND not soft tones */
1319		if (!dsp->tx_data) { /* no tx_data for user space required */
1320			dsp->last_tx = 0;
1321			return;
1322		}
1323		if (dsp->conf && dsp->conf->software && dsp->conf->hardware)
1324			tx_data_only = 1;
1325		if (dsp->echo.software && dsp->echo.hardware)
1326			tx_data_only = 1;
1327	}
1328
1329#ifdef CMX_DEBUG
1330	printk(KERN_DEBUG
1331	       "SEND members=%d dsp=%s, conf=%p, rx_R=%05x rx_W=%05x\n",
1332	       members, dsp->name, conf, dsp->rx_R, dsp->rx_W);
1333#endif
1334
1335	/* preload if we have delay set */
1336	if (dsp->cmx_delay && !dsp->last_tx) {
1337		preload = len;
1338		if (preload < 128)
1339			preload = 128;
1340	}
1341
1342	/* PREPARE RESULT */
1343	nskb = mI_alloc_skb(len + preload, GFP_ATOMIC);
1344	if (!nskb) {
1345		printk(KERN_ERR
1346		       "FATAL ERROR in mISDN_dsp.o: cannot alloc %d bytes\n",
1347		       len + preload);
1348		return;
1349	}
1350	hh = mISDN_HEAD_P(nskb);
1351	hh->prim = PH_DATA_REQ;
1352	hh->id = 0;
1353	dsp->last_tx = 1;
1354
1355	/* set pointers, indexes and stuff */
1356	member = dsp;
1357	p = dsp->tx_buff; /* transmit data */
1358	q = dsp->rx_buff; /* received data */
1359	d = skb_put(nskb, preload + len); /* result */
1360	t = dsp->tx_R; /* tx-pointers */
1361	tt = dsp->tx_W;
1362	r = dsp->rx_R; /* rx-pointers */
1363	rr = (r + len) & CMX_BUFF_MASK;
1364
1365	/* preload with silence, if required */
1366	if (preload) {
1367		memset(d, dsp_silence, preload);
1368		d += preload;
1369	}
1370
1371	/* PROCESS TONES/TX-DATA ONLY */
1372	if (dsp->tone.tone && dsp->tone.software) {
1373		/* -> copy tone */
1374		dsp_tone_copy(dsp, d, len);
1375		dsp->tx_R = 0; /* clear tx buffer */
1376		dsp->tx_W = 0;
1377		goto send_packet;
1378	}
1379	/* if we have tx-data but do not use mixing */
1380	if (!dsp->tx_mix && t != tt) {
1381		/* -> send tx-data and continue when not enough */
1382#ifdef CMX_TX_DEBUG
1383		sprintf(debugbuf, "TX sending (%04x-%04x)%p: ", t, tt, p);
1384#endif
1385		while (r != rr && t != tt) {
1386#ifdef CMX_TX_DEBUG
1387			if (strlen(debugbuf) < 48)
1388				sprintf(debugbuf + strlen(debugbuf), " %02x",
1389					p[t]);
1390#endif
1391			*d++ = p[t]; /* write tx_buff */
1392			t = (t + 1) & CMX_BUFF_MASK;
1393			r = (r + 1) & CMX_BUFF_MASK;
1394		}
1395		if (r == rr) {
1396			dsp->tx_R = t;
1397#ifdef CMX_TX_DEBUG
1398			printk(KERN_DEBUG "%s\n", debugbuf);
1399#endif
1400			goto send_packet;
1401		}
1402	}
1403#ifdef CMX_TX_DEBUG
1404	printk(KERN_DEBUG "%s\n", debugbuf);
1405#endif
1406
1407	/* PROCESS DATA (one member / no conf) */
1408	if (!conf || members <= 1) {
1409		/* -> if echo is NOT enabled */
1410		if (!dsp->echo.software) {
1411			/* -> send tx-data if available or use 0-volume */
1412			while (r != rr && t != tt) {
1413				*d++ = p[t]; /* write tx_buff */
1414				t = (t + 1) & CMX_BUFF_MASK;
1415				r = (r + 1) & CMX_BUFF_MASK;
1416			}
1417			if (r != rr) {
1418				if (dsp_debug & DEBUG_DSP_CLOCK)
1419					printk(KERN_DEBUG "%s: RX empty\n",
1420					       __func__);
1421				memset(d, dsp_silence, (rr - r) & CMX_BUFF_MASK);
1422			}
1423			/* -> if echo is enabled */
1424		} else {
1425			/*
1426			 * -> mix tx-data with echo if available,
1427			 * or use echo only
1428			 */
1429			while (r != rr && t != tt) {
1430				*d++ = dsp_audio_mix_law[(p[t] << 8) | q[r]];
1431				t = (t + 1) & CMX_BUFF_MASK;
1432				r = (r + 1) & CMX_BUFF_MASK;
1433			}
1434			while (r != rr) {
1435				*d++ = q[r]; /* echo */
1436				r = (r + 1) & CMX_BUFF_MASK;
1437			}
1438		}
1439		dsp->tx_R = t;
1440		goto send_packet;
1441	}
1442	/* PROCESS DATA (two members) */
1443#ifdef CMX_CONF_DEBUG
1444	if (0) {
1445#else
1446	if (members == 2) {
1447#endif
1448		/* "other" becomes other party */
1449		other = (list_entry(conf->mlist.next,
1450				    struct dsp_conf_member, list))->dsp;
1451		if (other == member)
1452			other = (list_entry(conf->mlist.prev,
1453				    struct dsp_conf_member, list))->dsp;
1454		o_q = other->rx_buff; /* received data */
1455		o_rr = (other->rx_R + len) & CMX_BUFF_MASK;
1456		/* end of rx-pointer */
1457		o_r = (o_rr - rr + r) & CMX_BUFF_MASK;
1458		/* start rx-pointer at current read position*/
1459		/* -> if echo is NOT enabled */
1460		if (!dsp->echo.software) {
1461			/*
1462			 * -> copy other member's rx-data,
1463			 * if tx-data is available, mix
1464			 */
1465			while (o_r != o_rr && t != tt) {
1466				*d++ = dsp_audio_mix_law[(p[t] << 8) | o_q[o_r]];
1467				t = (t + 1) & CMX_BUFF_MASK;
1468				o_r = (o_r + 1) & CMX_BUFF_MASK;
1469			}
1470			while (o_r != o_rr) {
1471				*d++ = o_q[o_r];
1472				o_r = (o_r + 1) & CMX_BUFF_MASK;
1473			}
1474			/* -> if echo is enabled */
1475		} else {
1476			/*
1477			 * -> mix other member's rx-data with echo,
1478			 * if tx-data is available, mix
1479			 */
1480			while (r != rr && t != tt) {
1481				sample = dsp_audio_law_to_s32[p[t]] +
1482					dsp_audio_law_to_s32[q[r]] +
1483					dsp_audio_law_to_s32[o_q[o_r]];
1484				if (sample < -32768)
1485					sample = -32768;
1486				else if (sample > 32767)
1487					sample = 32767;
1488				*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1489				/* tx-data + rx_data + echo */
1490				t = (t + 1) & CMX_BUFF_MASK;
1491				r = (r + 1) & CMX_BUFF_MASK;
1492				o_r = (o_r + 1) & CMX_BUFF_MASK;
1493			}
1494			while (r != rr) {
1495				*d++ = dsp_audio_mix_law[(q[r] << 8) | o_q[o_r]];
1496				r = (r + 1) & CMX_BUFF_MASK;
1497				o_r = (o_r + 1) & CMX_BUFF_MASK;
1498			}
1499		}
1500		dsp->tx_R = t;
1501		goto send_packet;
1502	}
1503	/* PROCESS DATA (three or more members) */
1504	/* -> if echo is NOT enabled */
1505	if (!dsp->echo.software) {
1506		/*
1507		 * -> subtract rx-data from conf-data,
1508		 * if tx-data is available, mix
1509		 */
1510		while (r != rr && t != tt) {
1511			sample = dsp_audio_law_to_s32[p[t]] + *c++ -
1512				dsp_audio_law_to_s32[q[r]];
1513			if (sample < -32768)
1514				sample = -32768;
1515			else if (sample > 32767)
1516				sample = 32767;
1517			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1518			/* conf-rx+tx */
1519			r = (r + 1) & CMX_BUFF_MASK;
1520			t = (t + 1) & CMX_BUFF_MASK;
1521		}
1522		while (r != rr) {
1523			sample = *c++ - dsp_audio_law_to_s32[q[r]];
1524			if (sample < -32768)
1525				sample = -32768;
1526			else if (sample > 32767)
1527				sample = 32767;
1528			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1529			/* conf-rx */
1530			r = (r + 1) & CMX_BUFF_MASK;
1531		}
1532		/* -> if echo is enabled */
1533	} else {
1534		/*
1535		 * -> encode conf-data, if tx-data
1536		 * is available, mix
1537		 */
1538		while (r != rr && t != tt) {
1539			sample = dsp_audio_law_to_s32[p[t]] + *c++;
1540			if (sample < -32768)
1541				sample = -32768;
1542			else if (sample > 32767)
1543				sample = 32767;
1544			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1545			/* conf(echo)+tx */
1546			t = (t + 1) & CMX_BUFF_MASK;
1547			r = (r + 1) & CMX_BUFF_MASK;
1548		}
1549		while (r != rr) {
1550			sample = *c++;
1551			if (sample < -32768)
1552				sample = -32768;
1553			else if (sample > 32767)
1554				sample = 32767;
1555			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1556			/* conf(echo) */
1557			r = (r + 1) & CMX_BUFF_MASK;
1558		}
1559	}
1560	dsp->tx_R = t;
1561	goto send_packet;
1562
1563send_packet:
1564	/*
1565	 * send tx-data if enabled - don't filter,
1566	 * because we want what we send, not what we filtered
1567	 */
1568	if (dsp->tx_data) {
1569		if (tx_data_only) {
1570			hh->prim = DL_DATA_REQ;
1571			hh->id = 0;
1572			/* queue and trigger */
1573			skb_queue_tail(&dsp->sendq, nskb);
1574			schedule_work(&dsp->workq);
1575			/* exit because only tx_data is used */
1576			return;
1577		} else {
1578			txskb = mI_alloc_skb(len, GFP_ATOMIC);
1579			if (!txskb) {
1580				printk(KERN_ERR
1581				       "FATAL ERROR in mISDN_dsp.o: "
1582				       "cannot alloc %d bytes\n", len);
1583			} else {
1584				thh = mISDN_HEAD_P(txskb);
1585				thh->prim = DL_DATA_REQ;
1586				thh->id = 0;
1587				skb_put_data(txskb, nskb->data + preload, len);
1588				/* queue (trigger later) */
1589				skb_queue_tail(&dsp->sendq, txskb);
1590			}
1591		}
1592	}
1593
1594	/* send data only to card, if we don't just calculated tx_data */
1595	/* adjust volume */
1596	if (dsp->tx_volume)
1597		dsp_change_volume(nskb, dsp->tx_volume);
1598	/* pipeline */
1599	if (dsp->pipeline.inuse)
1600		dsp_pipeline_process_tx(&dsp->pipeline, nskb->data,
1601					nskb->len);
1602	/* crypt */
1603	if (dsp->bf_enable)
1604		dsp_bf_encrypt(dsp, nskb->data, nskb->len);
1605	/* queue and trigger */
1606	skb_queue_tail(&dsp->sendq, nskb);
1607	schedule_work(&dsp->workq);
1608}
1609
1610static u32	jittercount; /* counter for jitter check */
1611struct timer_list dsp_spl_tl;
1612unsigned long	dsp_spl_jiffies; /* calculate the next time to fire */
1613static u16	dsp_count; /* last sample count */
1614static int	dsp_count_valid; /* if we have last sample count */
1615
1616void
1617dsp_cmx_send(struct timer_list *arg)
1618{
1619	struct dsp_conf *conf;
1620	struct dsp_conf_member *member;
1621	struct dsp *dsp;
1622	int mustmix, members;
1623	static s32 mixbuffer[MAX_POLL + 100];
1624	s32 *c;
1625	u8 *p, *q;
1626	int r, rr;
1627	int jittercheck = 0, delay, i;
1628	u_long flags;
1629	u16 length, count;
1630
1631	/* lock */
1632	spin_lock_irqsave(&dsp_lock, flags);
1633
1634	if (!dsp_count_valid) {
1635		dsp_count = mISDN_clock_get();
1636		length = dsp_poll;
1637		dsp_count_valid = 1;
1638	} else {
1639		count = mISDN_clock_get();
1640		length = count - dsp_count;
1641		dsp_count = count;
1642	}
1643	if (length > MAX_POLL + 100)
1644		length = MAX_POLL + 100;
1645	/* printk(KERN_DEBUG "len=%d dsp_count=0x%x\n", length, dsp_count); */
1646
1647	/*
1648	 * check if jitter needs to be checked (this is every second)
1649	 */
1650	jittercount += length;
1651	if (jittercount >= 8000) {
1652		jittercount -= 8000;
1653		jittercheck = 1;
1654	}
1655
1656	/* loop all members that do not require conference mixing */
1657	list_for_each_entry(dsp, &dsp_ilist, list) {
1658		if (dsp->hdlc)
1659			continue;
1660		conf = dsp->conf;
1661		mustmix = 0;
1662		members = 0;
1663		if (conf) {
1664			members = list_count_nodes(&conf->mlist);
1665#ifdef CMX_CONF_DEBUG
1666			if (conf->software && members > 1)
1667#else
1668			if (conf->software && members > 2)
1669#endif
1670				mustmix = 1;
1671		}
1672
1673		/* transmission required */
1674		if (!mustmix) {
1675			dsp_cmx_send_member(dsp, length, mixbuffer, members);
1676
1677			/*
1678			 * unused mixbuffer is given to prevent a
1679			 * potential null-pointer-bug
1680			 */
1681		}
1682	}
1683
1684	/* loop all members that require conference mixing */
1685	list_for_each_entry(conf, &conf_ilist, list) {
1686		/* count members and check hardware */
1687		members = list_count_nodes(&conf->mlist);
1688#ifdef CMX_CONF_DEBUG
1689		if (conf->software && members > 1) {
1690#else
1691		if (conf->software && members > 2) {
1692#endif
1693			/* check for hdlc conf */
1694			member = list_entry(conf->mlist.next,
1695					    struct dsp_conf_member, list);
1696			if (member->dsp->hdlc)
1697				continue;
1698			/* mix all data */
1699			memset(mixbuffer, 0, length * sizeof(s32));
1700			list_for_each_entry(member, &conf->mlist, list) {
1701				dsp = member->dsp;
1702				/* get range of data to mix */
1703				c = mixbuffer;
1704				q = dsp->rx_buff;
1705				r = dsp->rx_R;
1706				rr = (r + length) & CMX_BUFF_MASK;
1707				/* add member's data */
1708				while (r != rr) {
1709					*c++ += dsp_audio_law_to_s32[q[r]];
1710					r = (r + 1) & CMX_BUFF_MASK;
1711				}
1712			}
1713
1714			/* process each member */
1715			list_for_each_entry(member, &conf->mlist, list) {
1716				/* transmission */
1717				dsp_cmx_send_member(member->dsp, length,
1718						    mixbuffer, members);
1719			}
1720		}
1721	}
1722
1723	/* delete rx-data, increment buffers, change pointers */
1724	list_for_each_entry(dsp, &dsp_ilist, list) {
1725		if (dsp->hdlc)
1726			continue;
1727		p = dsp->rx_buff;
1728		q = dsp->tx_buff;
1729		r = dsp->rx_R;
1730		/* move receive pointer when receiving */
1731		if (!dsp->rx_is_off) {
1732			rr = (r + length) & CMX_BUFF_MASK;
1733			/* delete rx-data */
1734			while (r != rr) {
1735				p[r] = dsp_silence;
1736				r = (r + 1) & CMX_BUFF_MASK;
1737			}
1738			/* increment rx-buffer pointer */
1739			dsp->rx_R = r; /* write incremented read pointer */
1740		}
1741
1742		/* check current rx_delay */
1743		delay = (dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK;
1744		if (delay >= CMX_BUFF_HALF)
1745			delay = 0; /* will be the delay before next write */
1746		/* check for lower delay */
1747		if (delay < dsp->rx_delay[0])
1748			dsp->rx_delay[0] = delay;
1749		/* check current tx_delay */
1750		delay = (dsp->tx_W-dsp->tx_R) & CMX_BUFF_MASK;
1751		if (delay >= CMX_BUFF_HALF)
1752			delay = 0; /* will be the delay before next write */
1753		/* check for lower delay */
1754		if (delay < dsp->tx_delay[0])
1755			dsp->tx_delay[0] = delay;
1756		if (jittercheck) {
1757			/* find the lowest of all rx_delays */
1758			delay = dsp->rx_delay[0];
1759			i = 1;
1760			while (i < MAX_SECONDS_JITTER_CHECK) {
1761				if (delay > dsp->rx_delay[i])
1762					delay = dsp->rx_delay[i];
1763				i++;
1764			}
1765			/*
1766			 * remove rx_delay only if we have delay AND we
1767			 * have not preset cmx_delay AND
1768			 * the delay is greater dsp_poll
1769			 */
1770			if (delay > dsp_poll && !dsp->cmx_delay) {
1771				if (dsp_debug & DEBUG_DSP_CLOCK)
1772					printk(KERN_DEBUG
1773					       "%s lowest rx_delay of %d bytes for"
1774					       " dsp %s are now removed.\n",
1775					       __func__, delay,
1776					       dsp->name);
1777				r = dsp->rx_R;
1778				rr = (r + delay - (dsp_poll >> 1))
1779					& CMX_BUFF_MASK;
1780				/* delete rx-data */
1781				while (r != rr) {
1782					p[r] = dsp_silence;
1783					r = (r + 1) & CMX_BUFF_MASK;
1784				}
1785				/* increment rx-buffer pointer */
1786				dsp->rx_R = r;
1787				/* write incremented read pointer */
1788			}
1789			/* find the lowest of all tx_delays */
1790			delay = dsp->tx_delay[0];
1791			i = 1;
1792			while (i < MAX_SECONDS_JITTER_CHECK) {
1793				if (delay > dsp->tx_delay[i])
1794					delay = dsp->tx_delay[i];
1795				i++;
1796			}
1797			/*
1798			 * remove delay only if we have delay AND we
1799			 * have enabled tx_dejitter
1800			 */
1801			if (delay > dsp_poll && dsp->tx_dejitter) {
1802				if (dsp_debug & DEBUG_DSP_CLOCK)
1803					printk(KERN_DEBUG
1804					       "%s lowest tx_delay of %d bytes for"
1805					       " dsp %s are now removed.\n",
1806					       __func__, delay,
1807					       dsp->name);
1808				r = dsp->tx_R;
1809				rr = (r + delay - (dsp_poll >> 1))
1810					& CMX_BUFF_MASK;
1811				/* delete tx-data */
1812				while (r != rr) {
1813					q[r] = dsp_silence;
1814					r = (r + 1) & CMX_BUFF_MASK;
1815				}
1816				/* increment rx-buffer pointer */
1817				dsp->tx_R = r;
1818				/* write incremented read pointer */
1819			}
1820			/* scroll up delays */
1821			i = MAX_SECONDS_JITTER_CHECK - 1;
1822			while (i) {
1823				dsp->rx_delay[i] = dsp->rx_delay[i - 1];
1824				dsp->tx_delay[i] = dsp->tx_delay[i - 1];
1825				i--;
1826			}
1827			dsp->tx_delay[0] = CMX_BUFF_HALF; /* (infinite) delay */
1828			dsp->rx_delay[0] = CMX_BUFF_HALF; /* (infinite) delay */
1829		}
1830	}
1831
1832	/* if next event would be in the past ... */
1833	if ((s32)(dsp_spl_jiffies + dsp_tics-jiffies) <= 0)
1834		dsp_spl_jiffies = jiffies + 1;
1835	else
1836		dsp_spl_jiffies += dsp_tics;
1837
1838	dsp_spl_tl.expires = dsp_spl_jiffies;
1839	add_timer(&dsp_spl_tl);
1840
1841	/* unlock */
1842	spin_unlock_irqrestore(&dsp_lock, flags);
1843}
1844
1845/*
1846 * audio data is transmitted from upper layer to the dsp
1847 */
1848void
1849dsp_cmx_transmit(struct dsp *dsp, struct sk_buff *skb)
1850{
1851	u_int w, ww;
1852	u8 *d, *p;
1853	int space; /* todo: , l = skb->len; */
1854#ifdef CMX_TX_DEBUG
1855	char debugbuf[256] = "";
1856#endif
1857
1858	/* check if there is enough space, and then copy */
1859	w = dsp->tx_W;
1860	ww = dsp->tx_R;
1861	p = dsp->tx_buff;
1862	d = skb->data;
1863	space = (ww - w - 1) & CMX_BUFF_MASK;
1864	/* write-pointer should not overrun nor reach read pointer */
1865	if (space < skb->len) {
1866		/* write to the space we have left */
1867		ww = (ww - 1) & CMX_BUFF_MASK; /* end one byte prior tx_R */
1868		if (dsp_debug & DEBUG_DSP_CLOCK)
1869			printk(KERN_DEBUG "%s: TX overflow space=%d skb->len="
1870			       "%d, w=0x%04x, ww=0x%04x\n", __func__, space,
1871			       skb->len, w, ww);
1872	} else
1873		/* write until all byte are copied */
1874		ww = (w + skb->len) & CMX_BUFF_MASK;
1875	dsp->tx_W = ww;
1876		/* show current buffer */
1877#ifdef CMX_DEBUG
1878	printk(KERN_DEBUG
1879	       "cmx_transmit(dsp=%lx) %d bytes to 0x%x-0x%x. %s\n",
1880	       (u_long)dsp, (ww - w) & CMX_BUFF_MASK, w, ww, dsp->name);
1881#endif
1882
1883	/* copy transmit data to tx-buffer */
1884#ifdef CMX_TX_DEBUG
1885	sprintf(debugbuf, "TX getting (%04x-%04x)%p: ", w, ww, p);
1886#endif
1887	while (w != ww) {
1888#ifdef CMX_TX_DEBUG
1889		if (strlen(debugbuf) < 48)
1890			sprintf(debugbuf + strlen(debugbuf), " %02x", *d);
1891#endif
1892		p[w] = *d++;
1893		w = (w + 1) & CMX_BUFF_MASK;
1894	}
1895#ifdef CMX_TX_DEBUG
1896	printk(KERN_DEBUG "%s\n", debugbuf);
1897#endif
1898
1899}
1900
1901/*
1902 * hdlc data is received from card and sent to all members.
1903 */
1904void
1905dsp_cmx_hdlc(struct dsp *dsp, struct sk_buff *skb)
1906{
1907	struct sk_buff *nskb = NULL;
1908	struct dsp_conf_member *member;
1909	struct mISDNhead *hh;
1910
1911	/* not if not active */
1912	if (!dsp->b_active)
1913		return;
1914
1915	/* check if we have sompen */
1916	if (skb->len < 1)
1917		return;
1918
1919	/* no conf */
1920	if (!dsp->conf) {
1921		/* in case of software echo */
1922		if (dsp->echo.software) {
1923			nskb = skb_clone(skb, GFP_ATOMIC);
1924			if (nskb) {
1925				hh = mISDN_HEAD_P(nskb);
1926				hh->prim = PH_DATA_REQ;
1927				hh->id = 0;
1928				skb_queue_tail(&dsp->sendq, nskb);
1929				schedule_work(&dsp->workq);
1930			}
1931		}
1932		return;
1933	}
1934	/* in case of hardware conference */
1935	if (dsp->conf->hardware)
1936		return;
1937	list_for_each_entry(member, &dsp->conf->mlist, list) {
1938		if (dsp->echo.software || member->dsp != dsp) {
1939			nskb = skb_clone(skb, GFP_ATOMIC);
1940			if (nskb) {
1941				hh = mISDN_HEAD_P(nskb);
1942				hh->prim = PH_DATA_REQ;
1943				hh->id = 0;
1944				skb_queue_tail(&member->dsp->sendq, nskb);
1945				schedule_work(&member->dsp->workq);
1946			}
1947		}
1948	}
1949}
v5.4
   1/*
   2 * Audio crossconnecting/conferrencing (hardware level).
   3 *
   4 * Copyright 2002 by Andreas Eversberg (jolly@eversberg.eu)
   5 *
   6 * This software may be used and distributed according to the terms
   7 * of the GNU General Public License, incorporated herein by reference.
   8 *
   9 */
  10
  11/*
  12 * The process of adding and removing parties to/from a conference:
  13 *
  14 * There is a chain of struct dsp_conf which has one or more members in a chain
  15 * of struct dsp_conf_member.
  16 *
  17 * After a party is added, the conference is checked for hardware capability.
  18 * Also if a party is removed, the conference is checked again.
  19 *
  20 * There are 3 different solutions: -1 = software, 0 = hardware-crossconnect
  21 * 1-n = hardware-conference. The n will give the conference number.
  22 *
  23 * Depending on the change after removal or insertion of a party, hardware
  24 * commands are given.
  25 *
  26 * The current solution is stored within the struct dsp_conf entry.
  27 */
  28
  29/*
  30 * HOW THE CMX WORKS:
  31 *
  32 * There are 3 types of interaction: One member is alone, in this case only
  33 * data flow from upper to lower layer is done.
  34 * Two members will also exchange their data so they are crossconnected.
  35 * Three or more members will be added in a conference and will hear each
  36 * other but will not receive their own speech (echo) if not enabled.
  37 *
  38 * Features of CMX are:
  39 *  - Crossconnecting or even conference, if more than two members are together.
  40 *  - Force mixing of transmit data with other crossconnect/conference members.
  41 *  - Echo generation to benchmark the delay of audio processing.
  42 *  - Use hardware to minimize cpu load, disable FIFO load and minimize delay.
  43 *  - Dejittering and clock generation.
  44 *
  45 * There are 2 buffers:
  46 *
  47 *
  48 * RX-Buffer
  49 *                 R             W
  50 *                 |             |
  51 * ----------------+-------------+-------------------
  52 *
  53 * The rx-buffer is a ring buffer used to store the received data for each
  54 * individual member. This is only the case if data needs to be dejittered
  55 * or in case of a conference where different clocks require reclocking.
  56 * The transmit-clock (R) will read the buffer.
  57 * If the clock overruns the write-pointer, we will have a buffer underrun.
  58 * If the write pointer always has a certain distance from the transmit-
  59 * clock, we will have a delay. The delay will dynamically be increased and
  60 * reduced.
  61 *
  62 *
  63 * TX-Buffer
  64 *                  R        W
  65 *                  |        |
  66 * -----------------+--------+-----------------------
  67 *
  68 * The tx-buffer is a ring buffer to queue the transmit data from user space
  69 * until it will be mixed or sent. There are two pointers, R and W. If the write
  70 * pointer W would reach or overrun R, the buffer would overrun. In this case
  71 * (some) data is dropped so that it will not overrun.
  72 * Additionally a dynamic dejittering can be enabled. this allows data from
  73 * user space that have jitter and different clock source.
  74 *
  75 *
  76 * Clock:
  77 *
  78 * A Clock is not required, if the data source has exactly one clock. In this
  79 * case the data source is forwarded to the destination.
  80 *
  81 * A Clock is required, because the data source
  82 *  - has multiple clocks.
  83 *  - has no usable clock due to jitter or packet loss (VoIP).
  84 * In this case the system's clock is used. The clock resolution depends on
  85 * the jiffie resolution.
  86 *
  87 * If a member joins a conference:
  88 *
  89 * - If a member joins, its rx_buff is set to silence and change read pointer
  90 *   to transmit clock.
  91 *
  92 * The procedure of received data from card is explained in cmx_receive.
  93 * The procedure of received data from user space is explained in cmx_transmit.
  94 * The procedure of transmit data to card is cmx_send.
  95 *
  96 *
  97 * Interaction with other features:
  98 *
  99 * DTMF:
 100 * DTMF decoding is done before the data is crossconnected.
 101 *
 102 * Volume change:
 103 * Changing rx-volume is done before the data is crossconnected. The tx-volume
 104 * must be changed whenever data is transmitted to the card by the cmx.
 105 *
 106 * Tones:
 107 * If a tone is enabled, it will be processed whenever data is transmitted to
 108 * the card. It will replace the tx-data from the user space.
 109 * If tones are generated by hardware, this conference member is removed for
 110 * this time.
 111 *
 112 * Disable rx-data:
 113 * If cmx is realized in hardware, rx data will be disabled if requested by
 114 * the upper layer. If dtmf decoding is done by software and enabled, rx data
 115 * will not be disabled but blocked to the upper layer.
 116 *
 117 * HFC conference engine:
 118 * If it is possible to realize all features using hardware, hardware will be
 119 * used if not forbidden by control command. Disabling rx-data provides
 120 * absolutely traffic free audio processing. (except for the quick 1-frame
 121 * upload of a tone loop, only once for a new tone)
 122 *
 123 */
 124
 125/* delay.h is required for hw_lock.h */
 126
 127#include <linux/slab.h>
 128#include <linux/delay.h>
 129#include <linux/mISDNif.h>
 130#include <linux/mISDNdsp.h>
 131#include "core.h"
 132#include "dsp.h"
 133/*
 134 * debugging of multi party conference,
 135 * by using conference even with two members
 136 */
 137
 138/* #define CMX_CONF_DEBUG */
 139
 140/*#define CMX_DEBUG * massive read/write pointer output */
 141/*#define CMX_DELAY_DEBUG * gives rx-buffer delay overview */
 142/*#define CMX_TX_DEBUG * massive read/write on tx-buffer with content */
 143
 144static inline int
 145count_list_member(struct list_head *head)
 146{
 147	int			cnt = 0;
 148	struct list_head	*m;
 149
 150	list_for_each(m, head)
 151		cnt++;
 152	return cnt;
 153}
 154
 155/*
 156 * debug cmx memory structure
 157 */
 158void
 159dsp_cmx_debug(struct dsp *dsp)
 160{
 161	struct dsp_conf	*conf;
 162	struct dsp_conf_member	*member;
 163	struct dsp		*odsp;
 164
 165	printk(KERN_DEBUG "-----Current DSP\n");
 166	list_for_each_entry(odsp, &dsp_ilist, list) {
 167		printk(KERN_DEBUG "* %s hardecho=%d softecho=%d txmix=%d",
 168		       odsp->name, odsp->echo.hardware, odsp->echo.software,
 169		       odsp->tx_mix);
 170		if (odsp->conf)
 171			printk(" (Conf %d)", odsp->conf->id);
 172		if (dsp == odsp)
 173			printk(" *this*");
 174		printk("\n");
 175	}
 176	printk(KERN_DEBUG "-----Current Conf:\n");
 177	list_for_each_entry(conf, &conf_ilist, list) {
 178		printk(KERN_DEBUG "* Conf %d (%p)\n", conf->id, conf);
 179		list_for_each_entry(member, &conf->mlist, list) {
 180			printk(KERN_DEBUG
 181			       "  - member = %s (slot_tx %d, bank_tx %d, "
 182			       "slot_rx %d, bank_rx %d hfc_conf %d "
 183			       "tx_data %d rx_is_off %d)%s\n",
 184			       member->dsp->name, member->dsp->pcm_slot_tx,
 185			       member->dsp->pcm_bank_tx, member->dsp->pcm_slot_rx,
 186			       member->dsp->pcm_bank_rx, member->dsp->hfc_conf,
 187			       member->dsp->tx_data, member->dsp->rx_is_off,
 188			       (member->dsp == dsp) ? " *this*" : "");
 189		}
 190	}
 191	printk(KERN_DEBUG "-----end\n");
 192}
 193
 194/*
 195 * search conference
 196 */
 197static struct dsp_conf *
 198dsp_cmx_search_conf(u32 id)
 199{
 200	struct dsp_conf *conf;
 201
 202	if (!id) {
 203		printk(KERN_WARNING "%s: conference ID is 0.\n", __func__);
 204		return NULL;
 205	}
 206
 207	/* search conference */
 208	list_for_each_entry(conf, &conf_ilist, list)
 209		if (conf->id == id)
 210			return conf;
 211
 212	return NULL;
 213}
 214
 215
 216/*
 217 * add member to conference
 218 */
 219static int
 220dsp_cmx_add_conf_member(struct dsp *dsp, struct dsp_conf *conf)
 221{
 222	struct dsp_conf_member *member;
 223
 224	if (!conf || !dsp) {
 225		printk(KERN_WARNING "%s: conf or dsp is 0.\n", __func__);
 226		return -EINVAL;
 227	}
 228	if (dsp->member) {
 229		printk(KERN_WARNING "%s: dsp is already member in a conf.\n",
 230		       __func__);
 231		return -EINVAL;
 232	}
 233
 234	if (dsp->conf) {
 235		printk(KERN_WARNING "%s: dsp is already in a conf.\n",
 236		       __func__);
 237		return -EINVAL;
 238	}
 239
 240	member = kzalloc(sizeof(struct dsp_conf_member), GFP_ATOMIC);
 241	if (!member) {
 242		printk(KERN_ERR "kzalloc struct dsp_conf_member failed\n");
 243		return -ENOMEM;
 244	}
 245	member->dsp = dsp;
 246	/* clear rx buffer */
 247	memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
 248	dsp->rx_init = 1; /* rx_W and rx_R will be adjusted on first frame */
 249	dsp->rx_W = 0;
 250	dsp->rx_R = 0;
 251
 252	list_add_tail(&member->list, &conf->mlist);
 253
 254	dsp->conf = conf;
 255	dsp->member = member;
 256
 257	return 0;
 258}
 259
 260
 261/*
 262 * del member from conference
 263 */
 264int
 265dsp_cmx_del_conf_member(struct dsp *dsp)
 266{
 267	struct dsp_conf_member *member;
 268
 269	if (!dsp) {
 270		printk(KERN_WARNING "%s: dsp is 0.\n",
 271		       __func__);
 272		return -EINVAL;
 273	}
 274
 275	if (!dsp->conf) {
 276		printk(KERN_WARNING "%s: dsp is not in a conf.\n",
 277		       __func__);
 278		return -EINVAL;
 279	}
 280
 281	if (list_empty(&dsp->conf->mlist)) {
 282		printk(KERN_WARNING "%s: dsp has linked an empty conf.\n",
 283		       __func__);
 284		return -EINVAL;
 285	}
 286
 287	/* find us in conf */
 288	list_for_each_entry(member, &dsp->conf->mlist, list) {
 289		if (member->dsp == dsp) {
 290			list_del(&member->list);
 291			dsp->conf = NULL;
 292			dsp->member = NULL;
 293			kfree(member);
 294			return 0;
 295		}
 296	}
 297	printk(KERN_WARNING
 298	       "%s: dsp is not present in its own conf_member list.\n",
 299	       __func__);
 300
 301	return -EINVAL;
 302}
 303
 304
 305/*
 306 * new conference
 307 */
 308static struct dsp_conf
 309*dsp_cmx_new_conf(u32 id)
 310{
 311	struct dsp_conf *conf;
 312
 313	if (!id) {
 314		printk(KERN_WARNING "%s: id is 0.\n",
 315		       __func__);
 316		return NULL;
 317	}
 318
 319	conf = kzalloc(sizeof(struct dsp_conf), GFP_ATOMIC);
 320	if (!conf) {
 321		printk(KERN_ERR "kzalloc struct dsp_conf failed\n");
 322		return NULL;
 323	}
 324	INIT_LIST_HEAD(&conf->mlist);
 325	conf->id = id;
 326
 327	list_add_tail(&conf->list, &conf_ilist);
 328
 329	return conf;
 330}
 331
 332
 333/*
 334 * del conference
 335 */
 336int
 337dsp_cmx_del_conf(struct dsp_conf *conf)
 338{
 339	if (!conf) {
 340		printk(KERN_WARNING "%s: conf is null.\n",
 341		       __func__);
 342		return -EINVAL;
 343	}
 344
 345	if (!list_empty(&conf->mlist)) {
 346		printk(KERN_WARNING "%s: conf not empty.\n",
 347		       __func__);
 348		return -EINVAL;
 349	}
 350	list_del(&conf->list);
 351	kfree(conf);
 352
 353	return 0;
 354}
 355
 356
 357/*
 358 * send HW message to hfc card
 359 */
 360static void
 361dsp_cmx_hw_message(struct dsp *dsp, u32 message, u32 param1, u32 param2,
 362		   u32 param3, u32 param4)
 363{
 364	struct mISDN_ctrl_req cq;
 365
 366	memset(&cq, 0, sizeof(cq));
 367	cq.op = message;
 368	cq.p1 = param1 | (param2 << 8);
 369	cq.p2 = param3 | (param4 << 8);
 370	if (dsp->ch.peer)
 371		dsp->ch.peer->ctrl(dsp->ch.peer, CONTROL_CHANNEL, &cq);
 372}
 373
 374
 375/*
 376 * do hardware update and set the software/hardware flag
 377 *
 378 * either a conference or a dsp instance can be given
 379 * if only dsp instance is given, the instance is not associated with a conf
 380 * and therefore removed. if a conference is given, the dsp is expected to
 381 * be member of that conference.
 382 */
 383void
 384dsp_cmx_hardware(struct dsp_conf *conf, struct dsp *dsp)
 385{
 386	struct dsp_conf_member	*member, *nextm;
 387	struct dsp		*finddsp;
 388	int		memb = 0, i, ii, i1, i2;
 389	int		freeunits[8];
 390	u_char		freeslots[256];
 391	int		same_hfc = -1, same_pcm = -1, current_conf = -1,
 392		all_conf = 1, tx_data = 0;
 393
 394	/* dsp gets updated (no conf) */
 395	if (!conf) {
 396		if (!dsp)
 397			return;
 398		if (dsp_debug & DEBUG_DSP_CMX)
 399			printk(KERN_DEBUG "%s checking dsp %s\n",
 400			       __func__, dsp->name);
 401	one_member:
 402		/* remove HFC conference if enabled */
 403		if (dsp->hfc_conf >= 0) {
 404			if (dsp_debug & DEBUG_DSP_CMX)
 405				printk(KERN_DEBUG
 406				       "%s removing %s from HFC conf %d "
 407				       "because dsp is split\n", __func__,
 408				       dsp->name, dsp->hfc_conf);
 409			dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_CONF_SPLIT,
 410					   0, 0, 0, 0);
 411			dsp->hfc_conf = -1;
 412		}
 413		/* process hw echo */
 414		if (dsp->features.pcm_banks < 1)
 415			return;
 416		if (!dsp->echo.software && !dsp->echo.hardware) {
 417			/* NO ECHO: remove PCM slot if assigned */
 418			if (dsp->pcm_slot_tx >= 0 || dsp->pcm_slot_rx >= 0) {
 419				if (dsp_debug & DEBUG_DSP_CMX)
 420					printk(KERN_DEBUG "%s removing %s from"
 421					       " PCM slot %d (TX) %d (RX) because"
 422					       " dsp is split (no echo)\n",
 423					       __func__, dsp->name,
 424					       dsp->pcm_slot_tx, dsp->pcm_slot_rx);
 425				dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_DISC,
 426						   0, 0, 0, 0);
 427				dsp->pcm_slot_tx = -1;
 428				dsp->pcm_bank_tx = -1;
 429				dsp->pcm_slot_rx = -1;
 430				dsp->pcm_bank_rx = -1;
 431			}
 432			return;
 433		}
 434		/* echo is enabled, find out if we use soft or hardware */
 435		dsp->echo.software = dsp->tx_data;
 436		dsp->echo.hardware = 0;
 437		/* ECHO: already echo */
 438		if (dsp->pcm_slot_tx >= 0 && dsp->pcm_slot_rx < 0 &&
 439		    dsp->pcm_bank_tx == 2 && dsp->pcm_bank_rx == 2) {
 440			dsp->echo.hardware = 1;
 441			return;
 442		}
 443		/* ECHO: if slot already assigned */
 444		if (dsp->pcm_slot_tx >= 0) {
 445			dsp->pcm_slot_rx = dsp->pcm_slot_tx;
 446			dsp->pcm_bank_tx = 2; /* 2 means loop */
 447			dsp->pcm_bank_rx = 2;
 448			if (dsp_debug & DEBUG_DSP_CMX)
 449				printk(KERN_DEBUG
 450				       "%s refresh %s for echo using slot %d\n",
 451				       __func__, dsp->name,
 452				       dsp->pcm_slot_tx);
 453			dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_CONN,
 454					   dsp->pcm_slot_tx, 2, dsp->pcm_slot_rx, 2);
 455			dsp->echo.hardware = 1;
 456			return;
 457		}
 458		/* ECHO: find slot */
 459		dsp->pcm_slot_tx = -1;
 460		dsp->pcm_slot_rx = -1;
 461		memset(freeslots, 1, sizeof(freeslots));
 462		list_for_each_entry(finddsp, &dsp_ilist, list) {
 463			if (finddsp->features.pcm_id == dsp->features.pcm_id) {
 464				if (finddsp->pcm_slot_rx >= 0 &&
 465				    finddsp->pcm_slot_rx < sizeof(freeslots))
 466					freeslots[finddsp->pcm_slot_rx] = 0;
 467				if (finddsp->pcm_slot_tx >= 0 &&
 468				    finddsp->pcm_slot_tx < sizeof(freeslots))
 469					freeslots[finddsp->pcm_slot_tx] = 0;
 470			}
 471		}
 472		i = 0;
 473		ii = dsp->features.pcm_slots;
 474		while (i < ii) {
 475			if (freeslots[i])
 476				break;
 477			i++;
 478		}
 479		if (i == ii) {
 480			if (dsp_debug & DEBUG_DSP_CMX)
 481				printk(KERN_DEBUG
 482				       "%s no slot available for echo\n",
 483				       __func__);
 484			/* no more slots available */
 485			dsp->echo.software = 1;
 486			return;
 487		}
 488		/* assign free slot */
 489		dsp->pcm_slot_tx = i;
 490		dsp->pcm_slot_rx = i;
 491		dsp->pcm_bank_tx = 2; /* loop */
 492		dsp->pcm_bank_rx = 2;
 493		if (dsp_debug & DEBUG_DSP_CMX)
 494			printk(KERN_DEBUG
 495			       "%s assign echo for %s using slot %d\n",
 496			       __func__, dsp->name, dsp->pcm_slot_tx);
 497		dsp_cmx_hw_message(dsp, MISDN_CTRL_HFC_PCM_CONN,
 498				   dsp->pcm_slot_tx, 2, dsp->pcm_slot_rx, 2);
 499		dsp->echo.hardware = 1;
 500		return;
 501	}
 502
 503	/* conf gets updated (all members) */
 504	if (dsp_debug & DEBUG_DSP_CMX)
 505		printk(KERN_DEBUG "%s checking conference %d\n",
 506		       __func__, conf->id);
 507
 508	if (list_empty(&conf->mlist)) {
 509		printk(KERN_ERR "%s: conference without members\n",
 510		       __func__);
 511		return;
 512	}
 513	member = list_entry(conf->mlist.next, struct dsp_conf_member, list);
 514	same_hfc = member->dsp->features.hfc_id;
 515	same_pcm = member->dsp->features.pcm_id;
 516	/* check all members in our conference */
 517	list_for_each_entry(member, &conf->mlist, list) {
 518		/* check if member uses mixing */
 519		if (member->dsp->tx_mix) {
 520			if (dsp_debug & DEBUG_DSP_CMX)
 521				printk(KERN_DEBUG
 522				       "%s dsp %s cannot form a conf, because "
 523				       "tx_mix is turned on\n", __func__,
 524				       member->dsp->name);
 525		conf_software:
 526			list_for_each_entry(member, &conf->mlist, list) {
 527				dsp = member->dsp;
 528				/* remove HFC conference if enabled */
 529				if (dsp->hfc_conf >= 0) {
 530					if (dsp_debug & DEBUG_DSP_CMX)
 531						printk(KERN_DEBUG
 532						       "%s removing %s from HFC "
 533						       "conf %d because not "
 534						       "possible with hardware\n",
 535						       __func__,
 536						       dsp->name,
 537						       dsp->hfc_conf);
 538					dsp_cmx_hw_message(dsp,
 539							   MISDN_CTRL_HFC_CONF_SPLIT,
 540							   0, 0, 0, 0);
 541					dsp->hfc_conf = -1;
 542				}
 543				/* remove PCM slot if assigned */
 544				if (dsp->pcm_slot_tx >= 0 ||
 545				    dsp->pcm_slot_rx >= 0) {
 546					if (dsp_debug & DEBUG_DSP_CMX)
 547						printk(KERN_DEBUG "%s removing "
 548						       "%s from PCM slot %d (TX)"
 549						       " slot %d (RX) because not"
 550						       " possible with hardware\n",
 551						       __func__,
 552						       dsp->name,
 553						       dsp->pcm_slot_tx,
 554						       dsp->pcm_slot_rx);
 555					dsp_cmx_hw_message(dsp,
 556							   MISDN_CTRL_HFC_PCM_DISC,
 557							   0, 0, 0, 0);
 558					dsp->pcm_slot_tx = -1;
 559					dsp->pcm_bank_tx = -1;
 560					dsp->pcm_slot_rx = -1;
 561					dsp->pcm_bank_rx = -1;
 562				}
 563			}
 564			conf->hardware = 0;
 565			conf->software = 1;
 566			return;
 567		}
 568		/* check if member has echo turned on */
 569		if (member->dsp->echo.hardware || member->dsp->echo.software) {
 570			if (dsp_debug & DEBUG_DSP_CMX)
 571				printk(KERN_DEBUG
 572				       "%s dsp %s cannot form a conf, because "
 573				       "echo is turned on\n", __func__,
 574				       member->dsp->name);
 575			goto conf_software;
 576		}
 577		/* check if member has tx_mix turned on */
 578		if (member->dsp->tx_mix) {
 579			if (dsp_debug & DEBUG_DSP_CMX)
 580				printk(KERN_DEBUG
 581				       "%s dsp %s cannot form a conf, because "
 582				       "tx_mix is turned on\n",
 583				       __func__, member->dsp->name);
 584			goto conf_software;
 585		}
 586		/* check if member changes volume at an not suppoted level */
 587		if (member->dsp->tx_volume) {
 588			if (dsp_debug & DEBUG_DSP_CMX)
 589				printk(KERN_DEBUG
 590				       "%s dsp %s cannot form a conf, because "
 591				       "tx_volume is changed\n",
 592				       __func__, member->dsp->name);
 593			goto conf_software;
 594		}
 595		if (member->dsp->rx_volume) {
 596			if (dsp_debug & DEBUG_DSP_CMX)
 597				printk(KERN_DEBUG
 598				       "%s dsp %s cannot form a conf, because "
 599				       "rx_volume is changed\n",
 600				       __func__, member->dsp->name);
 601			goto conf_software;
 602		}
 603		/* check if tx-data turned on */
 604		if (member->dsp->tx_data) {
 605			if (dsp_debug & DEBUG_DSP_CMX)
 606				printk(KERN_DEBUG
 607				       "%s dsp %s tx_data is turned on\n",
 608				       __func__, member->dsp->name);
 609			tx_data = 1;
 610		}
 611		/* check if pipeline exists */
 612		if (member->dsp->pipeline.inuse) {
 613			if (dsp_debug & DEBUG_DSP_CMX)
 614				printk(KERN_DEBUG
 615				       "%s dsp %s cannot form a conf, because "
 616				       "pipeline exists\n", __func__,
 617				       member->dsp->name);
 618			goto conf_software;
 619		}
 620		/* check if encryption is enabled */
 621		if (member->dsp->bf_enable) {
 622			if (dsp_debug & DEBUG_DSP_CMX)
 623				printk(KERN_DEBUG "%s dsp %s cannot form a "
 624				       "conf, because encryption is enabled\n",
 625				       __func__, member->dsp->name);
 626			goto conf_software;
 627		}
 628		/* check if member is on a card with PCM support */
 629		if (member->dsp->features.pcm_id < 0) {
 630			if (dsp_debug & DEBUG_DSP_CMX)
 631				printk(KERN_DEBUG
 632				       "%s dsp %s cannot form a conf, because "
 633				       "dsp has no PCM bus\n",
 634				       __func__, member->dsp->name);
 635			goto conf_software;
 636		}
 637		/* check if relations are on the same PCM bus */
 638		if (member->dsp->features.pcm_id != same_pcm) {
 639			if (dsp_debug & DEBUG_DSP_CMX)
 640				printk(KERN_DEBUG
 641				       "%s dsp %s cannot form a conf, because "
 642				       "dsp is on a different PCM bus than the "
 643				       "first dsp\n",
 644				       __func__, member->dsp->name);
 645			goto conf_software;
 646		}
 647		/* determine if members are on the same hfc chip */
 648		if (same_hfc != member->dsp->features.hfc_id)
 649			same_hfc = -1;
 650		/* if there are members already in a conference */
 651		if (current_conf < 0 && member->dsp->hfc_conf >= 0)
 652			current_conf = member->dsp->hfc_conf;
 653		/* if any member is not in a conference */
 654		if (member->dsp->hfc_conf < 0)
 655			all_conf = 0;
 656
 657		memb++;
 658	}
 659
 660	/* if no member, this is an error */
 661	if (memb < 1)
 662		return;
 663
 664	/* one member */
 665	if (memb == 1) {
 666		if (dsp_debug & DEBUG_DSP_CMX)
 667			printk(KERN_DEBUG
 668			       "%s conf %d cannot form a HW conference, "
 669			       "because dsp is alone\n", __func__, conf->id);
 670		conf->hardware = 0;
 671		conf->software = 0;
 672		member = list_entry(conf->mlist.next, struct dsp_conf_member,
 673				    list);
 674		dsp = member->dsp;
 675		goto one_member;
 676	}
 677
 678	/*
 679	 * ok, now we are sure that all members are on the same pcm.
 680	 * now we will see if we have only two members, so we can do
 681	 * crossconnections, which don't have any limitations.
 682	 */
 683
 684	/* if we have only two members */
 685	if (memb == 2) {
 686		member = list_entry(conf->mlist.next, struct dsp_conf_member,
 687				    list);
 688		nextm = list_entry(member->list.next, struct dsp_conf_member,
 689				   list);
 690		/* remove HFC conference if enabled */
 691		if (member->dsp->hfc_conf >= 0) {
 692			if (dsp_debug & DEBUG_DSP_CMX)
 693				printk(KERN_DEBUG
 694				       "%s removing %s from HFC conf %d because "
 695				       "two parties require only a PCM slot\n",
 696				       __func__, member->dsp->name,
 697				       member->dsp->hfc_conf);
 698			dsp_cmx_hw_message(member->dsp,
 699					   MISDN_CTRL_HFC_CONF_SPLIT, 0, 0, 0, 0);
 700			member->dsp->hfc_conf = -1;
 701		}
 702		if (nextm->dsp->hfc_conf >= 0) {
 703			if (dsp_debug & DEBUG_DSP_CMX)
 704				printk(KERN_DEBUG
 705				       "%s removing %s from HFC conf %d because "
 706				       "two parties require only a PCM slot\n",
 707				       __func__, nextm->dsp->name,
 708				       nextm->dsp->hfc_conf);
 709			dsp_cmx_hw_message(nextm->dsp,
 710					   MISDN_CTRL_HFC_CONF_SPLIT, 0, 0, 0, 0);
 711			nextm->dsp->hfc_conf = -1;
 712		}
 713		/* if members have two banks (and not on the same chip) */
 714		if (member->dsp->features.pcm_banks > 1 &&
 715		    nextm->dsp->features.pcm_banks > 1 &&
 716		    member->dsp->features.hfc_id !=
 717		    nextm->dsp->features.hfc_id) {
 718			/* if both members have same slots with crossed banks */
 719			if (member->dsp->pcm_slot_tx >= 0 &&
 720			    member->dsp->pcm_slot_rx >= 0 &&
 721			    nextm->dsp->pcm_slot_tx >= 0 &&
 722			    nextm->dsp->pcm_slot_rx >= 0 &&
 723			    nextm->dsp->pcm_slot_tx ==
 724			    member->dsp->pcm_slot_rx &&
 725			    nextm->dsp->pcm_slot_rx ==
 726			    member->dsp->pcm_slot_tx &&
 727			    nextm->dsp->pcm_slot_tx ==
 728			    member->dsp->pcm_slot_tx &&
 729			    member->dsp->pcm_bank_tx !=
 730			    member->dsp->pcm_bank_rx &&
 731			    nextm->dsp->pcm_bank_tx !=
 732			    nextm->dsp->pcm_bank_rx) {
 733				/* all members have same slot */
 734				if (dsp_debug & DEBUG_DSP_CMX)
 735					printk(KERN_DEBUG
 736					       "%s dsp %s & %s stay joined on "
 737					       "PCM slot %d bank %d (TX) bank %d "
 738					       "(RX) (on different chips)\n",
 739					       __func__,
 740					       member->dsp->name,
 741					       nextm->dsp->name,
 742					       member->dsp->pcm_slot_tx,
 743					       member->dsp->pcm_bank_tx,
 744					       member->dsp->pcm_bank_rx);
 745				conf->hardware = 1;
 746				conf->software = tx_data;
 747				return;
 748			}
 749			/* find a new slot */
 750			memset(freeslots, 1, sizeof(freeslots));
 751			list_for_each_entry(dsp, &dsp_ilist, list) {
 752				if (dsp != member->dsp &&
 753				    dsp != nextm->dsp &&
 754				    member->dsp->features.pcm_id ==
 755				    dsp->features.pcm_id) {
 756					if (dsp->pcm_slot_rx >= 0 &&
 757					    dsp->pcm_slot_rx <
 758					    sizeof(freeslots))
 759						freeslots[dsp->pcm_slot_rx] = 0;
 760					if (dsp->pcm_slot_tx >= 0 &&
 761					    dsp->pcm_slot_tx <
 762					    sizeof(freeslots))
 763						freeslots[dsp->pcm_slot_tx] = 0;
 764				}
 765			}
 766			i = 0;
 767			ii = member->dsp->features.pcm_slots;
 768			while (i < ii) {
 769				if (freeslots[i])
 770					break;
 771				i++;
 772			}
 773			if (i == ii) {
 774				if (dsp_debug & DEBUG_DSP_CMX)
 775					printk(KERN_DEBUG
 776					       "%s no slot available for "
 777					       "%s & %s\n", __func__,
 778					       member->dsp->name,
 779					       nextm->dsp->name);
 780				/* no more slots available */
 781				goto conf_software;
 782			}
 783			/* assign free slot */
 784			member->dsp->pcm_slot_tx = i;
 785			member->dsp->pcm_slot_rx = i;
 786			nextm->dsp->pcm_slot_tx = i;
 787			nextm->dsp->pcm_slot_rx = i;
 788			member->dsp->pcm_bank_rx = 0;
 789			member->dsp->pcm_bank_tx = 1;
 790			nextm->dsp->pcm_bank_rx = 1;
 791			nextm->dsp->pcm_bank_tx = 0;
 792			if (dsp_debug & DEBUG_DSP_CMX)
 793				printk(KERN_DEBUG
 794				       "%s adding %s & %s to new PCM slot %d "
 795				       "(TX and RX on different chips) because "
 796				       "both members have not same slots\n",
 797				       __func__,
 798				       member->dsp->name,
 799				       nextm->dsp->name,
 800				       member->dsp->pcm_slot_tx);
 801			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
 802					   member->dsp->pcm_slot_tx, member->dsp->pcm_bank_tx,
 803					   member->dsp->pcm_slot_rx, member->dsp->pcm_bank_rx);
 804			dsp_cmx_hw_message(nextm->dsp, MISDN_CTRL_HFC_PCM_CONN,
 805					   nextm->dsp->pcm_slot_tx, nextm->dsp->pcm_bank_tx,
 806					   nextm->dsp->pcm_slot_rx, nextm->dsp->pcm_bank_rx);
 807			conf->hardware = 1;
 808			conf->software = tx_data;
 809			return;
 810			/* if members have one bank (or on the same chip) */
 811		} else {
 812			/* if both members have different crossed slots */
 813			if (member->dsp->pcm_slot_tx >= 0 &&
 814			    member->dsp->pcm_slot_rx >= 0 &&
 815			    nextm->dsp->pcm_slot_tx >= 0 &&
 816			    nextm->dsp->pcm_slot_rx >= 0 &&
 817			    nextm->dsp->pcm_slot_tx ==
 818			    member->dsp->pcm_slot_rx &&
 819			    nextm->dsp->pcm_slot_rx ==
 820			    member->dsp->pcm_slot_tx &&
 821			    member->dsp->pcm_slot_tx !=
 822			    member->dsp->pcm_slot_rx &&
 823			    member->dsp->pcm_bank_tx == 0 &&
 824			    member->dsp->pcm_bank_rx == 0 &&
 825			    nextm->dsp->pcm_bank_tx == 0 &&
 826			    nextm->dsp->pcm_bank_rx == 0) {
 827				/* all members have same slot */
 828				if (dsp_debug & DEBUG_DSP_CMX)
 829					printk(KERN_DEBUG
 830					       "%s dsp %s & %s stay joined on PCM "
 831					       "slot %d (TX) %d (RX) on same chip "
 832					       "or one bank PCM)\n", __func__,
 833					       member->dsp->name,
 834					       nextm->dsp->name,
 835					       member->dsp->pcm_slot_tx,
 836					       member->dsp->pcm_slot_rx);
 837				conf->hardware = 1;
 838				conf->software = tx_data;
 839				return;
 840			}
 841			/* find two new slot */
 842			memset(freeslots, 1, sizeof(freeslots));
 843			list_for_each_entry(dsp, &dsp_ilist, list) {
 844				if (dsp != member->dsp &&
 845				    dsp != nextm->dsp &&
 846				    member->dsp->features.pcm_id ==
 847				    dsp->features.pcm_id) {
 848					if (dsp->pcm_slot_rx >= 0 &&
 849					    dsp->pcm_slot_rx <
 850					    sizeof(freeslots))
 851						freeslots[dsp->pcm_slot_rx] = 0;
 852					if (dsp->pcm_slot_tx >= 0 &&
 853					    dsp->pcm_slot_tx <
 854					    sizeof(freeslots))
 855						freeslots[dsp->pcm_slot_tx] = 0;
 856				}
 857			}
 858			i1 = 0;
 859			ii = member->dsp->features.pcm_slots;
 860			while (i1 < ii) {
 861				if (freeslots[i1])
 862					break;
 863				i1++;
 864			}
 865			if (i1 == ii) {
 866				if (dsp_debug & DEBUG_DSP_CMX)
 867					printk(KERN_DEBUG
 868					       "%s no slot available "
 869					       "for %s & %s\n", __func__,
 870					       member->dsp->name,
 871					       nextm->dsp->name);
 872				/* no more slots available */
 873				goto conf_software;
 874			}
 875			i2 = i1 + 1;
 876			while (i2 < ii) {
 877				if (freeslots[i2])
 878					break;
 879				i2++;
 880			}
 881			if (i2 == ii) {
 882				if (dsp_debug & DEBUG_DSP_CMX)
 883					printk(KERN_DEBUG
 884					       "%s no slot available "
 885					       "for %s & %s\n",
 886					       __func__,
 887					       member->dsp->name,
 888					       nextm->dsp->name);
 889				/* no more slots available */
 890				goto conf_software;
 891			}
 892			/* assign free slots */
 893			member->dsp->pcm_slot_tx = i1;
 894			member->dsp->pcm_slot_rx = i2;
 895			nextm->dsp->pcm_slot_tx = i2;
 896			nextm->dsp->pcm_slot_rx = i1;
 897			member->dsp->pcm_bank_rx = 0;
 898			member->dsp->pcm_bank_tx = 0;
 899			nextm->dsp->pcm_bank_rx = 0;
 900			nextm->dsp->pcm_bank_tx = 0;
 901			if (dsp_debug & DEBUG_DSP_CMX)
 902				printk(KERN_DEBUG
 903				       "%s adding %s & %s to new PCM slot %d "
 904				       "(TX) %d (RX) on same chip or one bank "
 905				       "PCM, because both members have not "
 906				       "crossed slots\n", __func__,
 907				       member->dsp->name,
 908				       nextm->dsp->name,
 909				       member->dsp->pcm_slot_tx,
 910				       member->dsp->pcm_slot_rx);
 911			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
 912					   member->dsp->pcm_slot_tx, member->dsp->pcm_bank_tx,
 913					   member->dsp->pcm_slot_rx, member->dsp->pcm_bank_rx);
 914			dsp_cmx_hw_message(nextm->dsp, MISDN_CTRL_HFC_PCM_CONN,
 915					   nextm->dsp->pcm_slot_tx, nextm->dsp->pcm_bank_tx,
 916					   nextm->dsp->pcm_slot_rx, nextm->dsp->pcm_bank_rx);
 917			conf->hardware = 1;
 918			conf->software = tx_data;
 919			return;
 920		}
 921	}
 922
 923	/*
 924	 * if we have more than two, we may check if we have a conference
 925	 * unit available on the chip. also all members must be on the same
 926	 */
 927
 928	/* if not the same HFC chip */
 929	if (same_hfc < 0) {
 930		if (dsp_debug & DEBUG_DSP_CMX)
 931			printk(KERN_DEBUG
 932			       "%s conference %d cannot be formed, because "
 933			       "members are on different chips or not "
 934			       "on HFC chip\n",
 935			       __func__, conf->id);
 936		goto conf_software;
 937	}
 938
 939	/* for more than two members.. */
 940
 941	/* if all members already have the same conference */
 942	if (all_conf) {
 943		conf->hardware = 1;
 944		conf->software = tx_data;
 945		return;
 946	}
 947
 948	/*
 949	 * if there is an existing conference, but not all members have joined
 950	 */
 951	if (current_conf >= 0) {
 952	join_members:
 953		list_for_each_entry(member, &conf->mlist, list) {
 954			/* if no conference engine on our chip, change to
 955			 * software */
 956			if (!member->dsp->features.hfc_conf)
 957				goto conf_software;
 958			/* in case of hdlc, change to software */
 959			if (member->dsp->hdlc)
 960				goto conf_software;
 961			/* join to current conference */
 962			if (member->dsp->hfc_conf == current_conf)
 963				continue;
 964			/* get a free timeslot first */
 965			memset(freeslots, 1, sizeof(freeslots));
 966			list_for_each_entry(dsp, &dsp_ilist, list) {
 967				/*
 968				 * not checking current member, because
 969				 * slot will be overwritten.
 970				 */
 971				if (
 972					dsp != member->dsp &&
 973					/* dsp must be on the same PCM */
 974					member->dsp->features.pcm_id ==
 975					dsp->features.pcm_id) {
 976					/* dsp must be on a slot */
 977					if (dsp->pcm_slot_tx >= 0 &&
 978					    dsp->pcm_slot_tx <
 979					    sizeof(freeslots))
 980						freeslots[dsp->pcm_slot_tx] = 0;
 981					if (dsp->pcm_slot_rx >= 0 &&
 982					    dsp->pcm_slot_rx <
 983					    sizeof(freeslots))
 984						freeslots[dsp->pcm_slot_rx] = 0;
 985				}
 986			}
 987			i = 0;
 988			ii = member->dsp->features.pcm_slots;
 989			while (i < ii) {
 990				if (freeslots[i])
 991					break;
 992				i++;
 993			}
 994			if (i == ii) {
 995				/* no more slots available */
 996				if (dsp_debug & DEBUG_DSP_CMX)
 997					printk(KERN_DEBUG
 998					       "%s conference %d cannot be formed,"
 999					       " because no slot free\n",
1000					       __func__, conf->id);
1001				goto conf_software;
1002			}
1003			if (dsp_debug & DEBUG_DSP_CMX)
1004				printk(KERN_DEBUG
1005				       "%s changing dsp %s to HW conference "
1006				       "%d slot %d\n", __func__,
1007				       member->dsp->name, current_conf, i);
1008			/* assign free slot & set PCM & join conf */
1009			member->dsp->pcm_slot_tx = i;
1010			member->dsp->pcm_slot_rx = i;
1011			member->dsp->pcm_bank_tx = 2; /* loop */
1012			member->dsp->pcm_bank_rx = 2;
1013			member->dsp->hfc_conf = current_conf;
1014			dsp_cmx_hw_message(member->dsp, MISDN_CTRL_HFC_PCM_CONN,
1015					   i, 2, i, 2);
1016			dsp_cmx_hw_message(member->dsp,
1017					   MISDN_CTRL_HFC_CONF_JOIN, current_conf, 0, 0, 0);
1018		}
1019		conf->hardware = 1;
1020		conf->software = tx_data;
1021		return;
1022	}
1023
1024	/*
1025	 * no member is in a conference yet, so we find a free one
1026	 */
1027	memset(freeunits, 1, sizeof(freeunits));
1028	list_for_each_entry(dsp, &dsp_ilist, list) {
1029		/* dsp must be on the same chip */
1030		if (dsp->features.hfc_id == same_hfc &&
1031		    /* dsp must have joined a HW conference */
1032		    dsp->hfc_conf >= 0 &&
1033		    /* slot must be within range */
1034		    dsp->hfc_conf < 8)
1035			freeunits[dsp->hfc_conf] = 0;
1036	}
1037	i = 0;
1038	ii = 8;
1039	while (i < ii) {
1040		if (freeunits[i])
1041			break;
1042		i++;
1043	}
1044	if (i == ii) {
1045		/* no more conferences available */
1046		if (dsp_debug & DEBUG_DSP_CMX)
1047			printk(KERN_DEBUG
1048			       "%s conference %d cannot be formed, because "
1049			       "no conference number free\n",
1050			       __func__, conf->id);
1051		goto conf_software;
1052	}
1053	/* join all members */
1054	current_conf = i;
1055	goto join_members;
1056}
1057
1058
1059/*
1060 * conf_id != 0: join or change conference
1061 * conf_id == 0: split from conference if not already
1062 */
1063int
1064dsp_cmx_conf(struct dsp *dsp, u32 conf_id)
1065{
1066	int err;
1067	struct dsp_conf *conf;
1068	struct dsp_conf_member	*member;
1069
1070	/* if conference doesn't change */
1071	if (dsp->conf_id == conf_id)
1072		return 0;
1073
1074	/* first remove us from current conf */
1075	if (dsp->conf_id) {
1076		if (dsp_debug & DEBUG_DSP_CMX)
1077			printk(KERN_DEBUG "removing us from conference %d\n",
1078			       dsp->conf->id);
1079		/* remove us from conf */
1080		conf = dsp->conf;
1081		err = dsp_cmx_del_conf_member(dsp);
1082		if (err)
1083			return err;
1084		dsp->conf_id = 0;
1085
1086		/* update hardware */
1087		dsp_cmx_hardware(NULL, dsp);
1088
1089		/* conf now empty? */
1090		if (list_empty(&conf->mlist)) {
1091			if (dsp_debug & DEBUG_DSP_CMX)
1092				printk(KERN_DEBUG
1093				       "conference is empty, so we remove it.\n");
1094			err = dsp_cmx_del_conf(conf);
1095			if (err)
1096				return err;
1097		} else {
1098			/* update members left on conf */
1099			dsp_cmx_hardware(conf, NULL);
1100		}
1101	}
1102
1103	/* if split */
1104	if (!conf_id)
1105		return 0;
1106
1107	/* now add us to conf */
1108	if (dsp_debug & DEBUG_DSP_CMX)
1109		printk(KERN_DEBUG "searching conference %d\n",
1110		       conf_id);
1111	conf = dsp_cmx_search_conf(conf_id);
1112	if (!conf) {
1113		if (dsp_debug & DEBUG_DSP_CMX)
1114			printk(KERN_DEBUG
1115			       "conference doesn't exist yet, creating.\n");
1116		/* the conference doesn't exist, so we create */
1117		conf = dsp_cmx_new_conf(conf_id);
1118		if (!conf)
1119			return -EINVAL;
1120	} else if (!list_empty(&conf->mlist)) {
1121		member = list_entry(conf->mlist.next, struct dsp_conf_member,
1122				    list);
1123		if (dsp->hdlc && !member->dsp->hdlc) {
1124			if (dsp_debug & DEBUG_DSP_CMX)
1125				printk(KERN_DEBUG
1126				       "cannot join transparent conference.\n");
1127			return -EINVAL;
1128		}
1129		if (!dsp->hdlc && member->dsp->hdlc) {
1130			if (dsp_debug & DEBUG_DSP_CMX)
1131				printk(KERN_DEBUG
1132				       "cannot join hdlc conference.\n");
1133			return -EINVAL;
1134		}
1135	}
1136	/* add conference member */
1137	err = dsp_cmx_add_conf_member(dsp, conf);
1138	if (err)
1139		return err;
1140	dsp->conf_id = conf_id;
1141
1142	/* if we are alone, we do nothing! */
1143	if (list_empty(&conf->mlist)) {
1144		if (dsp_debug & DEBUG_DSP_CMX)
1145			printk(KERN_DEBUG
1146			       "we are alone in this conference, so exit.\n");
1147		/* update hardware */
1148		dsp_cmx_hardware(NULL, dsp);
1149		return 0;
1150	}
1151
1152	/* update members on conf */
1153	dsp_cmx_hardware(conf, NULL);
1154
1155	return 0;
1156}
1157
1158#ifdef CMX_DELAY_DEBUG
1159int delaycount;
1160static void
1161showdelay(struct dsp *dsp, int samples, int delay)
1162{
1163	char bar[] = "--------------------------------------------------|";
1164	int sdelay;
1165
1166	delaycount += samples;
1167	if (delaycount < 8000)
1168		return;
1169	delaycount = 0;
1170
1171	sdelay = delay * 50 / (dsp_poll << 2);
1172
1173	printk(KERN_DEBUG "DELAY (%s) %3d >%s\n", dsp->name, delay,
1174	       sdelay > 50 ? "..." : bar + 50 - sdelay);
1175}
1176#endif
1177
1178/*
1179 * audio data is received from card
1180 */
1181void
1182dsp_cmx_receive(struct dsp *dsp, struct sk_buff *skb)
1183{
1184	u8 *d, *p;
1185	int len = skb->len;
1186	struct mISDNhead *hh = mISDN_HEAD_P(skb);
1187	int w, i, ii;
1188
1189	/* check if we have sompen */
1190	if (len < 1)
1191		return;
1192
1193	/* half of the buffer should be larger than maximum packet size */
1194	if (len >= CMX_BUFF_HALF) {
1195		printk(KERN_ERR
1196		       "%s line %d: packet from card is too large (%d bytes). "
1197		       "please make card send smaller packets OR increase "
1198		       "CMX_BUFF_SIZE\n", __FILE__, __LINE__, len);
1199		return;
1200	}
1201
1202	/*
1203	 * initialize pointers if not already -
1204	 * also add delay if requested by PH_SIGNAL
1205	 */
1206	if (dsp->rx_init) {
1207		dsp->rx_init = 0;
1208		if (dsp->features.unordered) {
1209			dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1210			if (dsp->cmx_delay)
1211				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1212					& CMX_BUFF_MASK;
1213			else
1214				dsp->rx_W = (dsp->rx_R + (dsp_poll >> 1))
1215					& CMX_BUFF_MASK;
1216		} else {
1217			dsp->rx_R = 0;
1218			if (dsp->cmx_delay)
1219				dsp->rx_W = dsp->cmx_delay;
1220			else
1221				dsp->rx_W = dsp_poll >> 1;
1222		}
1223	}
1224	/* if frame contains time code, write directly */
1225	if (dsp->features.unordered) {
1226		dsp->rx_W = (hh->id & CMX_BUFF_MASK);
1227		/* printk(KERN_DEBUG "%s %08x\n", dsp->name, hh->id); */
1228	}
1229	/*
1230	 * if we underrun (or maybe overrun),
1231	 * we set our new read pointer, and write silence to buffer
1232	 */
1233	if (((dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK) >= CMX_BUFF_HALF) {
1234		if (dsp_debug & DEBUG_DSP_CLOCK)
1235			printk(KERN_DEBUG
1236			       "cmx_receive(dsp=%lx): UNDERRUN (or overrun the "
1237			       "maximum delay), adjusting read pointer! "
1238			       "(inst %s)\n", (u_long)dsp, dsp->name);
1239		/* flush rx buffer and set delay to dsp_poll / 2 */
1240		if (dsp->features.unordered) {
1241			dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1242			if (dsp->cmx_delay)
1243				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1244					& CMX_BUFF_MASK;
1245			else
1246				dsp->rx_W = (dsp->rx_R + (dsp_poll >> 1))
1247					& CMX_BUFF_MASK;
1248		} else {
1249			dsp->rx_R = 0;
1250			if (dsp->cmx_delay)
1251				dsp->rx_W = dsp->cmx_delay;
1252			else
1253				dsp->rx_W = dsp_poll >> 1;
1254		}
1255		memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
1256	}
1257	/* if we have reached double delay, jump back to middle */
1258	if (dsp->cmx_delay)
1259		if (((dsp->rx_W - dsp->rx_R) & CMX_BUFF_MASK) >=
1260		    (dsp->cmx_delay << 1)) {
1261			if (dsp_debug & DEBUG_DSP_CLOCK)
1262				printk(KERN_DEBUG
1263				       "cmx_receive(dsp=%lx): OVERRUN (because "
1264				       "twice the delay is reached), adjusting "
1265				       "read pointer! (inst %s)\n",
1266				       (u_long)dsp, dsp->name);
1267			/* flush buffer */
1268			if (dsp->features.unordered) {
1269				dsp->rx_R = (hh->id & CMX_BUFF_MASK);
1270				dsp->rx_W = (dsp->rx_R + dsp->cmx_delay)
1271					& CMX_BUFF_MASK;
1272			} else {
1273				dsp->rx_R = 0;
1274				dsp->rx_W = dsp->cmx_delay;
1275			}
1276			memset(dsp->rx_buff, dsp_silence, sizeof(dsp->rx_buff));
1277		}
1278
1279	/* show where to write */
1280#ifdef CMX_DEBUG
1281	printk(KERN_DEBUG
1282	       "cmx_receive(dsp=%lx): rx_R(dsp)=%05x rx_W(dsp)=%05x len=%d %s\n",
1283	       (u_long)dsp, dsp->rx_R, dsp->rx_W, len, dsp->name);
1284#endif
1285
1286	/* write data into rx_buffer */
1287	p = skb->data;
1288	d = dsp->rx_buff;
1289	w = dsp->rx_W;
1290	i = 0;
1291	ii = len;
1292	while (i < ii) {
1293		d[w++ & CMX_BUFF_MASK] = *p++;
1294		i++;
1295	}
1296
1297	/* increase write-pointer */
1298	dsp->rx_W = ((dsp->rx_W + len) & CMX_BUFF_MASK);
1299#ifdef CMX_DELAY_DEBUG
1300	showdelay(dsp, len, (dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK);
1301#endif
1302}
1303
1304
1305/*
1306 * send (mixed) audio data to card and control jitter
1307 */
1308static void
1309dsp_cmx_send_member(struct dsp *dsp, int len, s32 *c, int members)
1310{
1311	struct dsp_conf *conf = dsp->conf;
1312	struct dsp *member, *other;
1313	register s32 sample;
1314	u8 *d, *p, *q, *o_q;
1315	struct sk_buff *nskb, *txskb;
1316	int r, rr, t, tt, o_r, o_rr;
1317	int preload = 0;
1318	struct mISDNhead *hh, *thh;
1319	int tx_data_only = 0;
1320
1321	/* don't process if: */
1322	if (!dsp->b_active) { /* if not active */
1323		dsp->last_tx = 0;
1324		return;
1325	}
1326	if (((dsp->conf && dsp->conf->hardware) || /* hardware conf */
1327	     dsp->echo.hardware) && /* OR hardware echo */
1328	    dsp->tx_R == dsp->tx_W && /* AND no tx-data */
1329	    !(dsp->tone.tone && dsp->tone.software)) { /* AND not soft tones */
1330		if (!dsp->tx_data) { /* no tx_data for user space required */
1331			dsp->last_tx = 0;
1332			return;
1333		}
1334		if (dsp->conf && dsp->conf->software && dsp->conf->hardware)
1335			tx_data_only = 1;
1336		if (dsp->echo.software && dsp->echo.hardware)
1337			tx_data_only = 1;
1338	}
1339
1340#ifdef CMX_DEBUG
1341	printk(KERN_DEBUG
1342	       "SEND members=%d dsp=%s, conf=%p, rx_R=%05x rx_W=%05x\n",
1343	       members, dsp->name, conf, dsp->rx_R, dsp->rx_W);
1344#endif
1345
1346	/* preload if we have delay set */
1347	if (dsp->cmx_delay && !dsp->last_tx) {
1348		preload = len;
1349		if (preload < 128)
1350			preload = 128;
1351	}
1352
1353	/* PREPARE RESULT */
1354	nskb = mI_alloc_skb(len + preload, GFP_ATOMIC);
1355	if (!nskb) {
1356		printk(KERN_ERR
1357		       "FATAL ERROR in mISDN_dsp.o: cannot alloc %d bytes\n",
1358		       len + preload);
1359		return;
1360	}
1361	hh = mISDN_HEAD_P(nskb);
1362	hh->prim = PH_DATA_REQ;
1363	hh->id = 0;
1364	dsp->last_tx = 1;
1365
1366	/* set pointers, indexes and stuff */
1367	member = dsp;
1368	p = dsp->tx_buff; /* transmit data */
1369	q = dsp->rx_buff; /* received data */
1370	d = skb_put(nskb, preload + len); /* result */
1371	t = dsp->tx_R; /* tx-pointers */
1372	tt = dsp->tx_W;
1373	r = dsp->rx_R; /* rx-pointers */
1374	rr = (r + len) & CMX_BUFF_MASK;
1375
1376	/* preload with silence, if required */
1377	if (preload) {
1378		memset(d, dsp_silence, preload);
1379		d += preload;
1380	}
1381
1382	/* PROCESS TONES/TX-DATA ONLY */
1383	if (dsp->tone.tone && dsp->tone.software) {
1384		/* -> copy tone */
1385		dsp_tone_copy(dsp, d, len);
1386		dsp->tx_R = 0; /* clear tx buffer */
1387		dsp->tx_W = 0;
1388		goto send_packet;
1389	}
1390	/* if we have tx-data but do not use mixing */
1391	if (!dsp->tx_mix && t != tt) {
1392		/* -> send tx-data and continue when not enough */
1393#ifdef CMX_TX_DEBUG
1394		sprintf(debugbuf, "TX sending (%04x-%04x)%p: ", t, tt, p);
1395#endif
1396		while (r != rr && t != tt) {
1397#ifdef CMX_TX_DEBUG
1398			if (strlen(debugbuf) < 48)
1399				sprintf(debugbuf + strlen(debugbuf), " %02x",
1400					p[t]);
1401#endif
1402			*d++ = p[t]; /* write tx_buff */
1403			t = (t + 1) & CMX_BUFF_MASK;
1404			r = (r + 1) & CMX_BUFF_MASK;
1405		}
1406		if (r == rr) {
1407			dsp->tx_R = t;
1408#ifdef CMX_TX_DEBUG
1409			printk(KERN_DEBUG "%s\n", debugbuf);
1410#endif
1411			goto send_packet;
1412		}
1413	}
1414#ifdef CMX_TX_DEBUG
1415	printk(KERN_DEBUG "%s\n", debugbuf);
1416#endif
1417
1418	/* PROCESS DATA (one member / no conf) */
1419	if (!conf || members <= 1) {
1420		/* -> if echo is NOT enabled */
1421		if (!dsp->echo.software) {
1422			/* -> send tx-data if available or use 0-volume */
1423			while (r != rr && t != tt) {
1424				*d++ = p[t]; /* write tx_buff */
1425				t = (t + 1) & CMX_BUFF_MASK;
1426				r = (r + 1) & CMX_BUFF_MASK;
1427			}
1428			if (r != rr) {
1429				if (dsp_debug & DEBUG_DSP_CLOCK)
1430					printk(KERN_DEBUG "%s: RX empty\n",
1431					       __func__);
1432				memset(d, dsp_silence, (rr - r) & CMX_BUFF_MASK);
1433			}
1434			/* -> if echo is enabled */
1435		} else {
1436			/*
1437			 * -> mix tx-data with echo if available,
1438			 * or use echo only
1439			 */
1440			while (r != rr && t != tt) {
1441				*d++ = dsp_audio_mix_law[(p[t] << 8) | q[r]];
1442				t = (t + 1) & CMX_BUFF_MASK;
1443				r = (r + 1) & CMX_BUFF_MASK;
1444			}
1445			while (r != rr) {
1446				*d++ = q[r]; /* echo */
1447				r = (r + 1) & CMX_BUFF_MASK;
1448			}
1449		}
1450		dsp->tx_R = t;
1451		goto send_packet;
1452	}
1453	/* PROCESS DATA (two members) */
1454#ifdef CMX_CONF_DEBUG
1455	if (0) {
1456#else
1457	if (members == 2) {
1458#endif
1459		/* "other" becomes other party */
1460		other = (list_entry(conf->mlist.next,
1461				    struct dsp_conf_member, list))->dsp;
1462		if (other == member)
1463			other = (list_entry(conf->mlist.prev,
1464				    struct dsp_conf_member, list))->dsp;
1465		o_q = other->rx_buff; /* received data */
1466		o_rr = (other->rx_R + len) & CMX_BUFF_MASK;
1467		/* end of rx-pointer */
1468		o_r = (o_rr - rr + r) & CMX_BUFF_MASK;
1469		/* start rx-pointer at current read position*/
1470		/* -> if echo is NOT enabled */
1471		if (!dsp->echo.software) {
1472			/*
1473			 * -> copy other member's rx-data,
1474			 * if tx-data is available, mix
1475			 */
1476			while (o_r != o_rr && t != tt) {
1477				*d++ = dsp_audio_mix_law[(p[t] << 8) | o_q[o_r]];
1478				t = (t + 1) & CMX_BUFF_MASK;
1479				o_r = (o_r + 1) & CMX_BUFF_MASK;
1480			}
1481			while (o_r != o_rr) {
1482				*d++ = o_q[o_r];
1483				o_r = (o_r + 1) & CMX_BUFF_MASK;
1484			}
1485			/* -> if echo is enabled */
1486		} else {
1487			/*
1488			 * -> mix other member's rx-data with echo,
1489			 * if tx-data is available, mix
1490			 */
1491			while (r != rr && t != tt) {
1492				sample = dsp_audio_law_to_s32[p[t]] +
1493					dsp_audio_law_to_s32[q[r]] +
1494					dsp_audio_law_to_s32[o_q[o_r]];
1495				if (sample < -32768)
1496					sample = -32768;
1497				else if (sample > 32767)
1498					sample = 32767;
1499				*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1500				/* tx-data + rx_data + echo */
1501				t = (t + 1) & CMX_BUFF_MASK;
1502				r = (r + 1) & CMX_BUFF_MASK;
1503				o_r = (o_r + 1) & CMX_BUFF_MASK;
1504			}
1505			while (r != rr) {
1506				*d++ = dsp_audio_mix_law[(q[r] << 8) | o_q[o_r]];
1507				r = (r + 1) & CMX_BUFF_MASK;
1508				o_r = (o_r + 1) & CMX_BUFF_MASK;
1509			}
1510		}
1511		dsp->tx_R = t;
1512		goto send_packet;
1513	}
1514	/* PROCESS DATA (three or more members) */
1515	/* -> if echo is NOT enabled */
1516	if (!dsp->echo.software) {
1517		/*
1518		 * -> subtract rx-data from conf-data,
1519		 * if tx-data is available, mix
1520		 */
1521		while (r != rr && t != tt) {
1522			sample = dsp_audio_law_to_s32[p[t]] + *c++ -
1523				dsp_audio_law_to_s32[q[r]];
1524			if (sample < -32768)
1525				sample = -32768;
1526			else if (sample > 32767)
1527				sample = 32767;
1528			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1529			/* conf-rx+tx */
1530			r = (r + 1) & CMX_BUFF_MASK;
1531			t = (t + 1) & CMX_BUFF_MASK;
1532		}
1533		while (r != rr) {
1534			sample = *c++ - dsp_audio_law_to_s32[q[r]];
1535			if (sample < -32768)
1536				sample = -32768;
1537			else if (sample > 32767)
1538				sample = 32767;
1539			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1540			/* conf-rx */
1541			r = (r + 1) & CMX_BUFF_MASK;
1542		}
1543		/* -> if echo is enabled */
1544	} else {
1545		/*
1546		 * -> encode conf-data, if tx-data
1547		 * is available, mix
1548		 */
1549		while (r != rr && t != tt) {
1550			sample = dsp_audio_law_to_s32[p[t]] + *c++;
1551			if (sample < -32768)
1552				sample = -32768;
1553			else if (sample > 32767)
1554				sample = 32767;
1555			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1556			/* conf(echo)+tx */
1557			t = (t + 1) & CMX_BUFF_MASK;
1558			r = (r + 1) & CMX_BUFF_MASK;
1559		}
1560		while (r != rr) {
1561			sample = *c++;
1562			if (sample < -32768)
1563				sample = -32768;
1564			else if (sample > 32767)
1565				sample = 32767;
1566			*d++ = dsp_audio_s16_to_law[sample & 0xffff];
1567			/* conf(echo) */
1568			r = (r + 1) & CMX_BUFF_MASK;
1569		}
1570	}
1571	dsp->tx_R = t;
1572	goto send_packet;
1573
1574send_packet:
1575	/*
1576	 * send tx-data if enabled - don't filter,
1577	 * because we want what we send, not what we filtered
1578	 */
1579	if (dsp->tx_data) {
1580		if (tx_data_only) {
1581			hh->prim = DL_DATA_REQ;
1582			hh->id = 0;
1583			/* queue and trigger */
1584			skb_queue_tail(&dsp->sendq, nskb);
1585			schedule_work(&dsp->workq);
1586			/* exit because only tx_data is used */
1587			return;
1588		} else {
1589			txskb = mI_alloc_skb(len, GFP_ATOMIC);
1590			if (!txskb) {
1591				printk(KERN_ERR
1592				       "FATAL ERROR in mISDN_dsp.o: "
1593				       "cannot alloc %d bytes\n", len);
1594			} else {
1595				thh = mISDN_HEAD_P(txskb);
1596				thh->prim = DL_DATA_REQ;
1597				thh->id = 0;
1598				skb_put_data(txskb, nskb->data + preload, len);
1599				/* queue (trigger later) */
1600				skb_queue_tail(&dsp->sendq, txskb);
1601			}
1602		}
1603	}
1604
1605	/* send data only to card, if we don't just calculated tx_data */
1606	/* adjust volume */
1607	if (dsp->tx_volume)
1608		dsp_change_volume(nskb, dsp->tx_volume);
1609	/* pipeline */
1610	if (dsp->pipeline.inuse)
1611		dsp_pipeline_process_tx(&dsp->pipeline, nskb->data,
1612					nskb->len);
1613	/* crypt */
1614	if (dsp->bf_enable)
1615		dsp_bf_encrypt(dsp, nskb->data, nskb->len);
1616	/* queue and trigger */
1617	skb_queue_tail(&dsp->sendq, nskb);
1618	schedule_work(&dsp->workq);
1619}
1620
1621static u32	jittercount; /* counter for jitter check */
1622struct timer_list dsp_spl_tl;
1623unsigned long	dsp_spl_jiffies; /* calculate the next time to fire */
1624static u16	dsp_count; /* last sample count */
1625static int	dsp_count_valid; /* if we have last sample count */
1626
1627void
1628dsp_cmx_send(void *arg)
1629{
1630	struct dsp_conf *conf;
1631	struct dsp_conf_member *member;
1632	struct dsp *dsp;
1633	int mustmix, members;
1634	static s32 mixbuffer[MAX_POLL + 100];
1635	s32 *c;
1636	u8 *p, *q;
1637	int r, rr;
1638	int jittercheck = 0, delay, i;
1639	u_long flags;
1640	u16 length, count;
1641
1642	/* lock */
1643	spin_lock_irqsave(&dsp_lock, flags);
1644
1645	if (!dsp_count_valid) {
1646		dsp_count = mISDN_clock_get();
1647		length = dsp_poll;
1648		dsp_count_valid = 1;
1649	} else {
1650		count = mISDN_clock_get();
1651		length = count - dsp_count;
1652		dsp_count = count;
1653	}
1654	if (length > MAX_POLL + 100)
1655		length = MAX_POLL + 100;
1656	/* printk(KERN_DEBUG "len=%d dsp_count=0x%x\n", length, dsp_count); */
1657
1658	/*
1659	 * check if jitter needs to be checked (this is every second)
1660	 */
1661	jittercount += length;
1662	if (jittercount >= 8000) {
1663		jittercount -= 8000;
1664		jittercheck = 1;
1665	}
1666
1667	/* loop all members that do not require conference mixing */
1668	list_for_each_entry(dsp, &dsp_ilist, list) {
1669		if (dsp->hdlc)
1670			continue;
1671		conf = dsp->conf;
1672		mustmix = 0;
1673		members = 0;
1674		if (conf) {
1675			members = count_list_member(&conf->mlist);
1676#ifdef CMX_CONF_DEBUG
1677			if (conf->software && members > 1)
1678#else
1679			if (conf->software && members > 2)
1680#endif
1681				mustmix = 1;
1682		}
1683
1684		/* transmission required */
1685		if (!mustmix) {
1686			dsp_cmx_send_member(dsp, length, mixbuffer, members);
1687
1688			/*
1689			 * unused mixbuffer is given to prevent a
1690			 * potential null-pointer-bug
1691			 */
1692		}
1693	}
1694
1695	/* loop all members that require conference mixing */
1696	list_for_each_entry(conf, &conf_ilist, list) {
1697		/* count members and check hardware */
1698		members = count_list_member(&conf->mlist);
1699#ifdef CMX_CONF_DEBUG
1700		if (conf->software && members > 1) {
1701#else
1702		if (conf->software && members > 2) {
1703#endif
1704			/* check for hdlc conf */
1705			member = list_entry(conf->mlist.next,
1706					    struct dsp_conf_member, list);
1707			if (member->dsp->hdlc)
1708				continue;
1709			/* mix all data */
1710			memset(mixbuffer, 0, length * sizeof(s32));
1711			list_for_each_entry(member, &conf->mlist, list) {
1712				dsp = member->dsp;
1713				/* get range of data to mix */
1714				c = mixbuffer;
1715				q = dsp->rx_buff;
1716				r = dsp->rx_R;
1717				rr = (r + length) & CMX_BUFF_MASK;
1718				/* add member's data */
1719				while (r != rr) {
1720					*c++ += dsp_audio_law_to_s32[q[r]];
1721					r = (r + 1) & CMX_BUFF_MASK;
1722				}
1723			}
1724
1725			/* process each member */
1726			list_for_each_entry(member, &conf->mlist, list) {
1727				/* transmission */
1728				dsp_cmx_send_member(member->dsp, length,
1729						    mixbuffer, members);
1730			}
1731		}
1732	}
1733
1734	/* delete rx-data, increment buffers, change pointers */
1735	list_for_each_entry(dsp, &dsp_ilist, list) {
1736		if (dsp->hdlc)
1737			continue;
1738		p = dsp->rx_buff;
1739		q = dsp->tx_buff;
1740		r = dsp->rx_R;
1741		/* move receive pointer when receiving */
1742		if (!dsp->rx_is_off) {
1743			rr = (r + length) & CMX_BUFF_MASK;
1744			/* delete rx-data */
1745			while (r != rr) {
1746				p[r] = dsp_silence;
1747				r = (r + 1) & CMX_BUFF_MASK;
1748			}
1749			/* increment rx-buffer pointer */
1750			dsp->rx_R = r; /* write incremented read pointer */
1751		}
1752
1753		/* check current rx_delay */
1754		delay = (dsp->rx_W-dsp->rx_R) & CMX_BUFF_MASK;
1755		if (delay >= CMX_BUFF_HALF)
1756			delay = 0; /* will be the delay before next write */
1757		/* check for lower delay */
1758		if (delay < dsp->rx_delay[0])
1759			dsp->rx_delay[0] = delay;
1760		/* check current tx_delay */
1761		delay = (dsp->tx_W-dsp->tx_R) & CMX_BUFF_MASK;
1762		if (delay >= CMX_BUFF_HALF)
1763			delay = 0; /* will be the delay before next write */
1764		/* check for lower delay */
1765		if (delay < dsp->tx_delay[0])
1766			dsp->tx_delay[0] = delay;
1767		if (jittercheck) {
1768			/* find the lowest of all rx_delays */
1769			delay = dsp->rx_delay[0];
1770			i = 1;
1771			while (i < MAX_SECONDS_JITTER_CHECK) {
1772				if (delay > dsp->rx_delay[i])
1773					delay = dsp->rx_delay[i];
1774				i++;
1775			}
1776			/*
1777			 * remove rx_delay only if we have delay AND we
1778			 * have not preset cmx_delay AND
1779			 * the delay is greater dsp_poll
1780			 */
1781			if (delay > dsp_poll && !dsp->cmx_delay) {
1782				if (dsp_debug & DEBUG_DSP_CLOCK)
1783					printk(KERN_DEBUG
1784					       "%s lowest rx_delay of %d bytes for"
1785					       " dsp %s are now removed.\n",
1786					       __func__, delay,
1787					       dsp->name);
1788				r = dsp->rx_R;
1789				rr = (r + delay - (dsp_poll >> 1))
1790					& CMX_BUFF_MASK;
1791				/* delete rx-data */
1792				while (r != rr) {
1793					p[r] = dsp_silence;
1794					r = (r + 1) & CMX_BUFF_MASK;
1795				}
1796				/* increment rx-buffer pointer */
1797				dsp->rx_R = r;
1798				/* write incremented read pointer */
1799			}
1800			/* find the lowest of all tx_delays */
1801			delay = dsp->tx_delay[0];
1802			i = 1;
1803			while (i < MAX_SECONDS_JITTER_CHECK) {
1804				if (delay > dsp->tx_delay[i])
1805					delay = dsp->tx_delay[i];
1806				i++;
1807			}
1808			/*
1809			 * remove delay only if we have delay AND we
1810			 * have enabled tx_dejitter
1811			 */
1812			if (delay > dsp_poll && dsp->tx_dejitter) {
1813				if (dsp_debug & DEBUG_DSP_CLOCK)
1814					printk(KERN_DEBUG
1815					       "%s lowest tx_delay of %d bytes for"
1816					       " dsp %s are now removed.\n",
1817					       __func__, delay,
1818					       dsp->name);
1819				r = dsp->tx_R;
1820				rr = (r + delay - (dsp_poll >> 1))
1821					& CMX_BUFF_MASK;
1822				/* delete tx-data */
1823				while (r != rr) {
1824					q[r] = dsp_silence;
1825					r = (r + 1) & CMX_BUFF_MASK;
1826				}
1827				/* increment rx-buffer pointer */
1828				dsp->tx_R = r;
1829				/* write incremented read pointer */
1830			}
1831			/* scroll up delays */
1832			i = MAX_SECONDS_JITTER_CHECK - 1;
1833			while (i) {
1834				dsp->rx_delay[i] = dsp->rx_delay[i - 1];
1835				dsp->tx_delay[i] = dsp->tx_delay[i - 1];
1836				i--;
1837			}
1838			dsp->tx_delay[0] = CMX_BUFF_HALF; /* (infinite) delay */
1839			dsp->rx_delay[0] = CMX_BUFF_HALF; /* (infinite) delay */
1840		}
1841	}
1842
1843	/* if next event would be in the past ... */
1844	if ((s32)(dsp_spl_jiffies + dsp_tics-jiffies) <= 0)
1845		dsp_spl_jiffies = jiffies + 1;
1846	else
1847		dsp_spl_jiffies += dsp_tics;
1848
1849	dsp_spl_tl.expires = dsp_spl_jiffies;
1850	add_timer(&dsp_spl_tl);
1851
1852	/* unlock */
1853	spin_unlock_irqrestore(&dsp_lock, flags);
1854}
1855
1856/*
1857 * audio data is transmitted from upper layer to the dsp
1858 */
1859void
1860dsp_cmx_transmit(struct dsp *dsp, struct sk_buff *skb)
1861{
1862	u_int w, ww;
1863	u8 *d, *p;
1864	int space; /* todo: , l = skb->len; */
1865#ifdef CMX_TX_DEBUG
1866	char debugbuf[256] = "";
1867#endif
1868
1869	/* check if there is enough space, and then copy */
1870	w = dsp->tx_W;
1871	ww = dsp->tx_R;
1872	p = dsp->tx_buff;
1873	d = skb->data;
1874	space = (ww - w - 1) & CMX_BUFF_MASK;
1875	/* write-pointer should not overrun nor reach read pointer */
1876	if (space < skb->len) {
1877		/* write to the space we have left */
1878		ww = (ww - 1) & CMX_BUFF_MASK; /* end one byte prior tx_R */
1879		if (dsp_debug & DEBUG_DSP_CLOCK)
1880			printk(KERN_DEBUG "%s: TX overflow space=%d skb->len="
1881			       "%d, w=0x%04x, ww=0x%04x\n", __func__, space,
1882			       skb->len, w, ww);
1883	} else
1884		/* write until all byte are copied */
1885		ww = (w + skb->len) & CMX_BUFF_MASK;
1886	dsp->tx_W = ww;
1887		/* show current buffer */
1888#ifdef CMX_DEBUG
1889	printk(KERN_DEBUG
1890	       "cmx_transmit(dsp=%lx) %d bytes to 0x%x-0x%x. %s\n",
1891	       (u_long)dsp, (ww - w) & CMX_BUFF_MASK, w, ww, dsp->name);
1892#endif
1893
1894	/* copy transmit data to tx-buffer */
1895#ifdef CMX_TX_DEBUG
1896	sprintf(debugbuf, "TX getting (%04x-%04x)%p: ", w, ww, p);
1897#endif
1898	while (w != ww) {
1899#ifdef CMX_TX_DEBUG
1900		if (strlen(debugbuf) < 48)
1901			sprintf(debugbuf + strlen(debugbuf), " %02x", *d);
1902#endif
1903		p[w] = *d++;
1904		w = (w + 1) & CMX_BUFF_MASK;
1905	}
1906#ifdef CMX_TX_DEBUG
1907	printk(KERN_DEBUG "%s\n", debugbuf);
1908#endif
1909
1910}
1911
1912/*
1913 * hdlc data is received from card and sent to all members.
1914 */
1915void
1916dsp_cmx_hdlc(struct dsp *dsp, struct sk_buff *skb)
1917{
1918	struct sk_buff *nskb = NULL;
1919	struct dsp_conf_member *member;
1920	struct mISDNhead *hh;
1921
1922	/* not if not active */
1923	if (!dsp->b_active)
1924		return;
1925
1926	/* check if we have sompen */
1927	if (skb->len < 1)
1928		return;
1929
1930	/* no conf */
1931	if (!dsp->conf) {
1932		/* in case of software echo */
1933		if (dsp->echo.software) {
1934			nskb = skb_clone(skb, GFP_ATOMIC);
1935			if (nskb) {
1936				hh = mISDN_HEAD_P(nskb);
1937				hh->prim = PH_DATA_REQ;
1938				hh->id = 0;
1939				skb_queue_tail(&dsp->sendq, nskb);
1940				schedule_work(&dsp->workq);
1941			}
1942		}
1943		return;
1944	}
1945	/* in case of hardware conference */
1946	if (dsp->conf->hardware)
1947		return;
1948	list_for_each_entry(member, &dsp->conf->mlist, list) {
1949		if (dsp->echo.software || member->dsp != dsp) {
1950			nskb = skb_clone(skb, GFP_ATOMIC);
1951			if (nskb) {
1952				hh = mISDN_HEAD_P(nskb);
1953				hh->prim = PH_DATA_REQ;
1954				hh->id = 0;
1955				skb_queue_tail(&member->dsp->sendq, nskb);
1956				schedule_work(&member->dsp->workq);
1957			}
1958		}
1959	}
1960}