Linux Audio

Check our new training course

Loading...
v4.6
 
   1/*
   2 *  Copyright (c) 1999 by Uros Bizjak <uros@kss-loka.si>
   3 *                        Takashi Iwai <tiwai@suse.de>
   4 *
   5 *  SB16ASP/AWE32 CSP control
   6 *
   7 *  CSP microcode loader:
   8 *   alsa-tools/sb16_csp/ 
   9 *
  10 *   This program is free software; you can redistribute it and/or modify 
  11 *   it under the terms of the GNU General Public License as published by
  12 *   the Free Software Foundation; either version 2 of the License, or
  13 *   (at your option) any later version.
  14 *
  15 *   This program is distributed in the hope that it will be useful,
  16 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  17 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18 *   GNU General Public License for more details.
  19 *
  20 *   You should have received a copy of the GNU General Public License
  21 *   along with this program; if not, write to the Free Software
  22 *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  23 *
  24 */
  25
  26#include <linux/delay.h>
  27#include <linux/init.h>
  28#include <linux/slab.h>
  29#include <linux/module.h>
  30#include <sound/core.h>
  31#include <sound/control.h>
  32#include <sound/info.h>
  33#include <sound/sb16_csp.h>
  34#include <sound/initval.h>
  35
  36MODULE_AUTHOR("Uros Bizjak <uros@kss-loka.si>");
  37MODULE_DESCRIPTION("ALSA driver for SB16 Creative Signal Processor");
  38MODULE_LICENSE("GPL");
  39MODULE_FIRMWARE("sb16/mulaw_main.csp");
  40MODULE_FIRMWARE("sb16/alaw_main.csp");
  41MODULE_FIRMWARE("sb16/ima_adpcm_init.csp");
  42MODULE_FIRMWARE("sb16/ima_adpcm_playback.csp");
  43MODULE_FIRMWARE("sb16/ima_adpcm_capture.csp");
  44
  45#ifdef SNDRV_LITTLE_ENDIAN
  46#define CSP_HDR_VALUE(a,b,c,d)	((a) | ((b)<<8) | ((c)<<16) | ((d)<<24))
  47#else
  48#define CSP_HDR_VALUE(a,b,c,d)	((d) | ((c)<<8) | ((b)<<16) | ((a)<<24))
  49#endif
  50
  51#define RIFF_HEADER	CSP_HDR_VALUE('R', 'I', 'F', 'F')
  52#define CSP__HEADER	CSP_HDR_VALUE('C', 'S', 'P', ' ')
  53#define LIST_HEADER	CSP_HDR_VALUE('L', 'I', 'S', 'T')
  54#define FUNC_HEADER	CSP_HDR_VALUE('f', 'u', 'n', 'c')
  55#define CODE_HEADER	CSP_HDR_VALUE('c', 'o', 'd', 'e')
  56#define INIT_HEADER	CSP_HDR_VALUE('i', 'n', 'i', 't')
  57#define MAIN_HEADER	CSP_HDR_VALUE('m', 'a', 'i', 'n')
  58
  59/*
  60 * RIFF data format
  61 */
  62struct riff_header {
  63	__u32 name;
  64	__u32 len;
  65};
  66
  67struct desc_header {
  68	struct riff_header info;
  69	__u16 func_nr;
  70	__u16 VOC_type;
  71	__u16 flags_play_rec;
  72	__u16 flags_16bit_8bit;
  73	__u16 flags_stereo_mono;
  74	__u16 flags_rates;
  75};
  76
  77/*
  78 * prototypes
  79 */
  80static void snd_sb_csp_free(struct snd_hwdep *hw);
  81static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file);
  82static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg);
  83static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file);
  84
  85static int csp_detect(struct snd_sb *chip, int *version);
  86static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val);
  87static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val);
  88static int read_register(struct snd_sb *chip, unsigned char reg);
  89static int set_mode_register(struct snd_sb *chip, unsigned char mode);
  90static int get_version(struct snd_sb *chip);
  91
  92static int snd_sb_csp_riff_load(struct snd_sb_csp * p,
  93				struct snd_sb_csp_microcode __user * code);
  94static int snd_sb_csp_unload(struct snd_sb_csp * p);
  95static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags);
  96static int snd_sb_csp_autoload(struct snd_sb_csp * p, int pcm_sfmt, int play_rec_mode);
  97static int snd_sb_csp_check_version(struct snd_sb_csp * p);
  98
  99static int snd_sb_csp_use(struct snd_sb_csp * p);
 100static int snd_sb_csp_unuse(struct snd_sb_csp * p);
 101static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels);
 102static int snd_sb_csp_stop(struct snd_sb_csp * p);
 103static int snd_sb_csp_pause(struct snd_sb_csp * p);
 104static int snd_sb_csp_restart(struct snd_sb_csp * p);
 105
 106static int snd_sb_qsound_build(struct snd_sb_csp * p);
 107static void snd_sb_qsound_destroy(struct snd_sb_csp * p);
 108static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p);
 109
 110static int init_proc_entry(struct snd_sb_csp * p, int device);
 111static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer);
 112
 113/*
 114 * Detect CSP chip and create a new instance
 115 */
 116int snd_sb_csp_new(struct snd_sb *chip, int device, struct snd_hwdep ** rhwdep)
 117{
 118	struct snd_sb_csp *p;
 119	int uninitialized_var(version);
 120	int err;
 121	struct snd_hwdep *hw;
 122
 123	if (rhwdep)
 124		*rhwdep = NULL;
 125
 126	if (csp_detect(chip, &version))
 127		return -ENODEV;
 128
 129	if ((err = snd_hwdep_new(chip->card, "SB16-CSP", device, &hw)) < 0)
 
 130		return err;
 131
 132	if ((p = kzalloc(sizeof(*p), GFP_KERNEL)) == NULL) {
 
 133		snd_device_free(chip->card, hw);
 134		return -ENOMEM;
 135	}
 136	p->chip = chip;
 137	p->version = version;
 138
 139	/* CSP operators */
 140	p->ops.csp_use = snd_sb_csp_use;
 141	p->ops.csp_unuse = snd_sb_csp_unuse;
 142	p->ops.csp_autoload = snd_sb_csp_autoload;
 143	p->ops.csp_start = snd_sb_csp_start;
 144	p->ops.csp_stop = snd_sb_csp_stop;
 145	p->ops.csp_qsound_transfer = snd_sb_csp_qsound_transfer;
 146
 147	mutex_init(&p->access_mutex);
 148	sprintf(hw->name, "CSP v%d.%d", (version >> 4), (version & 0x0f));
 149	hw->iface = SNDRV_HWDEP_IFACE_SB16CSP;
 150	hw->private_data = p;
 151	hw->private_free = snd_sb_csp_free;
 152
 153	/* operators - only write/ioctl */
 154	hw->ops.open = snd_sb_csp_open;
 155	hw->ops.ioctl = snd_sb_csp_ioctl;
 156	hw->ops.release = snd_sb_csp_release;
 157
 158	/* create a proc entry */
 159	init_proc_entry(p, device);
 160	if (rhwdep)
 161		*rhwdep = hw;
 162	return 0;
 163}
 164
 165/*
 166 * free_private for hwdep instance
 167 */
 168static void snd_sb_csp_free(struct snd_hwdep *hwdep)
 169{
 170	int i;
 171	struct snd_sb_csp *p = hwdep->private_data;
 172	if (p) {
 173		if (p->running & SNDRV_SB_CSP_ST_RUNNING)
 174			snd_sb_csp_stop(p);
 175		for (i = 0; i < ARRAY_SIZE(p->csp_programs); ++i)
 176			release_firmware(p->csp_programs[i]);
 177		kfree(p);
 178	}
 179}
 180
 181/* ------------------------------ */
 182
 183/*
 184 * open the device exclusively
 185 */
 186static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file)
 187{
 188	struct snd_sb_csp *p = hw->private_data;
 189	return (snd_sb_csp_use(p));
 190}
 191
 192/*
 193 * ioctl for hwdep device:
 194 */
 195static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg)
 196{
 197	struct snd_sb_csp *p = hw->private_data;
 198	struct snd_sb_csp_info info;
 199	struct snd_sb_csp_start start_info;
 200	int err;
 201
 202	if (snd_BUG_ON(!p))
 203		return -EINVAL;
 204
 205	if (snd_sb_csp_check_version(p))
 206		return -ENODEV;
 207
 208	switch (cmd) {
 209		/* get information */
 210	case SNDRV_SB_CSP_IOCTL_INFO:
 211		memset(&info, 0, sizeof(info));
 212		*info.codec_name = *p->codec_name;
 213		info.func_nr = p->func_nr;
 214		info.acc_format = p->acc_format;
 215		info.acc_channels = p->acc_channels;
 216		info.acc_width = p->acc_width;
 217		info.acc_rates = p->acc_rates;
 218		info.csp_mode = p->mode;
 219		info.run_channels = p->run_channels;
 220		info.run_width = p->run_width;
 221		info.version = p->version;
 222		info.state = p->running;
 223		if (copy_to_user((void __user *)arg, &info, sizeof(info)))
 224			err = -EFAULT;
 225		else
 226			err = 0;
 227		break;
 228
 229		/* load CSP microcode */
 230	case SNDRV_SB_CSP_IOCTL_LOAD_CODE:
 231		err = (p->running & SNDRV_SB_CSP_ST_RUNNING ?
 232		       -EBUSY : snd_sb_csp_riff_load(p, (struct snd_sb_csp_microcode __user *) arg));
 233		break;
 234	case SNDRV_SB_CSP_IOCTL_UNLOAD_CODE:
 235		err = (p->running & SNDRV_SB_CSP_ST_RUNNING ?
 236		       -EBUSY : snd_sb_csp_unload(p));
 237		break;
 238
 239		/* change CSP running state */
 240	case SNDRV_SB_CSP_IOCTL_START:
 241		if (copy_from_user(&start_info, (void __user *) arg, sizeof(start_info)))
 242			err = -EFAULT;
 243		else
 244			err = snd_sb_csp_start(p, start_info.sample_width, start_info.channels);
 245		break;
 246	case SNDRV_SB_CSP_IOCTL_STOP:
 247		err = snd_sb_csp_stop(p);
 248		break;
 249	case SNDRV_SB_CSP_IOCTL_PAUSE:
 250		err = snd_sb_csp_pause(p);
 251		break;
 252	case SNDRV_SB_CSP_IOCTL_RESTART:
 253		err = snd_sb_csp_restart(p);
 254		break;
 255	default:
 256		err = -ENOTTY;
 257		break;
 258	}
 259
 260	return err;
 261}
 262
 263/*
 264 * close the device
 265 */
 266static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file)
 267{
 268	struct snd_sb_csp *p = hw->private_data;
 269	return (snd_sb_csp_unuse(p));
 270}
 271
 272/* ------------------------------ */
 273
 274/*
 275 * acquire device
 276 */
 277static int snd_sb_csp_use(struct snd_sb_csp * p)
 278{
 279	mutex_lock(&p->access_mutex);
 280	if (p->used) {
 281		mutex_unlock(&p->access_mutex);
 282		return -EAGAIN;
 283	}
 284	p->used++;
 285	mutex_unlock(&p->access_mutex);
 286
 287	return 0;
 288
 289}
 290
 291/*
 292 * release device
 293 */
 294static int snd_sb_csp_unuse(struct snd_sb_csp * p)
 295{
 296	mutex_lock(&p->access_mutex);
 297	p->used--;
 298	mutex_unlock(&p->access_mutex);
 299
 300	return 0;
 301}
 302
 303/*
 304 * load microcode via ioctl: 
 305 * code is user-space pointer
 306 */
 307static int snd_sb_csp_riff_load(struct snd_sb_csp * p,
 308				struct snd_sb_csp_microcode __user * mcode)
 309{
 310	struct snd_sb_csp_mc_header info;
 311
 312	unsigned char __user *data_ptr;
 313	unsigned char __user *data_end;
 314	unsigned short func_nr = 0;
 315
 316	struct riff_header file_h, item_h, code_h;
 317	__u32 item_type;
 318	struct desc_header funcdesc_h;
 319
 320	unsigned long flags;
 321	int err;
 322
 323	if (copy_from_user(&info, mcode, sizeof(info)))
 324		return -EFAULT;
 325	data_ptr = mcode->data;
 326
 327	if (copy_from_user(&file_h, data_ptr, sizeof(file_h)))
 328		return -EFAULT;
 329	if ((file_h.name != RIFF_HEADER) ||
 330	    (le32_to_cpu(file_h.len) >= SNDRV_SB_CSP_MAX_MICROCODE_FILE_SIZE - sizeof(file_h))) {
 331		snd_printd("%s: Invalid RIFF header\n", __func__);
 332		return -EINVAL;
 333	}
 334	data_ptr += sizeof(file_h);
 335	data_end = data_ptr + le32_to_cpu(file_h.len);
 336
 337	if (copy_from_user(&item_type, data_ptr, sizeof(item_type)))
 338		return -EFAULT;
 339	if (item_type != CSP__HEADER) {
 340		snd_printd("%s: Invalid RIFF file type\n", __func__);
 341		return -EINVAL;
 342	}
 343	data_ptr += sizeof (item_type);
 344
 345	for (; data_ptr < data_end; data_ptr += le32_to_cpu(item_h.len)) {
 346		if (copy_from_user(&item_h, data_ptr, sizeof(item_h)))
 347			return -EFAULT;
 348		data_ptr += sizeof(item_h);
 349		if (item_h.name != LIST_HEADER)
 350			continue;
 351
 352		if (copy_from_user(&item_type, data_ptr, sizeof(item_type)))
 353			 return -EFAULT;
 354		switch (item_type) {
 355		case FUNC_HEADER:
 356			if (copy_from_user(&funcdesc_h, data_ptr + sizeof(item_type), sizeof(funcdesc_h)))
 357				return -EFAULT;
 358			func_nr = le16_to_cpu(funcdesc_h.func_nr);
 359			break;
 360		case CODE_HEADER:
 361			if (func_nr != info.func_req)
 362				break;	/* not required function, try next */
 363			data_ptr += sizeof(item_type);
 364
 365			/* destroy QSound mixer element */
 366			if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
 367				snd_sb_qsound_destroy(p);
 368			}
 369			/* Clear all flags */
 370			p->running = 0;
 371			p->mode = 0;
 372
 373			/* load microcode blocks */
 374			for (;;) {
 375				if (data_ptr >= data_end)
 376					return -EINVAL;
 377				if (copy_from_user(&code_h, data_ptr, sizeof(code_h)))
 378					return -EFAULT;
 379
 380				/* init microcode blocks */
 381				if (code_h.name != INIT_HEADER)
 382					break;
 383				data_ptr += sizeof(code_h);
 384				err = snd_sb_csp_load_user(p, data_ptr, le32_to_cpu(code_h.len),
 385						      SNDRV_SB_CSP_LOAD_INITBLOCK);
 386				if (err)
 387					return err;
 388				data_ptr += le32_to_cpu(code_h.len);
 389			}
 390			/* main microcode block */
 391			if (copy_from_user(&code_h, data_ptr, sizeof(code_h)))
 392				return -EFAULT;
 393
 394			if (code_h.name != MAIN_HEADER) {
 395				snd_printd("%s: Missing 'main' microcode\n", __func__);
 396				return -EINVAL;
 397			}
 398			data_ptr += sizeof(code_h);
 399			err = snd_sb_csp_load_user(p, data_ptr,
 400						   le32_to_cpu(code_h.len), 0);
 401			if (err)
 402				return err;
 403
 404			/* fill in codec header */
 405			strlcpy(p->codec_name, info.codec_name, sizeof(p->codec_name));
 406			p->func_nr = func_nr;
 407			p->mode = le16_to_cpu(funcdesc_h.flags_play_rec);
 408			switch (le16_to_cpu(funcdesc_h.VOC_type)) {
 409			case 0x0001:	/* QSound decoder */
 410				if (le16_to_cpu(funcdesc_h.flags_play_rec) == SNDRV_SB_CSP_MODE_DSP_WRITE) {
 411					if (snd_sb_qsound_build(p) == 0)
 412						/* set QSound flag and clear all other mode flags */
 413						p->mode = SNDRV_SB_CSP_MODE_QSOUND;
 414				}
 415				p->acc_format = 0;
 416				break;
 417			case 0x0006:	/* A Law codec */
 418				p->acc_format = SNDRV_PCM_FMTBIT_A_LAW;
 419				break;
 420			case 0x0007:	/* Mu Law codec */
 421				p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW;
 422				break;
 423			case 0x0011:	/* what Creative thinks is IMA ADPCM codec */
 424			case 0x0200:	/* Creative ADPCM codec */
 425				p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM;
 426				break;
 427			case    201:	/* Text 2 Speech decoder */
 428				/* TODO: Text2Speech handling routines */
 429				p->acc_format = 0;
 430				break;
 431			case 0x0202:	/* Fast Speech 8 codec */
 432			case 0x0203:	/* Fast Speech 10 codec */
 433				p->acc_format = SNDRV_PCM_FMTBIT_SPECIAL;
 434				break;
 435			default:	/* other codecs are unsupported */
 436				p->acc_format = p->acc_width = p->acc_rates = 0;
 437				p->mode = 0;
 438				snd_printd("%s: Unsupported CSP codec type: 0x%04x\n",
 439					   __func__,
 440					   le16_to_cpu(funcdesc_h.VOC_type));
 441				return -EINVAL;
 442			}
 443			p->acc_channels = le16_to_cpu(funcdesc_h.flags_stereo_mono);
 444			p->acc_width = le16_to_cpu(funcdesc_h.flags_16bit_8bit);
 445			p->acc_rates = le16_to_cpu(funcdesc_h.flags_rates);
 446
 447			/* Decouple CSP from IRQ and DMAREQ lines */
 448			spin_lock_irqsave(&p->chip->reg_lock, flags);
 449			set_mode_register(p->chip, 0xfc);
 450			set_mode_register(p->chip, 0x00);
 451			spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 452
 453			/* finished loading successfully */
 454			p->running = SNDRV_SB_CSP_ST_LOADED;	/* set LOADED flag */
 455			return 0;
 456		}
 457	}
 458	snd_printd("%s: Function #%d not found\n", __func__, info.func_req);
 459	return -EINVAL;
 460}
 461
 462/*
 463 * unload CSP microcode
 464 */
 465static int snd_sb_csp_unload(struct snd_sb_csp * p)
 466{
 467	if (p->running & SNDRV_SB_CSP_ST_RUNNING)
 468		return -EBUSY;
 469	if (!(p->running & SNDRV_SB_CSP_ST_LOADED))
 470		return -ENXIO;
 471
 472	/* clear supported formats */
 473	p->acc_format = 0;
 474	p->acc_channels = p->acc_width = p->acc_rates = 0;
 475	/* destroy QSound mixer element */
 476	if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
 477		snd_sb_qsound_destroy(p);
 478	}
 479	/* clear all flags */
 480	p->running = 0;
 481	p->mode = 0;
 482	return 0;
 483}
 484
 485/*
 486 * send command sequence to DSP
 487 */
 488static inline int command_seq(struct snd_sb *chip, const unsigned char *seq, int size)
 489{
 490	int i;
 491	for (i = 0; i < size; i++) {
 492		if (!snd_sbdsp_command(chip, seq[i]))
 493			return -EIO;
 494	}
 495	return 0;
 496}
 497
 498/*
 499 * set CSP codec parameter
 500 */
 501static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val)
 502{
 503	unsigned char dsp_cmd[3];
 504
 505	dsp_cmd[0] = 0x05;	/* CSP set codec parameter */
 506	dsp_cmd[1] = val;	/* Parameter value */
 507	dsp_cmd[2] = par;	/* Parameter */
 508	command_seq(chip, dsp_cmd, 3);
 509	snd_sbdsp_command(chip, 0x03);	/* DSP read? */
 510	if (snd_sbdsp_get_byte(chip) != par)
 511		return -EIO;
 512	return 0;
 513}
 514
 515/*
 516 * set CSP register
 517 */
 518static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val)
 519{
 520	unsigned char dsp_cmd[3];
 521
 522	dsp_cmd[0] = 0x0e;	/* CSP set register */
 523	dsp_cmd[1] = reg;	/* CSP Register */
 524	dsp_cmd[2] = val;	/* value */
 525	return command_seq(chip, dsp_cmd, 3);
 526}
 527
 528/*
 529 * read CSP register
 530 * return < 0 -> error
 531 */
 532static int read_register(struct snd_sb *chip, unsigned char reg)
 533{
 534	unsigned char dsp_cmd[2];
 535
 536	dsp_cmd[0] = 0x0f;	/* CSP read register */
 537	dsp_cmd[1] = reg;	/* CSP Register */
 538	command_seq(chip, dsp_cmd, 2);
 539	return snd_sbdsp_get_byte(chip);	/* Read DSP value */
 540}
 541
 542/*
 543 * set CSP mode register
 544 */
 545static int set_mode_register(struct snd_sb *chip, unsigned char mode)
 546{
 547	unsigned char dsp_cmd[2];
 548
 549	dsp_cmd[0] = 0x04;	/* CSP set mode register */
 550	dsp_cmd[1] = mode;	/* mode */
 551	return command_seq(chip, dsp_cmd, 2);
 552}
 553
 554/*
 555 * Detect CSP
 556 * return 0 if CSP exists.
 557 */
 558static int csp_detect(struct snd_sb *chip, int *version)
 559{
 560	unsigned char csp_test1, csp_test2;
 561	unsigned long flags;
 562	int result = -ENODEV;
 563
 564	spin_lock_irqsave(&chip->reg_lock, flags);
 565
 566	set_codec_parameter(chip, 0x00, 0x00);
 567	set_mode_register(chip, 0xfc);		/* 0xfc = ?? */
 568
 569	csp_test1 = read_register(chip, 0x83);
 570	set_register(chip, 0x83, ~csp_test1);
 571	csp_test2 = read_register(chip, 0x83);
 572	if (csp_test2 != (csp_test1 ^ 0xff))
 573		goto __fail;
 574
 575	set_register(chip, 0x83, csp_test1);
 576	csp_test2 = read_register(chip, 0x83);
 577	if (csp_test2 != csp_test1)
 578		goto __fail;
 579
 580	set_mode_register(chip, 0x00);		/* 0x00 = ? */
 581
 582	*version = get_version(chip);
 583	snd_sbdsp_reset(chip);	/* reset DSP after getversion! */
 584	if (*version >= 0x10 && *version <= 0x1f)
 585		result = 0;		/* valid version id */
 586
 587      __fail:
 588	spin_unlock_irqrestore(&chip->reg_lock, flags);
 589	return result;
 590}
 591
 592/*
 593 * get CSP version number
 594 */
 595static int get_version(struct snd_sb *chip)
 596{
 597	unsigned char dsp_cmd[2];
 598
 599	dsp_cmd[0] = 0x08;	/* SB_DSP_!something! */
 600	dsp_cmd[1] = 0x03;	/* get chip version id? */
 601	command_seq(chip, dsp_cmd, 2);
 602
 603	return (snd_sbdsp_get_byte(chip));
 604}
 605
 606/*
 607 * check if the CSP version is valid
 608 */
 609static int snd_sb_csp_check_version(struct snd_sb_csp * p)
 610{
 611	if (p->version < 0x10 || p->version > 0x1f) {
 612		snd_printd("%s: Invalid CSP version: 0x%x\n", __func__, p->version);
 613		return 1;
 614	}
 615	return 0;
 616}
 617
 618/*
 619 * download microcode to CSP (microcode should have one "main" block).
 620 */
 621static int snd_sb_csp_load(struct snd_sb_csp * p, const unsigned char *buf, int size, int load_flags)
 622{
 623	int status, i;
 624	int err;
 625	int result = -EIO;
 626	unsigned long flags;
 627
 628	spin_lock_irqsave(&p->chip->reg_lock, flags);
 629	snd_sbdsp_command(p->chip, 0x01);	/* CSP download command */
 630	if (snd_sbdsp_get_byte(p->chip)) {
 631		snd_printd("%s: Download command failed\n", __func__);
 632		goto __fail;
 633	}
 634	/* Send CSP low byte (size - 1) */
 635	snd_sbdsp_command(p->chip, (unsigned char)(size - 1));
 636	/* Send high byte */
 637	snd_sbdsp_command(p->chip, (unsigned char)((size - 1) >> 8));
 638	/* send microcode sequence */
 639	/* load from kernel space */
 640	while (size--) {
 641		if (!snd_sbdsp_command(p->chip, *buf++))
 642			goto __fail;
 643	}
 644	if (snd_sbdsp_get_byte(p->chip))
 645		goto __fail;
 646
 647	if (load_flags & SNDRV_SB_CSP_LOAD_INITBLOCK) {
 648		i = 0;
 649		/* some codecs (FastSpeech) take some time to initialize */
 650		while (1) {
 651			snd_sbdsp_command(p->chip, 0x03);
 652			status = snd_sbdsp_get_byte(p->chip);
 653			if (status == 0x55 || ++i >= 10)
 654				break;
 655			udelay (10);
 656		}
 657		if (status != 0x55) {
 658			snd_printd("%s: Microcode initialization failed\n", __func__);
 659			goto __fail;
 660		}
 661	} else {
 662		/*
 663		 * Read mixer register SB_DSP4_DMASETUP after loading 'main' code.
 664		 * Start CSP chip if no 16bit DMA channel is set - some kind
 665		 * of autorun or perhaps a bugfix?
 666		 */
 667		spin_lock(&p->chip->mixer_lock);
 668		status = snd_sbmixer_read(p->chip, SB_DSP4_DMASETUP);
 669		spin_unlock(&p->chip->mixer_lock);
 670		if (!(status & (SB_DMASETUP_DMA7 | SB_DMASETUP_DMA6 | SB_DMASETUP_DMA5))) {
 671			err = (set_codec_parameter(p->chip, 0xaa, 0x00) ||
 672			       set_codec_parameter(p->chip, 0xff, 0x00));
 673			snd_sbdsp_reset(p->chip);		/* really! */
 674			if (err)
 675				goto __fail;
 676			set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 677			set_mode_register(p->chip, 0x70);	/* 70 = RUN */
 678		}
 679	}
 680	result = 0;
 681
 682      __fail:
 683	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 684	return result;
 685}
 686 
 687static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags)
 688{
 689	int err;
 690	unsigned char *kbuf;
 691
 692	kbuf = memdup_user(buf, size);
 693	if (IS_ERR(kbuf))
 694		return PTR_ERR(kbuf);
 695
 696	err = snd_sb_csp_load(p, kbuf, size, load_flags);
 697
 698	kfree(kbuf);
 699	return err;
 700}
 701
 702static int snd_sb_csp_firmware_load(struct snd_sb_csp *p, int index, int flags)
 703{
 704	static const char *const names[] = {
 705		"sb16/mulaw_main.csp",
 706		"sb16/alaw_main.csp",
 707		"sb16/ima_adpcm_init.csp",
 708		"sb16/ima_adpcm_playback.csp",
 709		"sb16/ima_adpcm_capture.csp",
 710	};
 711	const struct firmware *program;
 712
 713	BUILD_BUG_ON(ARRAY_SIZE(names) != CSP_PROGRAM_COUNT);
 714	program = p->csp_programs[index];
 715	if (!program) {
 716		int err = request_firmware(&program, names[index],
 717				       p->chip->card->dev);
 718		if (err < 0)
 719			return err;
 720		p->csp_programs[index] = program;
 721	}
 722	return snd_sb_csp_load(p, program->data, program->size, flags);
 723}
 724
 725/*
 726 * autoload hardware codec if necessary
 727 * return 0 if CSP is loaded and ready to run (p->running != 0)
 728 */
 729static int snd_sb_csp_autoload(struct snd_sb_csp * p, int pcm_sfmt, int play_rec_mode)
 730{
 731	unsigned long flags;
 732	int err = 0;
 733
 734	/* if CSP is running or manually loaded then exit */
 735	if (p->running & (SNDRV_SB_CSP_ST_RUNNING | SNDRV_SB_CSP_ST_LOADED)) 
 736		return -EBUSY;
 737
 738	/* autoload microcode only if requested hardware codec is not already loaded */
 739	if (((1 << pcm_sfmt) & p->acc_format) && (play_rec_mode & p->mode)) {
 740		p->running = SNDRV_SB_CSP_ST_AUTO;
 741	} else {
 742		switch (pcm_sfmt) {
 743		case SNDRV_PCM_FORMAT_MU_LAW:
 744			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_MULAW, 0);
 745			p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW;
 746			p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE;
 747			break;
 748		case SNDRV_PCM_FORMAT_A_LAW:
 749			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_ALAW, 0);
 750			p->acc_format = SNDRV_PCM_FMTBIT_A_LAW;
 751			p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE;
 752			break;
 753		case SNDRV_PCM_FORMAT_IMA_ADPCM:
 754			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_ADPCM_INIT,
 755						       SNDRV_SB_CSP_LOAD_INITBLOCK);
 756			if (err)
 757				break;
 758			if (play_rec_mode == SNDRV_SB_CSP_MODE_DSP_WRITE) {
 759				err = snd_sb_csp_firmware_load
 760					(p, CSP_PROGRAM_ADPCM_PLAYBACK, 0);
 761				p->mode = SNDRV_SB_CSP_MODE_DSP_WRITE;
 762			} else {
 763				err = snd_sb_csp_firmware_load
 764					(p, CSP_PROGRAM_ADPCM_CAPTURE, 0);
 765				p->mode = SNDRV_SB_CSP_MODE_DSP_READ;
 766			}
 767			p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM;
 768			break;				  
 769		default:
 770			/* Decouple CSP from IRQ and DMAREQ lines */
 771			if (p->running & SNDRV_SB_CSP_ST_AUTO) {
 772				spin_lock_irqsave(&p->chip->reg_lock, flags);
 773				set_mode_register(p->chip, 0xfc);
 774				set_mode_register(p->chip, 0x00);
 775				spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 776				p->running = 0;			/* clear autoloaded flag */
 777			}
 778			return -EINVAL;
 779		}
 780		if (err) {
 781			p->acc_format = 0;
 782			p->acc_channels = p->acc_width = p->acc_rates = 0;
 783
 784			p->running = 0;				/* clear autoloaded flag */
 785			p->mode = 0;
 786			return (err);
 787		} else {
 788			p->running = SNDRV_SB_CSP_ST_AUTO;	/* set autoloaded flag */
 789			p->acc_width = SNDRV_SB_CSP_SAMPLE_16BIT;	/* only 16 bit data */
 790			p->acc_channels = SNDRV_SB_CSP_MONO | SNDRV_SB_CSP_STEREO;
 791			p->acc_rates = SNDRV_SB_CSP_RATE_ALL;	/* HW codecs accept all rates */
 792		}   
 793
 794	}
 795	return (p->running & SNDRV_SB_CSP_ST_AUTO) ? 0 : -ENXIO;
 796}
 797
 798/*
 799 * start CSP
 800 */
 801static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels)
 802{
 803	unsigned char s_type;	/* sample type */
 804	unsigned char mixL, mixR;
 805	int result = -EIO;
 806	unsigned long flags;
 807
 808	if (!(p->running & (SNDRV_SB_CSP_ST_LOADED | SNDRV_SB_CSP_ST_AUTO))) {
 809		snd_printd("%s: Microcode not loaded\n", __func__);
 810		return -ENXIO;
 811	}
 812	if (p->running & SNDRV_SB_CSP_ST_RUNNING) {
 813		snd_printd("%s: CSP already running\n", __func__);
 814		return -EBUSY;
 815	}
 816	if (!(sample_width & p->acc_width)) {
 817		snd_printd("%s: Unsupported PCM sample width\n", __func__);
 818		return -EINVAL;
 819	}
 820	if (!(channels & p->acc_channels)) {
 821		snd_printd("%s: Invalid number of channels\n", __func__);
 822		return -EINVAL;
 823	}
 824
 825	/* Mute PCM volume */
 826	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 827	mixL = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV);
 828	mixR = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV + 1);
 829	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL & 0x7);
 830	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR & 0x7);
 
 831
 832	spin_lock(&p->chip->reg_lock);
 833	set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 834	set_mode_register(p->chip, 0x70);	/* 70 = RUN */
 835
 836	s_type = 0x00;
 837	if (channels == SNDRV_SB_CSP_MONO)
 838		s_type = 0x11;	/* 000n 000n    (n = 1 if mono) */
 839	if (sample_width == SNDRV_SB_CSP_SAMPLE_8BIT)
 840		s_type |= 0x22;	/* 00dX 00dX    (d = 1 if 8 bit samples) */
 841
 842	if (set_codec_parameter(p->chip, 0x81, s_type)) {
 843		snd_printd("%s: Set sample type command failed\n", __func__);
 844		goto __fail;
 845	}
 846	if (set_codec_parameter(p->chip, 0x80, 0x00)) {
 847		snd_printd("%s: Codec start command failed\n", __func__);
 848		goto __fail;
 849	}
 850	p->run_width = sample_width;
 851	p->run_channels = channels;
 852
 853	p->running |= SNDRV_SB_CSP_ST_RUNNING;
 854
 855	if (p->mode & SNDRV_SB_CSP_MODE_QSOUND) {
 856		set_codec_parameter(p->chip, 0xe0, 0x01);
 857		/* enable QSound decoder */
 858		set_codec_parameter(p->chip, 0x00, 0xff);
 859		set_codec_parameter(p->chip, 0x01, 0xff);
 860		p->running |= SNDRV_SB_CSP_ST_QSOUND;
 861		/* set QSound startup value */
 862		snd_sb_csp_qsound_transfer(p);
 863	}
 864	result = 0;
 865
 866      __fail:
 867	spin_unlock(&p->chip->reg_lock);
 868
 869	/* restore PCM volume */
 
 870	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL);
 871	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR);
 872	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 873
 874	return result;
 875}
 876
 877/*
 878 * stop CSP
 879 */
 880static int snd_sb_csp_stop(struct snd_sb_csp * p)
 881{
 882	int result;
 883	unsigned char mixL, mixR;
 884	unsigned long flags;
 885
 886	if (!(p->running & SNDRV_SB_CSP_ST_RUNNING))
 887		return 0;
 888
 889	/* Mute PCM volume */
 890	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 891	mixL = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV);
 892	mixR = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV + 1);
 893	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL & 0x7);
 894	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR & 0x7);
 
 895
 896	spin_lock(&p->chip->reg_lock);
 897	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
 898		set_codec_parameter(p->chip, 0xe0, 0x01);
 899		/* disable QSound decoder */
 900		set_codec_parameter(p->chip, 0x00, 0x00);
 901		set_codec_parameter(p->chip, 0x01, 0x00);
 902
 903		p->running &= ~SNDRV_SB_CSP_ST_QSOUND;
 904	}
 905	result = set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 906	spin_unlock(&p->chip->reg_lock);
 907
 908	/* restore PCM volume */
 
 909	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL);
 910	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR);
 911	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 912
 913	if (!(result))
 914		p->running &= ~(SNDRV_SB_CSP_ST_PAUSED | SNDRV_SB_CSP_ST_RUNNING);
 915	return result;
 916}
 917
 918/*
 919 * pause CSP codec and hold DMA transfer
 920 */
 921static int snd_sb_csp_pause(struct snd_sb_csp * p)
 922{
 923	int result;
 924	unsigned long flags;
 925
 926	if (!(p->running & SNDRV_SB_CSP_ST_RUNNING))
 927		return -EBUSY;
 928
 929	spin_lock_irqsave(&p->chip->reg_lock, flags);
 930	result = set_codec_parameter(p->chip, 0x80, 0xff);
 931	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 932	if (!(result))
 933		p->running |= SNDRV_SB_CSP_ST_PAUSED;
 934
 935	return result;
 936}
 937
 938/*
 939 * restart CSP codec and resume DMA transfer
 940 */
 941static int snd_sb_csp_restart(struct snd_sb_csp * p)
 942{
 943	int result;
 944	unsigned long flags;
 945
 946	if (!(p->running & SNDRV_SB_CSP_ST_PAUSED))
 947		return -EBUSY;
 948
 949	spin_lock_irqsave(&p->chip->reg_lock, flags);
 950	result = set_codec_parameter(p->chip, 0x80, 0x00);
 951	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 952	if (!(result))
 953		p->running &= ~SNDRV_SB_CSP_ST_PAUSED;
 954
 955	return result;
 956}
 957
 958/* ------------------------------ */
 959
 960/*
 961 * QSound mixer control for PCM
 962 */
 963
 964#define snd_sb_qsound_switch_info	snd_ctl_boolean_mono_info
 965
 966static int snd_sb_qsound_switch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 967{
 968	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
 969	
 970	ucontrol->value.integer.value[0] = p->q_enabled ? 1 : 0;
 971	return 0;
 972}
 973
 974static int snd_sb_qsound_switch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 975{
 976	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
 977	unsigned long flags;
 978	int change;
 979	unsigned char nval;
 980	
 981	nval = ucontrol->value.integer.value[0] & 0x01;
 982	spin_lock_irqsave(&p->q_lock, flags);
 983	change = p->q_enabled != nval;
 984	p->q_enabled = nval;
 985	spin_unlock_irqrestore(&p->q_lock, flags);
 986	return change;
 987}
 988
 989static int snd_sb_qsound_space_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
 990{
 991	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 992	uinfo->count = 2;
 993	uinfo->value.integer.min = 0;
 994	uinfo->value.integer.max = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
 995	return 0;
 996}
 997
 998static int snd_sb_qsound_space_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 999{
1000	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
1001	unsigned long flags;
1002	
1003	spin_lock_irqsave(&p->q_lock, flags);
1004	ucontrol->value.integer.value[0] = p->qpos_left;
1005	ucontrol->value.integer.value[1] = p->qpos_right;
1006	spin_unlock_irqrestore(&p->q_lock, flags);
1007	return 0;
1008}
1009
1010static int snd_sb_qsound_space_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
1011{
1012	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
1013	unsigned long flags;
1014	int change;
1015	unsigned char nval1, nval2;
1016	
1017	nval1 = ucontrol->value.integer.value[0];
1018	if (nval1 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT)
1019		nval1 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
1020	nval2 = ucontrol->value.integer.value[1];
1021	if (nval2 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT)
1022		nval2 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
1023	spin_lock_irqsave(&p->q_lock, flags);
1024	change = p->qpos_left != nval1 || p->qpos_right != nval2;
1025	p->qpos_left = nval1;
1026	p->qpos_right = nval2;
1027	p->qpos_changed = change;
1028	spin_unlock_irqrestore(&p->q_lock, flags);
1029	return change;
1030}
1031
1032static struct snd_kcontrol_new snd_sb_qsound_switch = {
1033	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1034	.name = "3D Control - Switch",
1035	.info = snd_sb_qsound_switch_info,
1036	.get = snd_sb_qsound_switch_get,
1037	.put = snd_sb_qsound_switch_put
1038};
1039
1040static struct snd_kcontrol_new snd_sb_qsound_space = {
1041	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1042	.name = "3D Control - Space",
1043	.info = snd_sb_qsound_space_info,
1044	.get = snd_sb_qsound_space_get,
1045	.put = snd_sb_qsound_space_put
1046};
1047
1048static int snd_sb_qsound_build(struct snd_sb_csp * p)
1049{
1050	struct snd_card *card;
 
1051	int err;
1052
1053	if (snd_BUG_ON(!p))
1054		return -EINVAL;
1055
1056	card = p->chip->card;
1057	p->qpos_left = p->qpos_right = SNDRV_SB_CSP_QSOUND_MAX_RIGHT / 2;
1058	p->qpos_changed = 0;
1059
1060	spin_lock_init(&p->q_lock);
1061
1062	if ((err = snd_ctl_add(card, p->qsound_switch = snd_ctl_new1(&snd_sb_qsound_switch, p))) < 0)
 
 
1063		goto __error;
1064	if ((err = snd_ctl_add(card, p->qsound_space = snd_ctl_new1(&snd_sb_qsound_space, p))) < 0)
 
 
 
1065		goto __error;
 
1066
1067	return 0;
1068
1069     __error:
1070	snd_sb_qsound_destroy(p);
1071	return err;
1072}
1073
1074static void snd_sb_qsound_destroy(struct snd_sb_csp * p)
1075{
1076	struct snd_card *card;
1077	unsigned long flags;
1078
1079	if (snd_BUG_ON(!p))
1080		return;
1081
1082	card = p->chip->card;	
1083	
1084	down_write(&card->controls_rwsem);
1085	if (p->qsound_switch)
1086		snd_ctl_remove(card, p->qsound_switch);
1087	if (p->qsound_space)
 
 
1088		snd_ctl_remove(card, p->qsound_space);
 
 
1089	up_write(&card->controls_rwsem);
1090
1091	/* cancel pending transfer of QSound parameters */
1092	spin_lock_irqsave (&p->q_lock, flags);
1093	p->qpos_changed = 0;
1094	spin_unlock_irqrestore (&p->q_lock, flags);
1095}
1096
1097/*
1098 * Transfer qsound parameters to CSP,
1099 * function should be called from interrupt routine
1100 */
1101static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p)
1102{
1103	int err = -ENXIO;
1104
1105	spin_lock(&p->q_lock);
1106	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
1107		set_codec_parameter(p->chip, 0xe0, 0x01);
1108		/* left channel */
1109		set_codec_parameter(p->chip, 0x00, p->qpos_left);
1110		set_codec_parameter(p->chip, 0x02, 0x00);
1111		/* right channel */
1112		set_codec_parameter(p->chip, 0x00, p->qpos_right);
1113		set_codec_parameter(p->chip, 0x03, 0x00);
1114		err = 0;
1115	}
1116	p->qpos_changed = 0;
1117	spin_unlock(&p->q_lock);
1118	return err;
1119}
1120
1121/* ------------------------------ */
1122
1123/*
1124 * proc interface
1125 */
1126static int init_proc_entry(struct snd_sb_csp * p, int device)
1127{
1128	char name[16];
1129	struct snd_info_entry *entry;
1130	sprintf(name, "cspD%d", device);
1131	if (! snd_card_proc_new(p->chip->card, name, &entry))
1132		snd_info_set_text_ops(entry, p, info_read);
1133	return 0;
1134}
1135
1136static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer)
1137{
1138	struct snd_sb_csp *p = entry->private_data;
1139
1140	snd_iprintf(buffer, "Creative Signal Processor [v%d.%d]\n", (p->version >> 4), (p->version & 0x0f));
1141	snd_iprintf(buffer, "State: %cx%c%c%c\n", ((p->running & SNDRV_SB_CSP_ST_QSOUND) ? 'Q' : '-'),
1142		    ((p->running & SNDRV_SB_CSP_ST_PAUSED) ? 'P' : '-'),
1143		    ((p->running & SNDRV_SB_CSP_ST_RUNNING) ? 'R' : '-'),
1144		    ((p->running & SNDRV_SB_CSP_ST_LOADED) ? 'L' : '-'));
1145	if (p->running & SNDRV_SB_CSP_ST_LOADED) {
1146		snd_iprintf(buffer, "Codec: %s [func #%d]\n", p->codec_name, p->func_nr);
1147		snd_iprintf(buffer, "Sample rates: ");
1148		if (p->acc_rates == SNDRV_SB_CSP_RATE_ALL) {
1149			snd_iprintf(buffer, "All\n");
1150		} else {
1151			snd_iprintf(buffer, "%s%s%s%s\n",
1152				    ((p->acc_rates & SNDRV_SB_CSP_RATE_8000) ? "8000Hz " : ""),
1153				    ((p->acc_rates & SNDRV_SB_CSP_RATE_11025) ? "11025Hz " : ""),
1154				    ((p->acc_rates & SNDRV_SB_CSP_RATE_22050) ? "22050Hz " : ""),
1155				    ((p->acc_rates & SNDRV_SB_CSP_RATE_44100) ? "44100Hz" : ""));
1156		}
1157		if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
1158			snd_iprintf(buffer, "QSound decoder %sabled\n",
1159				    p->q_enabled ? "en" : "dis");
1160		} else {
1161			snd_iprintf(buffer, "PCM format ID: 0x%x (%s/%s) [%s/%s] [%s/%s]\n",
1162				    p->acc_format,
1163				    ((p->acc_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? "16bit" : "-"),
1164				    ((p->acc_width & SNDRV_SB_CSP_SAMPLE_8BIT) ? "8bit" : "-"),
1165				    ((p->acc_channels & SNDRV_SB_CSP_MONO) ? "mono" : "-"),
1166				    ((p->acc_channels & SNDRV_SB_CSP_STEREO) ? "stereo" : "-"),
1167				    ((p->mode & SNDRV_SB_CSP_MODE_DSP_WRITE) ? "playback" : "-"),
1168				    ((p->mode & SNDRV_SB_CSP_MODE_DSP_READ) ? "capture" : "-"));
1169		}
1170	}
1171	if (p->running & SNDRV_SB_CSP_ST_AUTO) {
1172		snd_iprintf(buffer, "Autoloaded Mu-Law, A-Law or Ima-ADPCM hardware codec\n");
1173	}
1174	if (p->running & SNDRV_SB_CSP_ST_RUNNING) {
1175		snd_iprintf(buffer, "Processing %dbit %s PCM samples\n",
1176			    ((p->run_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? 16 : 8),
1177			    ((p->run_channels & SNDRV_SB_CSP_MONO) ? "mono" : "stereo"));
1178	}
1179	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
1180		snd_iprintf(buffer, "Qsound position: left = 0x%x, right = 0x%x\n",
1181			    p->qpos_left, p->qpos_right);
1182	}
1183}
1184
1185/* */
1186
1187EXPORT_SYMBOL(snd_sb_csp_new);
1188
1189/*
1190 * INIT part
1191 */
1192
1193static int __init alsa_sb_csp_init(void)
1194{
1195	return 0;
1196}
1197
1198static void __exit alsa_sb_csp_exit(void)
1199{
1200}
1201
1202module_init(alsa_sb_csp_init)
1203module_exit(alsa_sb_csp_exit)
v6.2
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *  Copyright (c) 1999 by Uros Bizjak <uros@kss-loka.si>
   4 *                        Takashi Iwai <tiwai@suse.de>
   5 *
   6 *  SB16ASP/AWE32 CSP control
   7 *
   8 *  CSP microcode loader:
   9 *   alsa-tools/sb16_csp/ 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  10 */
  11
  12#include <linux/delay.h>
  13#include <linux/init.h>
  14#include <linux/slab.h>
  15#include <linux/module.h>
  16#include <sound/core.h>
  17#include <sound/control.h>
  18#include <sound/info.h>
  19#include <sound/sb16_csp.h>
  20#include <sound/initval.h>
  21
  22MODULE_AUTHOR("Uros Bizjak <uros@kss-loka.si>");
  23MODULE_DESCRIPTION("ALSA driver for SB16 Creative Signal Processor");
  24MODULE_LICENSE("GPL");
  25MODULE_FIRMWARE("sb16/mulaw_main.csp");
  26MODULE_FIRMWARE("sb16/alaw_main.csp");
  27MODULE_FIRMWARE("sb16/ima_adpcm_init.csp");
  28MODULE_FIRMWARE("sb16/ima_adpcm_playback.csp");
  29MODULE_FIRMWARE("sb16/ima_adpcm_capture.csp");
  30
  31#ifdef SNDRV_LITTLE_ENDIAN
  32#define CSP_HDR_VALUE(a,b,c,d)	((a) | ((b)<<8) | ((c)<<16) | ((d)<<24))
  33#else
  34#define CSP_HDR_VALUE(a,b,c,d)	((d) | ((c)<<8) | ((b)<<16) | ((a)<<24))
  35#endif
  36
  37#define RIFF_HEADER	CSP_HDR_VALUE('R', 'I', 'F', 'F')
  38#define CSP__HEADER	CSP_HDR_VALUE('C', 'S', 'P', ' ')
  39#define LIST_HEADER	CSP_HDR_VALUE('L', 'I', 'S', 'T')
  40#define FUNC_HEADER	CSP_HDR_VALUE('f', 'u', 'n', 'c')
  41#define CODE_HEADER	CSP_HDR_VALUE('c', 'o', 'd', 'e')
  42#define INIT_HEADER	CSP_HDR_VALUE('i', 'n', 'i', 't')
  43#define MAIN_HEADER	CSP_HDR_VALUE('m', 'a', 'i', 'n')
  44
  45/*
  46 * RIFF data format
  47 */
  48struct riff_header {
  49	__le32 name;
  50	__le32 len;
  51};
  52
  53struct desc_header {
  54	struct riff_header info;
  55	__le16 func_nr;
  56	__le16 VOC_type;
  57	__le16 flags_play_rec;
  58	__le16 flags_16bit_8bit;
  59	__le16 flags_stereo_mono;
  60	__le16 flags_rates;
  61};
  62
  63/*
  64 * prototypes
  65 */
  66static void snd_sb_csp_free(struct snd_hwdep *hw);
  67static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file);
  68static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg);
  69static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file);
  70
  71static int csp_detect(struct snd_sb *chip, int *version);
  72static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val);
  73static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val);
  74static int read_register(struct snd_sb *chip, unsigned char reg);
  75static int set_mode_register(struct snd_sb *chip, unsigned char mode);
  76static int get_version(struct snd_sb *chip);
  77
  78static int snd_sb_csp_riff_load(struct snd_sb_csp * p,
  79				struct snd_sb_csp_microcode __user * code);
  80static int snd_sb_csp_unload(struct snd_sb_csp * p);
  81static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags);
  82static int snd_sb_csp_autoload(struct snd_sb_csp * p, snd_pcm_format_t pcm_sfmt, int play_rec_mode);
  83static int snd_sb_csp_check_version(struct snd_sb_csp * p);
  84
  85static int snd_sb_csp_use(struct snd_sb_csp * p);
  86static int snd_sb_csp_unuse(struct snd_sb_csp * p);
  87static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels);
  88static int snd_sb_csp_stop(struct snd_sb_csp * p);
  89static int snd_sb_csp_pause(struct snd_sb_csp * p);
  90static int snd_sb_csp_restart(struct snd_sb_csp * p);
  91
  92static int snd_sb_qsound_build(struct snd_sb_csp * p);
  93static void snd_sb_qsound_destroy(struct snd_sb_csp * p);
  94static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p);
  95
  96static int init_proc_entry(struct snd_sb_csp * p, int device);
  97static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer);
  98
  99/*
 100 * Detect CSP chip and create a new instance
 101 */
 102int snd_sb_csp_new(struct snd_sb *chip, int device, struct snd_hwdep ** rhwdep)
 103{
 104	struct snd_sb_csp *p;
 105	int version;
 106	int err;
 107	struct snd_hwdep *hw;
 108
 109	if (rhwdep)
 110		*rhwdep = NULL;
 111
 112	if (csp_detect(chip, &version))
 113		return -ENODEV;
 114
 115	err = snd_hwdep_new(chip->card, "SB16-CSP", device, &hw);
 116	if (err < 0)
 117		return err;
 118
 119	p = kzalloc(sizeof(*p), GFP_KERNEL);
 120	if (!p) {
 121		snd_device_free(chip->card, hw);
 122		return -ENOMEM;
 123	}
 124	p->chip = chip;
 125	p->version = version;
 126
 127	/* CSP operators */
 128	p->ops.csp_use = snd_sb_csp_use;
 129	p->ops.csp_unuse = snd_sb_csp_unuse;
 130	p->ops.csp_autoload = snd_sb_csp_autoload;
 131	p->ops.csp_start = snd_sb_csp_start;
 132	p->ops.csp_stop = snd_sb_csp_stop;
 133	p->ops.csp_qsound_transfer = snd_sb_csp_qsound_transfer;
 134
 135	mutex_init(&p->access_mutex);
 136	sprintf(hw->name, "CSP v%d.%d", (version >> 4), (version & 0x0f));
 137	hw->iface = SNDRV_HWDEP_IFACE_SB16CSP;
 138	hw->private_data = p;
 139	hw->private_free = snd_sb_csp_free;
 140
 141	/* operators - only write/ioctl */
 142	hw->ops.open = snd_sb_csp_open;
 143	hw->ops.ioctl = snd_sb_csp_ioctl;
 144	hw->ops.release = snd_sb_csp_release;
 145
 146	/* create a proc entry */
 147	init_proc_entry(p, device);
 148	if (rhwdep)
 149		*rhwdep = hw;
 150	return 0;
 151}
 152
 153/*
 154 * free_private for hwdep instance
 155 */
 156static void snd_sb_csp_free(struct snd_hwdep *hwdep)
 157{
 158	int i;
 159	struct snd_sb_csp *p = hwdep->private_data;
 160	if (p) {
 161		if (p->running & SNDRV_SB_CSP_ST_RUNNING)
 162			snd_sb_csp_stop(p);
 163		for (i = 0; i < ARRAY_SIZE(p->csp_programs); ++i)
 164			release_firmware(p->csp_programs[i]);
 165		kfree(p);
 166	}
 167}
 168
 169/* ------------------------------ */
 170
 171/*
 172 * open the device exclusively
 173 */
 174static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file)
 175{
 176	struct snd_sb_csp *p = hw->private_data;
 177	return (snd_sb_csp_use(p));
 178}
 179
 180/*
 181 * ioctl for hwdep device:
 182 */
 183static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg)
 184{
 185	struct snd_sb_csp *p = hw->private_data;
 186	struct snd_sb_csp_info info;
 187	struct snd_sb_csp_start start_info;
 188	int err;
 189
 190	if (snd_BUG_ON(!p))
 191		return -EINVAL;
 192
 193	if (snd_sb_csp_check_version(p))
 194		return -ENODEV;
 195
 196	switch (cmd) {
 197		/* get information */
 198	case SNDRV_SB_CSP_IOCTL_INFO:
 199		memset(&info, 0, sizeof(info));
 200		*info.codec_name = *p->codec_name;
 201		info.func_nr = p->func_nr;
 202		info.acc_format = p->acc_format;
 203		info.acc_channels = p->acc_channels;
 204		info.acc_width = p->acc_width;
 205		info.acc_rates = p->acc_rates;
 206		info.csp_mode = p->mode;
 207		info.run_channels = p->run_channels;
 208		info.run_width = p->run_width;
 209		info.version = p->version;
 210		info.state = p->running;
 211		if (copy_to_user((void __user *)arg, &info, sizeof(info)))
 212			err = -EFAULT;
 213		else
 214			err = 0;
 215		break;
 216
 217		/* load CSP microcode */
 218	case SNDRV_SB_CSP_IOCTL_LOAD_CODE:
 219		err = (p->running & SNDRV_SB_CSP_ST_RUNNING ?
 220		       -EBUSY : snd_sb_csp_riff_load(p, (struct snd_sb_csp_microcode __user *) arg));
 221		break;
 222	case SNDRV_SB_CSP_IOCTL_UNLOAD_CODE:
 223		err = (p->running & SNDRV_SB_CSP_ST_RUNNING ?
 224		       -EBUSY : snd_sb_csp_unload(p));
 225		break;
 226
 227		/* change CSP running state */
 228	case SNDRV_SB_CSP_IOCTL_START:
 229		if (copy_from_user(&start_info, (void __user *) arg, sizeof(start_info)))
 230			err = -EFAULT;
 231		else
 232			err = snd_sb_csp_start(p, start_info.sample_width, start_info.channels);
 233		break;
 234	case SNDRV_SB_CSP_IOCTL_STOP:
 235		err = snd_sb_csp_stop(p);
 236		break;
 237	case SNDRV_SB_CSP_IOCTL_PAUSE:
 238		err = snd_sb_csp_pause(p);
 239		break;
 240	case SNDRV_SB_CSP_IOCTL_RESTART:
 241		err = snd_sb_csp_restart(p);
 242		break;
 243	default:
 244		err = -ENOTTY;
 245		break;
 246	}
 247
 248	return err;
 249}
 250
 251/*
 252 * close the device
 253 */
 254static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file)
 255{
 256	struct snd_sb_csp *p = hw->private_data;
 257	return (snd_sb_csp_unuse(p));
 258}
 259
 260/* ------------------------------ */
 261
 262/*
 263 * acquire device
 264 */
 265static int snd_sb_csp_use(struct snd_sb_csp * p)
 266{
 267	mutex_lock(&p->access_mutex);
 268	if (p->used) {
 269		mutex_unlock(&p->access_mutex);
 270		return -EAGAIN;
 271	}
 272	p->used++;
 273	mutex_unlock(&p->access_mutex);
 274
 275	return 0;
 276
 277}
 278
 279/*
 280 * release device
 281 */
 282static int snd_sb_csp_unuse(struct snd_sb_csp * p)
 283{
 284	mutex_lock(&p->access_mutex);
 285	p->used--;
 286	mutex_unlock(&p->access_mutex);
 287
 288	return 0;
 289}
 290
 291/*
 292 * load microcode via ioctl: 
 293 * code is user-space pointer
 294 */
 295static int snd_sb_csp_riff_load(struct snd_sb_csp * p,
 296				struct snd_sb_csp_microcode __user * mcode)
 297{
 298	struct snd_sb_csp_mc_header info;
 299
 300	unsigned char __user *data_ptr;
 301	unsigned char __user *data_end;
 302	unsigned short func_nr = 0;
 303
 304	struct riff_header file_h, item_h, code_h;
 305	__le32 item_type;
 306	struct desc_header funcdesc_h;
 307
 308	unsigned long flags;
 309	int err;
 310
 311	if (copy_from_user(&info, mcode, sizeof(info)))
 312		return -EFAULT;
 313	data_ptr = mcode->data;
 314
 315	if (copy_from_user(&file_h, data_ptr, sizeof(file_h)))
 316		return -EFAULT;
 317	if ((le32_to_cpu(file_h.name) != RIFF_HEADER) ||
 318	    (le32_to_cpu(file_h.len) >= SNDRV_SB_CSP_MAX_MICROCODE_FILE_SIZE - sizeof(file_h))) {
 319		snd_printd("%s: Invalid RIFF header\n", __func__);
 320		return -EINVAL;
 321	}
 322	data_ptr += sizeof(file_h);
 323	data_end = data_ptr + le32_to_cpu(file_h.len);
 324
 325	if (copy_from_user(&item_type, data_ptr, sizeof(item_type)))
 326		return -EFAULT;
 327	if (le32_to_cpu(item_type) != CSP__HEADER) {
 328		snd_printd("%s: Invalid RIFF file type\n", __func__);
 329		return -EINVAL;
 330	}
 331	data_ptr += sizeof (item_type);
 332
 333	for (; data_ptr < data_end; data_ptr += le32_to_cpu(item_h.len)) {
 334		if (copy_from_user(&item_h, data_ptr, sizeof(item_h)))
 335			return -EFAULT;
 336		data_ptr += sizeof(item_h);
 337		if (le32_to_cpu(item_h.name) != LIST_HEADER)
 338			continue;
 339
 340		if (copy_from_user(&item_type, data_ptr, sizeof(item_type)))
 341			 return -EFAULT;
 342		switch (le32_to_cpu(item_type)) {
 343		case FUNC_HEADER:
 344			if (copy_from_user(&funcdesc_h, data_ptr + sizeof(item_type), sizeof(funcdesc_h)))
 345				return -EFAULT;
 346			func_nr = le16_to_cpu(funcdesc_h.func_nr);
 347			break;
 348		case CODE_HEADER:
 349			if (func_nr != info.func_req)
 350				break;	/* not required function, try next */
 351			data_ptr += sizeof(item_type);
 352
 353			/* destroy QSound mixer element */
 354			if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
 355				snd_sb_qsound_destroy(p);
 356			}
 357			/* Clear all flags */
 358			p->running = 0;
 359			p->mode = 0;
 360
 361			/* load microcode blocks */
 362			for (;;) {
 363				if (data_ptr >= data_end)
 364					return -EINVAL;
 365				if (copy_from_user(&code_h, data_ptr, sizeof(code_h)))
 366					return -EFAULT;
 367
 368				/* init microcode blocks */
 369				if (le32_to_cpu(code_h.name) != INIT_HEADER)
 370					break;
 371				data_ptr += sizeof(code_h);
 372				err = snd_sb_csp_load_user(p, data_ptr, le32_to_cpu(code_h.len),
 373						      SNDRV_SB_CSP_LOAD_INITBLOCK);
 374				if (err)
 375					return err;
 376				data_ptr += le32_to_cpu(code_h.len);
 377			}
 378			/* main microcode block */
 379			if (copy_from_user(&code_h, data_ptr, sizeof(code_h)))
 380				return -EFAULT;
 381
 382			if (le32_to_cpu(code_h.name) != MAIN_HEADER) {
 383				snd_printd("%s: Missing 'main' microcode\n", __func__);
 384				return -EINVAL;
 385			}
 386			data_ptr += sizeof(code_h);
 387			err = snd_sb_csp_load_user(p, data_ptr,
 388						   le32_to_cpu(code_h.len), 0);
 389			if (err)
 390				return err;
 391
 392			/* fill in codec header */
 393			strscpy(p->codec_name, info.codec_name, sizeof(p->codec_name));
 394			p->func_nr = func_nr;
 395			p->mode = le16_to_cpu(funcdesc_h.flags_play_rec);
 396			switch (le16_to_cpu(funcdesc_h.VOC_type)) {
 397			case 0x0001:	/* QSound decoder */
 398				if (le16_to_cpu(funcdesc_h.flags_play_rec) == SNDRV_SB_CSP_MODE_DSP_WRITE) {
 399					if (snd_sb_qsound_build(p) == 0)
 400						/* set QSound flag and clear all other mode flags */
 401						p->mode = SNDRV_SB_CSP_MODE_QSOUND;
 402				}
 403				p->acc_format = 0;
 404				break;
 405			case 0x0006:	/* A Law codec */
 406				p->acc_format = SNDRV_PCM_FMTBIT_A_LAW;
 407				break;
 408			case 0x0007:	/* Mu Law codec */
 409				p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW;
 410				break;
 411			case 0x0011:	/* what Creative thinks is IMA ADPCM codec */
 412			case 0x0200:	/* Creative ADPCM codec */
 413				p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM;
 414				break;
 415			case    201:	/* Text 2 Speech decoder */
 416				/* TODO: Text2Speech handling routines */
 417				p->acc_format = 0;
 418				break;
 419			case 0x0202:	/* Fast Speech 8 codec */
 420			case 0x0203:	/* Fast Speech 10 codec */
 421				p->acc_format = SNDRV_PCM_FMTBIT_SPECIAL;
 422				break;
 423			default:	/* other codecs are unsupported */
 424				p->acc_format = p->acc_width = p->acc_rates = 0;
 425				p->mode = 0;
 426				snd_printd("%s: Unsupported CSP codec type: 0x%04x\n",
 427					   __func__,
 428					   le16_to_cpu(funcdesc_h.VOC_type));
 429				return -EINVAL;
 430			}
 431			p->acc_channels = le16_to_cpu(funcdesc_h.flags_stereo_mono);
 432			p->acc_width = le16_to_cpu(funcdesc_h.flags_16bit_8bit);
 433			p->acc_rates = le16_to_cpu(funcdesc_h.flags_rates);
 434
 435			/* Decouple CSP from IRQ and DMAREQ lines */
 436			spin_lock_irqsave(&p->chip->reg_lock, flags);
 437			set_mode_register(p->chip, 0xfc);
 438			set_mode_register(p->chip, 0x00);
 439			spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 440
 441			/* finished loading successfully */
 442			p->running = SNDRV_SB_CSP_ST_LOADED;	/* set LOADED flag */
 443			return 0;
 444		}
 445	}
 446	snd_printd("%s: Function #%d not found\n", __func__, info.func_req);
 447	return -EINVAL;
 448}
 449
 450/*
 451 * unload CSP microcode
 452 */
 453static int snd_sb_csp_unload(struct snd_sb_csp * p)
 454{
 455	if (p->running & SNDRV_SB_CSP_ST_RUNNING)
 456		return -EBUSY;
 457	if (!(p->running & SNDRV_SB_CSP_ST_LOADED))
 458		return -ENXIO;
 459
 460	/* clear supported formats */
 461	p->acc_format = 0;
 462	p->acc_channels = p->acc_width = p->acc_rates = 0;
 463	/* destroy QSound mixer element */
 464	if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
 465		snd_sb_qsound_destroy(p);
 466	}
 467	/* clear all flags */
 468	p->running = 0;
 469	p->mode = 0;
 470	return 0;
 471}
 472
 473/*
 474 * send command sequence to DSP
 475 */
 476static inline int command_seq(struct snd_sb *chip, const unsigned char *seq, int size)
 477{
 478	int i;
 479	for (i = 0; i < size; i++) {
 480		if (!snd_sbdsp_command(chip, seq[i]))
 481			return -EIO;
 482	}
 483	return 0;
 484}
 485
 486/*
 487 * set CSP codec parameter
 488 */
 489static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val)
 490{
 491	unsigned char dsp_cmd[3];
 492
 493	dsp_cmd[0] = 0x05;	/* CSP set codec parameter */
 494	dsp_cmd[1] = val;	/* Parameter value */
 495	dsp_cmd[2] = par;	/* Parameter */
 496	command_seq(chip, dsp_cmd, 3);
 497	snd_sbdsp_command(chip, 0x03);	/* DSP read? */
 498	if (snd_sbdsp_get_byte(chip) != par)
 499		return -EIO;
 500	return 0;
 501}
 502
 503/*
 504 * set CSP register
 505 */
 506static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val)
 507{
 508	unsigned char dsp_cmd[3];
 509
 510	dsp_cmd[0] = 0x0e;	/* CSP set register */
 511	dsp_cmd[1] = reg;	/* CSP Register */
 512	dsp_cmd[2] = val;	/* value */
 513	return command_seq(chip, dsp_cmd, 3);
 514}
 515
 516/*
 517 * read CSP register
 518 * return < 0 -> error
 519 */
 520static int read_register(struct snd_sb *chip, unsigned char reg)
 521{
 522	unsigned char dsp_cmd[2];
 523
 524	dsp_cmd[0] = 0x0f;	/* CSP read register */
 525	dsp_cmd[1] = reg;	/* CSP Register */
 526	command_seq(chip, dsp_cmd, 2);
 527	return snd_sbdsp_get_byte(chip);	/* Read DSP value */
 528}
 529
 530/*
 531 * set CSP mode register
 532 */
 533static int set_mode_register(struct snd_sb *chip, unsigned char mode)
 534{
 535	unsigned char dsp_cmd[2];
 536
 537	dsp_cmd[0] = 0x04;	/* CSP set mode register */
 538	dsp_cmd[1] = mode;	/* mode */
 539	return command_seq(chip, dsp_cmd, 2);
 540}
 541
 542/*
 543 * Detect CSP
 544 * return 0 if CSP exists.
 545 */
 546static int csp_detect(struct snd_sb *chip, int *version)
 547{
 548	unsigned char csp_test1, csp_test2;
 549	unsigned long flags;
 550	int result = -ENODEV;
 551
 552	spin_lock_irqsave(&chip->reg_lock, flags);
 553
 554	set_codec_parameter(chip, 0x00, 0x00);
 555	set_mode_register(chip, 0xfc);		/* 0xfc = ?? */
 556
 557	csp_test1 = read_register(chip, 0x83);
 558	set_register(chip, 0x83, ~csp_test1);
 559	csp_test2 = read_register(chip, 0x83);
 560	if (csp_test2 != (csp_test1 ^ 0xff))
 561		goto __fail;
 562
 563	set_register(chip, 0x83, csp_test1);
 564	csp_test2 = read_register(chip, 0x83);
 565	if (csp_test2 != csp_test1)
 566		goto __fail;
 567
 568	set_mode_register(chip, 0x00);		/* 0x00 = ? */
 569
 570	*version = get_version(chip);
 571	snd_sbdsp_reset(chip);	/* reset DSP after getversion! */
 572	if (*version >= 0x10 && *version <= 0x1f)
 573		result = 0;		/* valid version id */
 574
 575      __fail:
 576	spin_unlock_irqrestore(&chip->reg_lock, flags);
 577	return result;
 578}
 579
 580/*
 581 * get CSP version number
 582 */
 583static int get_version(struct snd_sb *chip)
 584{
 585	unsigned char dsp_cmd[2];
 586
 587	dsp_cmd[0] = 0x08;	/* SB_DSP_!something! */
 588	dsp_cmd[1] = 0x03;	/* get chip version id? */
 589	command_seq(chip, dsp_cmd, 2);
 590
 591	return (snd_sbdsp_get_byte(chip));
 592}
 593
 594/*
 595 * check if the CSP version is valid
 596 */
 597static int snd_sb_csp_check_version(struct snd_sb_csp * p)
 598{
 599	if (p->version < 0x10 || p->version > 0x1f) {
 600		snd_printd("%s: Invalid CSP version: 0x%x\n", __func__, p->version);
 601		return 1;
 602	}
 603	return 0;
 604}
 605
 606/*
 607 * download microcode to CSP (microcode should have one "main" block).
 608 */
 609static int snd_sb_csp_load(struct snd_sb_csp * p, const unsigned char *buf, int size, int load_flags)
 610{
 611	int status, i;
 612	int err;
 613	int result = -EIO;
 614	unsigned long flags;
 615
 616	spin_lock_irqsave(&p->chip->reg_lock, flags);
 617	snd_sbdsp_command(p->chip, 0x01);	/* CSP download command */
 618	if (snd_sbdsp_get_byte(p->chip)) {
 619		snd_printd("%s: Download command failed\n", __func__);
 620		goto __fail;
 621	}
 622	/* Send CSP low byte (size - 1) */
 623	snd_sbdsp_command(p->chip, (unsigned char)(size - 1));
 624	/* Send high byte */
 625	snd_sbdsp_command(p->chip, (unsigned char)((size - 1) >> 8));
 626	/* send microcode sequence */
 627	/* load from kernel space */
 628	while (size--) {
 629		if (!snd_sbdsp_command(p->chip, *buf++))
 630			goto __fail;
 631	}
 632	if (snd_sbdsp_get_byte(p->chip))
 633		goto __fail;
 634
 635	if (load_flags & SNDRV_SB_CSP_LOAD_INITBLOCK) {
 636		i = 0;
 637		/* some codecs (FastSpeech) take some time to initialize */
 638		while (1) {
 639			snd_sbdsp_command(p->chip, 0x03);
 640			status = snd_sbdsp_get_byte(p->chip);
 641			if (status == 0x55 || ++i >= 10)
 642				break;
 643			udelay (10);
 644		}
 645		if (status != 0x55) {
 646			snd_printd("%s: Microcode initialization failed\n", __func__);
 647			goto __fail;
 648		}
 649	} else {
 650		/*
 651		 * Read mixer register SB_DSP4_DMASETUP after loading 'main' code.
 652		 * Start CSP chip if no 16bit DMA channel is set - some kind
 653		 * of autorun or perhaps a bugfix?
 654		 */
 655		spin_lock(&p->chip->mixer_lock);
 656		status = snd_sbmixer_read(p->chip, SB_DSP4_DMASETUP);
 657		spin_unlock(&p->chip->mixer_lock);
 658		if (!(status & (SB_DMASETUP_DMA7 | SB_DMASETUP_DMA6 | SB_DMASETUP_DMA5))) {
 659			err = (set_codec_parameter(p->chip, 0xaa, 0x00) ||
 660			       set_codec_parameter(p->chip, 0xff, 0x00));
 661			snd_sbdsp_reset(p->chip);		/* really! */
 662			if (err)
 663				goto __fail;
 664			set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 665			set_mode_register(p->chip, 0x70);	/* 70 = RUN */
 666		}
 667	}
 668	result = 0;
 669
 670      __fail:
 671	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 672	return result;
 673}
 674 
 675static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags)
 676{
 677	int err;
 678	unsigned char *kbuf;
 679
 680	kbuf = memdup_user(buf, size);
 681	if (IS_ERR(kbuf))
 682		return PTR_ERR(kbuf);
 683
 684	err = snd_sb_csp_load(p, kbuf, size, load_flags);
 685
 686	kfree(kbuf);
 687	return err;
 688}
 689
 690static int snd_sb_csp_firmware_load(struct snd_sb_csp *p, int index, int flags)
 691{
 692	static const char *const names[] = {
 693		"sb16/mulaw_main.csp",
 694		"sb16/alaw_main.csp",
 695		"sb16/ima_adpcm_init.csp",
 696		"sb16/ima_adpcm_playback.csp",
 697		"sb16/ima_adpcm_capture.csp",
 698	};
 699	const struct firmware *program;
 700
 701	BUILD_BUG_ON(ARRAY_SIZE(names) != CSP_PROGRAM_COUNT);
 702	program = p->csp_programs[index];
 703	if (!program) {
 704		int err = request_firmware(&program, names[index],
 705				       p->chip->card->dev);
 706		if (err < 0)
 707			return err;
 708		p->csp_programs[index] = program;
 709	}
 710	return snd_sb_csp_load(p, program->data, program->size, flags);
 711}
 712
 713/*
 714 * autoload hardware codec if necessary
 715 * return 0 if CSP is loaded and ready to run (p->running != 0)
 716 */
 717static int snd_sb_csp_autoload(struct snd_sb_csp * p, snd_pcm_format_t pcm_sfmt, int play_rec_mode)
 718{
 719	unsigned long flags;
 720	int err = 0;
 721
 722	/* if CSP is running or manually loaded then exit */
 723	if (p->running & (SNDRV_SB_CSP_ST_RUNNING | SNDRV_SB_CSP_ST_LOADED)) 
 724		return -EBUSY;
 725
 726	/* autoload microcode only if requested hardware codec is not already loaded */
 727	if (((1U << (__force int)pcm_sfmt) & p->acc_format) && (play_rec_mode & p->mode)) {
 728		p->running = SNDRV_SB_CSP_ST_AUTO;
 729	} else {
 730		switch (pcm_sfmt) {
 731		case SNDRV_PCM_FORMAT_MU_LAW:
 732			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_MULAW, 0);
 733			p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW;
 734			p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE;
 735			break;
 736		case SNDRV_PCM_FORMAT_A_LAW:
 737			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_ALAW, 0);
 738			p->acc_format = SNDRV_PCM_FMTBIT_A_LAW;
 739			p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE;
 740			break;
 741		case SNDRV_PCM_FORMAT_IMA_ADPCM:
 742			err = snd_sb_csp_firmware_load(p, CSP_PROGRAM_ADPCM_INIT,
 743						       SNDRV_SB_CSP_LOAD_INITBLOCK);
 744			if (err)
 745				break;
 746			if (play_rec_mode == SNDRV_SB_CSP_MODE_DSP_WRITE) {
 747				err = snd_sb_csp_firmware_load
 748					(p, CSP_PROGRAM_ADPCM_PLAYBACK, 0);
 749				p->mode = SNDRV_SB_CSP_MODE_DSP_WRITE;
 750			} else {
 751				err = snd_sb_csp_firmware_load
 752					(p, CSP_PROGRAM_ADPCM_CAPTURE, 0);
 753				p->mode = SNDRV_SB_CSP_MODE_DSP_READ;
 754			}
 755			p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM;
 756			break;				  
 757		default:
 758			/* Decouple CSP from IRQ and DMAREQ lines */
 759			if (p->running & SNDRV_SB_CSP_ST_AUTO) {
 760				spin_lock_irqsave(&p->chip->reg_lock, flags);
 761				set_mode_register(p->chip, 0xfc);
 762				set_mode_register(p->chip, 0x00);
 763				spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 764				p->running = 0;			/* clear autoloaded flag */
 765			}
 766			return -EINVAL;
 767		}
 768		if (err) {
 769			p->acc_format = 0;
 770			p->acc_channels = p->acc_width = p->acc_rates = 0;
 771
 772			p->running = 0;				/* clear autoloaded flag */
 773			p->mode = 0;
 774			return (err);
 775		} else {
 776			p->running = SNDRV_SB_CSP_ST_AUTO;	/* set autoloaded flag */
 777			p->acc_width = SNDRV_SB_CSP_SAMPLE_16BIT;	/* only 16 bit data */
 778			p->acc_channels = SNDRV_SB_CSP_MONO | SNDRV_SB_CSP_STEREO;
 779			p->acc_rates = SNDRV_SB_CSP_RATE_ALL;	/* HW codecs accept all rates */
 780		}   
 781
 782	}
 783	return (p->running & SNDRV_SB_CSP_ST_AUTO) ? 0 : -ENXIO;
 784}
 785
 786/*
 787 * start CSP
 788 */
 789static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels)
 790{
 791	unsigned char s_type;	/* sample type */
 792	unsigned char mixL, mixR;
 793	int result = -EIO;
 794	unsigned long flags;
 795
 796	if (!(p->running & (SNDRV_SB_CSP_ST_LOADED | SNDRV_SB_CSP_ST_AUTO))) {
 797		snd_printd("%s: Microcode not loaded\n", __func__);
 798		return -ENXIO;
 799	}
 800	if (p->running & SNDRV_SB_CSP_ST_RUNNING) {
 801		snd_printd("%s: CSP already running\n", __func__);
 802		return -EBUSY;
 803	}
 804	if (!(sample_width & p->acc_width)) {
 805		snd_printd("%s: Unsupported PCM sample width\n", __func__);
 806		return -EINVAL;
 807	}
 808	if (!(channels & p->acc_channels)) {
 809		snd_printd("%s: Invalid number of channels\n", __func__);
 810		return -EINVAL;
 811	}
 812
 813	/* Mute PCM volume */
 814	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 815	mixL = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV);
 816	mixR = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV + 1);
 817	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL & 0x7);
 818	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR & 0x7);
 819	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 820
 821	spin_lock(&p->chip->reg_lock);
 822	set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 823	set_mode_register(p->chip, 0x70);	/* 70 = RUN */
 824
 825	s_type = 0x00;
 826	if (channels == SNDRV_SB_CSP_MONO)
 827		s_type = 0x11;	/* 000n 000n    (n = 1 if mono) */
 828	if (sample_width == SNDRV_SB_CSP_SAMPLE_8BIT)
 829		s_type |= 0x22;	/* 00dX 00dX    (d = 1 if 8 bit samples) */
 830
 831	if (set_codec_parameter(p->chip, 0x81, s_type)) {
 832		snd_printd("%s: Set sample type command failed\n", __func__);
 833		goto __fail;
 834	}
 835	if (set_codec_parameter(p->chip, 0x80, 0x00)) {
 836		snd_printd("%s: Codec start command failed\n", __func__);
 837		goto __fail;
 838	}
 839	p->run_width = sample_width;
 840	p->run_channels = channels;
 841
 842	p->running |= SNDRV_SB_CSP_ST_RUNNING;
 843
 844	if (p->mode & SNDRV_SB_CSP_MODE_QSOUND) {
 845		set_codec_parameter(p->chip, 0xe0, 0x01);
 846		/* enable QSound decoder */
 847		set_codec_parameter(p->chip, 0x00, 0xff);
 848		set_codec_parameter(p->chip, 0x01, 0xff);
 849		p->running |= SNDRV_SB_CSP_ST_QSOUND;
 850		/* set QSound startup value */
 851		snd_sb_csp_qsound_transfer(p);
 852	}
 853	result = 0;
 854
 855      __fail:
 856	spin_unlock(&p->chip->reg_lock);
 857
 858	/* restore PCM volume */
 859	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 860	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL);
 861	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR);
 862	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 863
 864	return result;
 865}
 866
 867/*
 868 * stop CSP
 869 */
 870static int snd_sb_csp_stop(struct snd_sb_csp * p)
 871{
 872	int result;
 873	unsigned char mixL, mixR;
 874	unsigned long flags;
 875
 876	if (!(p->running & SNDRV_SB_CSP_ST_RUNNING))
 877		return 0;
 878
 879	/* Mute PCM volume */
 880	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 881	mixL = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV);
 882	mixR = snd_sbmixer_read(p->chip, SB_DSP4_PCM_DEV + 1);
 883	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL & 0x7);
 884	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR & 0x7);
 885	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 886
 887	spin_lock(&p->chip->reg_lock);
 888	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
 889		set_codec_parameter(p->chip, 0xe0, 0x01);
 890		/* disable QSound decoder */
 891		set_codec_parameter(p->chip, 0x00, 0x00);
 892		set_codec_parameter(p->chip, 0x01, 0x00);
 893
 894		p->running &= ~SNDRV_SB_CSP_ST_QSOUND;
 895	}
 896	result = set_mode_register(p->chip, 0xc0);	/* c0 = STOP */
 897	spin_unlock(&p->chip->reg_lock);
 898
 899	/* restore PCM volume */
 900	spin_lock_irqsave(&p->chip->mixer_lock, flags);
 901	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV, mixL);
 902	snd_sbmixer_write(p->chip, SB_DSP4_PCM_DEV + 1, mixR);
 903	spin_unlock_irqrestore(&p->chip->mixer_lock, flags);
 904
 905	if (!(result))
 906		p->running &= ~(SNDRV_SB_CSP_ST_PAUSED | SNDRV_SB_CSP_ST_RUNNING);
 907	return result;
 908}
 909
 910/*
 911 * pause CSP codec and hold DMA transfer
 912 */
 913static int snd_sb_csp_pause(struct snd_sb_csp * p)
 914{
 915	int result;
 916	unsigned long flags;
 917
 918	if (!(p->running & SNDRV_SB_CSP_ST_RUNNING))
 919		return -EBUSY;
 920
 921	spin_lock_irqsave(&p->chip->reg_lock, flags);
 922	result = set_codec_parameter(p->chip, 0x80, 0xff);
 923	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 924	if (!(result))
 925		p->running |= SNDRV_SB_CSP_ST_PAUSED;
 926
 927	return result;
 928}
 929
 930/*
 931 * restart CSP codec and resume DMA transfer
 932 */
 933static int snd_sb_csp_restart(struct snd_sb_csp * p)
 934{
 935	int result;
 936	unsigned long flags;
 937
 938	if (!(p->running & SNDRV_SB_CSP_ST_PAUSED))
 939		return -EBUSY;
 940
 941	spin_lock_irqsave(&p->chip->reg_lock, flags);
 942	result = set_codec_parameter(p->chip, 0x80, 0x00);
 943	spin_unlock_irqrestore(&p->chip->reg_lock, flags);
 944	if (!(result))
 945		p->running &= ~SNDRV_SB_CSP_ST_PAUSED;
 946
 947	return result;
 948}
 949
 950/* ------------------------------ */
 951
 952/*
 953 * QSound mixer control for PCM
 954 */
 955
 956#define snd_sb_qsound_switch_info	snd_ctl_boolean_mono_info
 957
 958static int snd_sb_qsound_switch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 959{
 960	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
 961	
 962	ucontrol->value.integer.value[0] = p->q_enabled ? 1 : 0;
 963	return 0;
 964}
 965
 966static int snd_sb_qsound_switch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 967{
 968	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
 969	unsigned long flags;
 970	int change;
 971	unsigned char nval;
 972	
 973	nval = ucontrol->value.integer.value[0] & 0x01;
 974	spin_lock_irqsave(&p->q_lock, flags);
 975	change = p->q_enabled != nval;
 976	p->q_enabled = nval;
 977	spin_unlock_irqrestore(&p->q_lock, flags);
 978	return change;
 979}
 980
 981static int snd_sb_qsound_space_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
 982{
 983	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 984	uinfo->count = 2;
 985	uinfo->value.integer.min = 0;
 986	uinfo->value.integer.max = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
 987	return 0;
 988}
 989
 990static int snd_sb_qsound_space_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 991{
 992	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
 993	unsigned long flags;
 994	
 995	spin_lock_irqsave(&p->q_lock, flags);
 996	ucontrol->value.integer.value[0] = p->qpos_left;
 997	ucontrol->value.integer.value[1] = p->qpos_right;
 998	spin_unlock_irqrestore(&p->q_lock, flags);
 999	return 0;
1000}
1001
1002static int snd_sb_qsound_space_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
1003{
1004	struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol);
1005	unsigned long flags;
1006	int change;
1007	unsigned char nval1, nval2;
1008	
1009	nval1 = ucontrol->value.integer.value[0];
1010	if (nval1 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT)
1011		nval1 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
1012	nval2 = ucontrol->value.integer.value[1];
1013	if (nval2 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT)
1014		nval2 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT;
1015	spin_lock_irqsave(&p->q_lock, flags);
1016	change = p->qpos_left != nval1 || p->qpos_right != nval2;
1017	p->qpos_left = nval1;
1018	p->qpos_right = nval2;
1019	p->qpos_changed = change;
1020	spin_unlock_irqrestore(&p->q_lock, flags);
1021	return change;
1022}
1023
1024static const struct snd_kcontrol_new snd_sb_qsound_switch = {
1025	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1026	.name = "3D Control - Switch",
1027	.info = snd_sb_qsound_switch_info,
1028	.get = snd_sb_qsound_switch_get,
1029	.put = snd_sb_qsound_switch_put
1030};
1031
1032static const struct snd_kcontrol_new snd_sb_qsound_space = {
1033	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1034	.name = "3D Control - Space",
1035	.info = snd_sb_qsound_space_info,
1036	.get = snd_sb_qsound_space_get,
1037	.put = snd_sb_qsound_space_put
1038};
1039
1040static int snd_sb_qsound_build(struct snd_sb_csp * p)
1041{
1042	struct snd_card *card;
1043	struct snd_kcontrol *kctl;
1044	int err;
1045
1046	if (snd_BUG_ON(!p))
1047		return -EINVAL;
1048
1049	card = p->chip->card;
1050	p->qpos_left = p->qpos_right = SNDRV_SB_CSP_QSOUND_MAX_RIGHT / 2;
1051	p->qpos_changed = 0;
1052
1053	spin_lock_init(&p->q_lock);
1054
1055	kctl = snd_ctl_new1(&snd_sb_qsound_switch, p);
1056	err = snd_ctl_add(card, kctl);
1057	if (err < 0)
1058		goto __error;
1059	p->qsound_switch = kctl;
1060	kctl = snd_ctl_new1(&snd_sb_qsound_space, p);
1061	err = snd_ctl_add(card, kctl);
1062	if (err < 0)
1063		goto __error;
1064	p->qsound_space = kctl;
1065
1066	return 0;
1067
1068     __error:
1069	snd_sb_qsound_destroy(p);
1070	return err;
1071}
1072
1073static void snd_sb_qsound_destroy(struct snd_sb_csp * p)
1074{
1075	struct snd_card *card;
1076	unsigned long flags;
1077
1078	if (snd_BUG_ON(!p))
1079		return;
1080
1081	card = p->chip->card;	
1082	
1083	down_write(&card->controls_rwsem);
1084	if (p->qsound_switch) {
1085		snd_ctl_remove(card, p->qsound_switch);
1086		p->qsound_switch = NULL;
1087	}
1088	if (p->qsound_space) {
1089		snd_ctl_remove(card, p->qsound_space);
1090		p->qsound_space = NULL;
1091	}
1092	up_write(&card->controls_rwsem);
1093
1094	/* cancel pending transfer of QSound parameters */
1095	spin_lock_irqsave (&p->q_lock, flags);
1096	p->qpos_changed = 0;
1097	spin_unlock_irqrestore (&p->q_lock, flags);
1098}
1099
1100/*
1101 * Transfer qsound parameters to CSP,
1102 * function should be called from interrupt routine
1103 */
1104static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p)
1105{
1106	int err = -ENXIO;
1107
1108	spin_lock(&p->q_lock);
1109	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
1110		set_codec_parameter(p->chip, 0xe0, 0x01);
1111		/* left channel */
1112		set_codec_parameter(p->chip, 0x00, p->qpos_left);
1113		set_codec_parameter(p->chip, 0x02, 0x00);
1114		/* right channel */
1115		set_codec_parameter(p->chip, 0x00, p->qpos_right);
1116		set_codec_parameter(p->chip, 0x03, 0x00);
1117		err = 0;
1118	}
1119	p->qpos_changed = 0;
1120	spin_unlock(&p->q_lock);
1121	return err;
1122}
1123
1124/* ------------------------------ */
1125
1126/*
1127 * proc interface
1128 */
1129static int init_proc_entry(struct snd_sb_csp * p, int device)
1130{
1131	char name[16];
1132
1133	sprintf(name, "cspD%d", device);
1134	snd_card_ro_proc_new(p->chip->card, name, p, info_read);
 
1135	return 0;
1136}
1137
1138static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer)
1139{
1140	struct snd_sb_csp *p = entry->private_data;
1141
1142	snd_iprintf(buffer, "Creative Signal Processor [v%d.%d]\n", (p->version >> 4), (p->version & 0x0f));
1143	snd_iprintf(buffer, "State: %cx%c%c%c\n", ((p->running & SNDRV_SB_CSP_ST_QSOUND) ? 'Q' : '-'),
1144		    ((p->running & SNDRV_SB_CSP_ST_PAUSED) ? 'P' : '-'),
1145		    ((p->running & SNDRV_SB_CSP_ST_RUNNING) ? 'R' : '-'),
1146		    ((p->running & SNDRV_SB_CSP_ST_LOADED) ? 'L' : '-'));
1147	if (p->running & SNDRV_SB_CSP_ST_LOADED) {
1148		snd_iprintf(buffer, "Codec: %s [func #%d]\n", p->codec_name, p->func_nr);
1149		snd_iprintf(buffer, "Sample rates: ");
1150		if (p->acc_rates == SNDRV_SB_CSP_RATE_ALL) {
1151			snd_iprintf(buffer, "All\n");
1152		} else {
1153			snd_iprintf(buffer, "%s%s%s%s\n",
1154				    ((p->acc_rates & SNDRV_SB_CSP_RATE_8000) ? "8000Hz " : ""),
1155				    ((p->acc_rates & SNDRV_SB_CSP_RATE_11025) ? "11025Hz " : ""),
1156				    ((p->acc_rates & SNDRV_SB_CSP_RATE_22050) ? "22050Hz " : ""),
1157				    ((p->acc_rates & SNDRV_SB_CSP_RATE_44100) ? "44100Hz" : ""));
1158		}
1159		if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) {
1160			snd_iprintf(buffer, "QSound decoder %sabled\n",
1161				    p->q_enabled ? "en" : "dis");
1162		} else {
1163			snd_iprintf(buffer, "PCM format ID: 0x%x (%s/%s) [%s/%s] [%s/%s]\n",
1164				    p->acc_format,
1165				    ((p->acc_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? "16bit" : "-"),
1166				    ((p->acc_width & SNDRV_SB_CSP_SAMPLE_8BIT) ? "8bit" : "-"),
1167				    ((p->acc_channels & SNDRV_SB_CSP_MONO) ? "mono" : "-"),
1168				    ((p->acc_channels & SNDRV_SB_CSP_STEREO) ? "stereo" : "-"),
1169				    ((p->mode & SNDRV_SB_CSP_MODE_DSP_WRITE) ? "playback" : "-"),
1170				    ((p->mode & SNDRV_SB_CSP_MODE_DSP_READ) ? "capture" : "-"));
1171		}
1172	}
1173	if (p->running & SNDRV_SB_CSP_ST_AUTO) {
1174		snd_iprintf(buffer, "Autoloaded Mu-Law, A-Law or Ima-ADPCM hardware codec\n");
1175	}
1176	if (p->running & SNDRV_SB_CSP_ST_RUNNING) {
1177		snd_iprintf(buffer, "Processing %dbit %s PCM samples\n",
1178			    ((p->run_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? 16 : 8),
1179			    ((p->run_channels & SNDRV_SB_CSP_MONO) ? "mono" : "stereo"));
1180	}
1181	if (p->running & SNDRV_SB_CSP_ST_QSOUND) {
1182		snd_iprintf(buffer, "Qsound position: left = 0x%x, right = 0x%x\n",
1183			    p->qpos_left, p->qpos_right);
1184	}
1185}
1186
1187/* */
1188
1189EXPORT_SYMBOL(snd_sb_csp_new);