mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 02:59:34 +00:00 
			
		
		
		
	 7e895cfaad
			
		
	
	
		7e895cfaad
		
	
	
	
	
		
			
			as long as the io channel number is not set by the driver, the card is not visible from the ethersound network Signed-off-by: Tim Blechmann <tim@klingt.org> Signed-off-by: Takashi Iwai <tiwai@suse.de>
		
			
				
	
	
		
			1159 lines
		
	
	
		
			28 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1159 lines
		
	
	
		
			28 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* -*- linux-c -*- *
 | |
|  *
 | |
|  * ALSA driver for the digigram lx6464es interface
 | |
|  *
 | |
|  * Copyright (c) 2008, 2009 Tim Blechmann <tim@klingt.org>
 | |
|  *
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License as published by
 | |
|  * the Free Software Foundation; either version 2 of the License, or
 | |
|  * (at your option) any later version.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; see the file COPYING.  If not, write to
 | |
|  * the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
 | |
|  * Boston, MA 02111-1307, USA.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/pci.h>
 | |
| #include <linux/delay.h>
 | |
| 
 | |
| #include <sound/initval.h>
 | |
| #include <sound/control.h>
 | |
| #include <sound/info.h>
 | |
| 
 | |
| #include "lx6464es.h"
 | |
| 
 | |
| MODULE_AUTHOR("Tim Blechmann");
 | |
| MODULE_LICENSE("GPL");
 | |
| MODULE_DESCRIPTION("digigram lx6464es");
 | |
| MODULE_SUPPORTED_DEVICE("{digigram lx6464es{}}");
 | |
| 
 | |
| 
 | |
| static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
 | |
| static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
 | |
| static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
 | |
| 
 | |
| module_param_array(index, int, NULL, 0444);
 | |
| MODULE_PARM_DESC(index, "Index value for Digigram LX6464ES interface.");
 | |
| module_param_array(id, charp, NULL, 0444);
 | |
| MODULE_PARM_DESC(id, "ID string for  Digigram LX6464ES interface.");
 | |
| module_param_array(enable, bool, NULL, 0444);
 | |
| MODULE_PARM_DESC(enable, "Enable/disable specific Digigram LX6464ES soundcards.");
 | |
| 
 | |
| static const char card_name[] = "LX6464ES";
 | |
| 
 | |
| 
 | |
| #define PCI_DEVICE_ID_PLX_LX6464ES		PCI_DEVICE_ID_PLX_9056
 | |
| 
 | |
| static struct pci_device_id snd_lx6464es_ids[] = {
 | |
| 	{ PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES),
 | |
| 	  .subvendor = PCI_VENDOR_ID_DIGIGRAM,
 | |
| 	  .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_SERIAL_SUBSYSTEM
 | |
| 	},			/* LX6464ES */
 | |
| 	{ PCI_DEVICE(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_LX6464ES),
 | |
| 	  .subvendor = PCI_VENDOR_ID_DIGIGRAM,
 | |
| 	  .subdevice = PCI_SUBDEVICE_ID_DIGIGRAM_LX6464ES_CAE_SERIAL_SUBSYSTEM
 | |
| 	},			/* LX6464ES-CAE */
 | |
| 	{ 0, },
 | |
| };
 | |
| 
 | |
| MODULE_DEVICE_TABLE(pci, snd_lx6464es_ids);
 | |
| 
 | |
| 
 | |
| 
 | |
| /* PGO pour USERo dans le registre pci_0x06/loc_0xEC */
 | |
| #define CHIPSC_RESET_XILINX (1L<<16)
 | |
| 
 | |
| 
 | |
| /* alsa callbacks */
 | |
| static struct snd_pcm_hardware lx_caps = {
 | |
| 	.info             = (SNDRV_PCM_INFO_MMAP |
 | |
| 			     SNDRV_PCM_INFO_INTERLEAVED |
 | |
| 			     SNDRV_PCM_INFO_MMAP_VALID |
 | |
| 			     SNDRV_PCM_INFO_SYNC_START),
 | |
| 	.formats	  = (SNDRV_PCM_FMTBIT_S16_LE |
 | |
| 			     SNDRV_PCM_FMTBIT_S16_BE |
 | |
| 			     SNDRV_PCM_FMTBIT_S24_3LE |
 | |
| 			     SNDRV_PCM_FMTBIT_S24_3BE),
 | |
| 	.rates            = (SNDRV_PCM_RATE_CONTINUOUS |
 | |
| 			     SNDRV_PCM_RATE_8000_192000),
 | |
| 	.rate_min         = 8000,
 | |
| 	.rate_max         = 192000,
 | |
| 	.channels_min     = 2,
 | |
| 	.channels_max     = 64,
 | |
| 	.buffer_bytes_max = 64*2*3*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER,
 | |
| 	.period_bytes_min = (2*2*MICROBLAZE_IBL_MIN*2),
 | |
| 	.period_bytes_max = (4*64*MICROBLAZE_IBL_MAX*MAX_STREAM_BUFFER),
 | |
| 	.periods_min      = 2,
 | |
| 	.periods_max      = MAX_STREAM_BUFFER,
 | |
| };
 | |
| 
 | |
| static int lx_set_granularity(struct lx6464es *chip, u32 gran);
 | |
| 
 | |
| 
 | |
| static int lx_hardware_open(struct lx6464es *chip,
 | |
| 			    struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	int channels = runtime->channels;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_pcm_uframes_t period_size = runtime->period_size;
 | |
| 
 | |
| 	snd_printd(LXP "allocating pipe for %d channels\n", channels);
 | |
| 	err = lx_pipe_allocate(chip, 0, is_capture, channels);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "allocating pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	err = lx_set_granularity(chip, period_size);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "setting granularity to %ld failed\n",
 | |
| 			   period_size);
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int lx_hardware_start(struct lx6464es *chip,
 | |
| 			     struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_printd(LXP "setting stream format\n");
 | |
| 	err = lx_stream_set_format(chip, runtime, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "setting stream format failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "starting pipe\n");
 | |
| 	err = lx_pipe_start(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "starting pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "waiting for pipe to start\n");
 | |
| 	err = lx_pipe_wait_for_start(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "waiting for pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int lx_hardware_stop(struct lx6464es *chip,
 | |
| 			    struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_printd(LXP "pausing pipe\n");
 | |
| 	err = lx_pipe_pause(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "pausing pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "waiting for pipe to become idle\n");
 | |
| 	err = lx_pipe_wait_for_idle(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "waiting for pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "stopping pipe\n");
 | |
| 	err = lx_pipe_stop(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(LXP "stopping pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int lx_hardware_close(struct lx6464es *chip,
 | |
| 			     struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_printd(LXP "releasing pipe\n");
 | |
| 	err = lx_pipe_release(chip, 0, is_capture);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(LXP "releasing pipe failed\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int lx_pcm_open(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	int err = 0;
 | |
| 	int board_rate;
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_open\n");
 | |
| 	mutex_lock(&chip->setup_mutex);
 | |
| 
 | |
| 	/* copy the struct snd_pcm_hardware struct */
 | |
| 	runtime->hw = lx_caps;
 | |
| 
 | |
| #if 0
 | |
| 	/* buffer-size should better be multiple of period-size */
 | |
| 	err = snd_pcm_hw_constraint_integer(runtime,
 | |
| 					    SNDRV_PCM_HW_PARAM_PERIODS);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_WARNING LXP "could not constrain periods\n");
 | |
| 		goto exit;
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| 	/* the clock rate cannot be changed */
 | |
| 	board_rate = chip->board_sample_rate;
 | |
| 	err = snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE,
 | |
| 					   board_rate, board_rate);
 | |
| 
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_WARNING LXP "could not constrain periods\n");
 | |
| 		goto exit;
 | |
| 	}
 | |
| 
 | |
| 	/* constrain period size */
 | |
| 	err = snd_pcm_hw_constraint_minmax(runtime,
 | |
| 					   SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
 | |
| 					   MICROBLAZE_IBL_MIN,
 | |
| 					   MICROBLAZE_IBL_MAX);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_WARNING LXP
 | |
| 			   "could not constrain period size\n");
 | |
| 		goto exit;
 | |
| 	}
 | |
| 
 | |
| 	snd_pcm_hw_constraint_step(runtime, 0,
 | |
| 				   SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32);
 | |
| 
 | |
| 	snd_pcm_set_sync(substream);
 | |
| 	err = 0;
 | |
| 
 | |
| exit:
 | |
| 	runtime->private_data = chip;
 | |
| 
 | |
| 	mutex_unlock(&chip->setup_mutex);
 | |
| 	snd_printdd("<-lx_pcm_open, %d\n", err);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int lx_pcm_close(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	snd_printdd("->lx_pcm_close\n");
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static snd_pcm_uframes_t lx_pcm_stream_pointer(struct snd_pcm_substream
 | |
| 					       *substream)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	snd_pcm_uframes_t pos;
 | |
| 	unsigned long flags;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	struct lx_stream *lx_stream = is_capture ? &chip->capture_stream :
 | |
| 		&chip->playback_stream;
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_stream_pointer\n");
 | |
| 
 | |
| 	spin_lock_irqsave(&chip->lock, flags);
 | |
| 	pos = lx_stream->frame_pos * substream->runtime->period_size;
 | |
| 	spin_unlock_irqrestore(&chip->lock, flags);
 | |
| 
 | |
| 	snd_printdd(LXP "stream_pointer at %ld\n", pos);
 | |
| 	return pos;
 | |
| }
 | |
| 
 | |
| static int lx_pcm_prepare(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	int err = 0;
 | |
| 	const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_prepare\n");
 | |
| 
 | |
| 	mutex_lock(&chip->setup_mutex);
 | |
| 
 | |
| 	if (chip->hardware_running[is_capture]) {
 | |
| 		err = lx_hardware_stop(chip, substream);
 | |
| 		if (err < 0) {
 | |
| 			snd_printk(KERN_ERR LXP "failed to stop hardware. "
 | |
| 				   "Error code %d\n", err);
 | |
| 			goto exit;
 | |
| 		}
 | |
| 
 | |
| 		err = lx_hardware_close(chip, substream);
 | |
| 		if (err < 0) {
 | |
| 			snd_printk(KERN_ERR LXP "failed to close hardware. "
 | |
| 				   "Error code %d\n", err);
 | |
| 			goto exit;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "opening hardware\n");
 | |
| 	err = lx_hardware_open(chip, substream);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "failed to open hardware. "
 | |
| 			   "Error code %d\n", err);
 | |
| 		goto exit;
 | |
| 	}
 | |
| 
 | |
| 	err = lx_hardware_start(chip, substream);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "failed to start hardware. "
 | |
| 			   "Error code %d\n", err);
 | |
| 		goto exit;
 | |
| 	}
 | |
| 
 | |
| 	chip->hardware_running[is_capture] = 1;
 | |
| 
 | |
| 	if (chip->board_sample_rate != substream->runtime->rate) {
 | |
| 		if (!err)
 | |
| 			chip->board_sample_rate = substream->runtime->rate;
 | |
| 	}
 | |
| 
 | |
| exit:
 | |
| 	mutex_unlock(&chip->setup_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int lx_pcm_hw_params(struct snd_pcm_substream *substream,
 | |
| 			    struct snd_pcm_hw_params *hw_params, int is_capture)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	int err = 0;
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_hw_params\n");
 | |
| 
 | |
| 	mutex_lock(&chip->setup_mutex);
 | |
| 
 | |
| 	/* set dma buffer */
 | |
| 	err = snd_pcm_lib_malloc_pages(substream,
 | |
| 				       params_buffer_bytes(hw_params));
 | |
| 
 | |
| 	if (is_capture)
 | |
| 		chip->capture_stream.stream = substream;
 | |
| 	else
 | |
| 		chip->playback_stream.stream = substream;
 | |
| 
 | |
| 	mutex_unlock(&chip->setup_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int lx_pcm_hw_params_playback(struct snd_pcm_substream *substream,
 | |
| 				 struct snd_pcm_hw_params *hw_params)
 | |
| {
 | |
| 	return lx_pcm_hw_params(substream, hw_params, 0);
 | |
| }
 | |
| 
 | |
| static int lx_pcm_hw_params_capture(struct snd_pcm_substream *substream,
 | |
| 				 struct snd_pcm_hw_params *hw_params)
 | |
| {
 | |
| 	return lx_pcm_hw_params(substream, hw_params, 1);
 | |
| }
 | |
| 
 | |
| static int lx_pcm_hw_free(struct snd_pcm_substream *substream)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	int err = 0;
 | |
| 	int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_hw_free\n");
 | |
| 	mutex_lock(&chip->setup_mutex);
 | |
| 
 | |
| 	if (chip->hardware_running[is_capture]) {
 | |
| 		err = lx_hardware_stop(chip, substream);
 | |
| 		if (err < 0) {
 | |
| 			snd_printk(KERN_ERR LXP "failed to stop hardware. "
 | |
| 				   "Error code %d\n", err);
 | |
| 			goto exit;
 | |
| 		}
 | |
| 
 | |
| 		err = lx_hardware_close(chip, substream);
 | |
| 		if (err < 0) {
 | |
| 			snd_printk(KERN_ERR LXP "failed to close hardware. "
 | |
| 				   "Error code %d\n", err);
 | |
| 			goto exit;
 | |
| 		}
 | |
| 
 | |
| 		chip->hardware_running[is_capture] = 0;
 | |
| 	}
 | |
| 
 | |
| 	err = snd_pcm_lib_free_pages(substream);
 | |
| 
 | |
| 	if (is_capture)
 | |
| 		chip->capture_stream.stream = 0;
 | |
| 	else
 | |
| 		chip->playback_stream.stream = 0;
 | |
| 
 | |
| exit:
 | |
| 	mutex_unlock(&chip->setup_mutex);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void lx_trigger_start(struct lx6464es *chip, struct lx_stream *lx_stream)
 | |
| {
 | |
| 	struct snd_pcm_substream *substream = lx_stream->stream;
 | |
| 	const int is_capture = lx_stream->is_capture;
 | |
| 
 | |
| 	int err;
 | |
| 
 | |
| 	const u32 channels = substream->runtime->channels;
 | |
| 	const u32 bytes_per_frame = channels * 3;
 | |
| 	const u32 period_size = substream->runtime->period_size;
 | |
| 	const u32 periods = substream->runtime->periods;
 | |
| 	const u32 period_bytes = period_size * bytes_per_frame;
 | |
| 
 | |
| 	dma_addr_t buf = substream->dma_buffer.addr;
 | |
| 	int i;
 | |
| 
 | |
| 	u32 needed, freed;
 | |
| 	u32 size_array[5];
 | |
| 
 | |
| 	for (i = 0; i != periods; ++i) {
 | |
| 		u32 buffer_index = 0;
 | |
| 
 | |
| 		err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed,
 | |
| 				    size_array);
 | |
| 		snd_printdd(LXP "starting: needed %d, freed %d\n",
 | |
| 			    needed, freed);
 | |
| 
 | |
| 		err = lx_buffer_give(chip, 0, is_capture, period_bytes,
 | |
| 				     lower_32_bits(buf), upper_32_bits(buf),
 | |
| 				     &buffer_index);
 | |
| 
 | |
| 		snd_printdd(LXP "starting: buffer index %x on %p (%d bytes)\n",
 | |
| 			    buffer_index, (void *)buf, period_bytes);
 | |
| 		buf += period_bytes;
 | |
| 	}
 | |
| 
 | |
| 	err = lx_buffer_ask(chip, 0, is_capture, &needed, &freed, size_array);
 | |
| 	snd_printdd(LXP "starting: needed %d, freed %d\n", needed, freed);
 | |
| 
 | |
| 	snd_printd(LXP "starting: starting stream\n");
 | |
| 	err = lx_stream_start(chip, 0, is_capture);
 | |
| 	if (err < 0)
 | |
| 		snd_printk(KERN_ERR LXP "couldn't start stream\n");
 | |
| 	else
 | |
| 		lx_stream->status = LX_STREAM_STATUS_RUNNING;
 | |
| 
 | |
| 	lx_stream->frame_pos = 0;
 | |
| }
 | |
| 
 | |
| static void lx_trigger_stop(struct lx6464es *chip, struct lx_stream *lx_stream)
 | |
| {
 | |
| 	const int is_capture = lx_stream->is_capture;
 | |
| 	int err;
 | |
| 
 | |
| 	snd_printd(LXP "stopping: stopping stream\n");
 | |
| 	err = lx_stream_stop(chip, 0, is_capture);
 | |
| 	if (err < 0)
 | |
| 		snd_printk(KERN_ERR LXP "couldn't stop stream\n");
 | |
| 	else
 | |
| 		lx_stream->status = LX_STREAM_STATUS_FREE;
 | |
| 
 | |
| }
 | |
| 
 | |
| static void lx_trigger_tasklet_dispatch_stream(struct lx6464es *chip,
 | |
| 					       struct lx_stream *lx_stream)
 | |
| {
 | |
| 	switch (lx_stream->status) {
 | |
| 	case LX_STREAM_STATUS_SCHEDULE_RUN:
 | |
| 		lx_trigger_start(chip, lx_stream);
 | |
| 		break;
 | |
| 
 | |
| 	case LX_STREAM_STATUS_SCHEDULE_STOP:
 | |
| 		lx_trigger_stop(chip, lx_stream);
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void lx_trigger_tasklet(unsigned long data)
 | |
| {
 | |
| 	struct lx6464es *chip = (struct lx6464es *)data;
 | |
| 	unsigned long flags;
 | |
| 
 | |
| 	snd_printdd("->lx_trigger_tasklet\n");
 | |
| 
 | |
| 	spin_lock_irqsave(&chip->lock, flags);
 | |
| 	lx_trigger_tasklet_dispatch_stream(chip, &chip->capture_stream);
 | |
| 	lx_trigger_tasklet_dispatch_stream(chip, &chip->playback_stream);
 | |
| 	spin_unlock_irqrestore(&chip->lock, flags);
 | |
| }
 | |
| 
 | |
| static int lx_pcm_trigger_dispatch(struct lx6464es *chip,
 | |
| 				   struct lx_stream *lx_stream, int cmd)
 | |
| {
 | |
| 	int err = 0;
 | |
| 
 | |
| 	switch (cmd) {
 | |
| 	case SNDRV_PCM_TRIGGER_START:
 | |
| 		lx_stream->status = LX_STREAM_STATUS_SCHEDULE_RUN;
 | |
| 		break;
 | |
| 
 | |
| 	case SNDRV_PCM_TRIGGER_STOP:
 | |
| 		lx_stream->status = LX_STREAM_STATUS_SCHEDULE_STOP;
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		err = -EINVAL;
 | |
| 		goto exit;
 | |
| 	}
 | |
| 	tasklet_schedule(&chip->trigger_tasklet);
 | |
| 
 | |
| exit:
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int lx_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_pcm_substream_chip(substream);
 | |
| 	const int is_capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
 | |
| 	struct lx_stream *stream = is_capture ? &chip->capture_stream :
 | |
| 		&chip->playback_stream;
 | |
| 
 | |
| 	snd_printdd("->lx_pcm_trigger\n");
 | |
| 
 | |
| 	return lx_pcm_trigger_dispatch(chip, stream, cmd);
 | |
| }
 | |
| 
 | |
| static int snd_lx6464es_free(struct lx6464es *chip)
 | |
| {
 | |
| 	snd_printdd("->snd_lx6464es_free\n");
 | |
| 
 | |
| 	lx_irq_disable(chip);
 | |
| 
 | |
| 	if (chip->irq >= 0)
 | |
| 		free_irq(chip->irq, chip);
 | |
| 
 | |
| 	iounmap(chip->port_dsp_bar);
 | |
| 	ioport_unmap(chip->port_plx_remapped);
 | |
| 
 | |
| 	pci_release_regions(chip->pci);
 | |
| 	pci_disable_device(chip->pci);
 | |
| 
 | |
| 	kfree(chip);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_lx6464es_dev_free(struct snd_device *device)
 | |
| {
 | |
| 	return snd_lx6464es_free(device->device_data);
 | |
| }
 | |
| 
 | |
| /* reset the dsp during initialization */
 | |
| static int __devinit lx_init_xilinx_reset(struct lx6464es *chip)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 plx_reg = lx_plx_reg_read(chip, ePLX_CHIPSC);
 | |
| 
 | |
| 	snd_printdd("->lx_init_xilinx_reset\n");
 | |
| 
 | |
| 	/* activate reset of xilinx */
 | |
| 	plx_reg &= ~CHIPSC_RESET_XILINX;
 | |
| 
 | |
| 	lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg);
 | |
| 	msleep(1);
 | |
| 
 | |
| 	lx_plx_reg_write(chip, ePLX_MBOX3, 0);
 | |
| 	msleep(1);
 | |
| 
 | |
| 	plx_reg |= CHIPSC_RESET_XILINX;
 | |
| 	lx_plx_reg_write(chip, ePLX_CHIPSC, plx_reg);
 | |
| 
 | |
| 	/* deactivate reset of xilinx */
 | |
| 	for (i = 0; i != 100; ++i) {
 | |
| 		u32 reg_mbox3;
 | |
| 		msleep(10);
 | |
| 		reg_mbox3 = lx_plx_reg_read(chip, ePLX_MBOX3);
 | |
| 		if (reg_mbox3) {
 | |
| 			snd_printd(LXP "xilinx reset done\n");
 | |
| 			snd_printdd(LXP "xilinx took %d loops\n", i);
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	/* todo: add some error handling? */
 | |
| 
 | |
| 	/* clear mr */
 | |
| 	lx_dsp_reg_write(chip, eReg_CSM, 0);
 | |
| 
 | |
| 	/* le xilinx ES peut ne pas etre encore pret, on attend. */
 | |
| 	msleep(600);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __devinit lx_init_xilinx_test(struct lx6464es *chip)
 | |
| {
 | |
| 	u32 reg;
 | |
| 
 | |
| 	snd_printdd("->lx_init_xilinx_test\n");
 | |
| 
 | |
| 	/* TEST if we have access to Xilinx/MicroBlaze */
 | |
| 	lx_dsp_reg_write(chip, eReg_CSM, 0);
 | |
| 
 | |
| 	reg = lx_dsp_reg_read(chip, eReg_CSM);
 | |
| 
 | |
| 	if (reg) {
 | |
| 		snd_printk(KERN_ERR LXP "Problem: Reg_CSM %x.\n", reg);
 | |
| 
 | |
| 		/* PCI9056_SPACE0_REMAP */
 | |
| 		lx_plx_reg_write(chip, ePLX_PCICR, 1);
 | |
| 
 | |
| 		reg = lx_dsp_reg_read(chip, eReg_CSM);
 | |
| 		if (reg) {
 | |
| 			snd_printk(KERN_ERR LXP "Error: Reg_CSM %x.\n", reg);
 | |
| 			return -EAGAIN; /* seems to be appropriate */
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	snd_printd(LXP "Xilinx/MicroBlaze access test successful\n");
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* initialize ethersound */
 | |
| static int __devinit lx_init_ethersound_config(struct lx6464es *chip)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 orig_conf_es = lx_dsp_reg_read(chip, eReg_CONFES);
 | |
| 
 | |
| 	/* configure 64 io channels */
 | |
| 	u32 conf_es = (orig_conf_es & CONFES_READ_PART_MASK) |
 | |
| 		(64 << IOCR_INPUTS_OFFSET) |
 | |
| 		(64 << IOCR_OUTPUTS_OFFSET) |
 | |
| 		(FREQ_RATIO_SINGLE_MODE << FREQ_RATIO_OFFSET);
 | |
| 
 | |
| 	snd_printdd("->lx_init_ethersound\n");
 | |
| 
 | |
| 	chip->freq_ratio = FREQ_RATIO_SINGLE_MODE;
 | |
| 
 | |
| 	/*
 | |
| 	 * write it to the card !
 | |
| 	 * this actually kicks the ES xilinx, the first time since poweron.
 | |
| 	 * the MAC address in the Reg_ADMACESMSB Reg_ADMACESLSB registers
 | |
| 	 * is not ready before this is done, and the bit 2 in Reg_CSES is set.
 | |
| 	 * */
 | |
| 	lx_dsp_reg_write(chip, eReg_CONFES, conf_es);
 | |
| 
 | |
| 	for (i = 0; i != 1000; ++i) {
 | |
| 		if (lx_dsp_reg_read(chip, eReg_CSES) & 4) {
 | |
| 			snd_printd(LXP "ethersound initialized after %dms\n",
 | |
| 				   i);
 | |
| 			goto ethersound_initialized;
 | |
| 		}
 | |
| 		msleep(1);
 | |
| 	}
 | |
| 	snd_printk(KERN_WARNING LXP
 | |
| 		   "ethersound could not be initialized after %dms\n", i);
 | |
| 	return -ETIMEDOUT;
 | |
| 
 | |
|  ethersound_initialized:
 | |
| 	snd_printd(LXP "ethersound initialized\n");
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __devinit lx_init_get_version_features(struct lx6464es *chip)
 | |
| {
 | |
| 	u32 dsp_version;
 | |
| 
 | |
| 	int err;
 | |
| 
 | |
| 	snd_printdd("->lx_init_get_version_features\n");
 | |
| 
 | |
| 	err = lx_dsp_get_version(chip, &dsp_version);
 | |
| 
 | |
| 	if (err == 0) {
 | |
| 		u32 freq;
 | |
| 
 | |
| 		snd_printk(LXP "DSP version: V%02d.%02d #%d\n",
 | |
| 			   (dsp_version>>16) & 0xff, (dsp_version>>8) & 0xff,
 | |
| 			   dsp_version & 0xff);
 | |
| 
 | |
| 		/* later: what firmware version do we expect? */
 | |
| 
 | |
| 		/* retrieve Play/Rec features */
 | |
| 		/* done here because we may have to handle alternate
 | |
| 		 * DSP files. */
 | |
| 		/* later */
 | |
| 
 | |
| 		/* init the EtherSound sample rate */
 | |
| 		err = lx_dsp_get_clock_frequency(chip, &freq);
 | |
| 		if (err == 0)
 | |
| 			chip->board_sample_rate = freq;
 | |
| 		snd_printd(LXP "actual clock frequency %d\n", freq);
 | |
| 	} else {
 | |
| 		snd_printk(KERN_ERR LXP "DSP corrupted \n");
 | |
| 		err = -EAGAIN;
 | |
| 	}
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int lx_set_granularity(struct lx6464es *chip, u32 gran)
 | |
| {
 | |
| 	int err = 0;
 | |
| 	u32 snapped_gran = MICROBLAZE_IBL_MIN;
 | |
| 
 | |
| 	snd_printdd("->lx_set_granularity\n");
 | |
| 
 | |
| 	/* blocksize is a power of 2 */
 | |
| 	while ((snapped_gran < gran) &&
 | |
| 	       (snapped_gran < MICROBLAZE_IBL_MAX)) {
 | |
| 		snapped_gran *= 2;
 | |
| 	}
 | |
| 
 | |
| 	if (snapped_gran == chip->pcm_granularity)
 | |
| 		return 0;
 | |
| 
 | |
| 	err = lx_dsp_set_granularity(chip, snapped_gran);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_WARNING LXP "could not set granularity\n");
 | |
| 		err = -EAGAIN;
 | |
| 	}
 | |
| 
 | |
| 	if (snapped_gran != gran)
 | |
| 		snd_printk(LXP "snapped blocksize to %d\n", snapped_gran);
 | |
| 
 | |
| 	snd_printd(LXP "set blocksize on board %d\n", snapped_gran);
 | |
| 	chip->pcm_granularity = snapped_gran;
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| /* initialize and test the xilinx dsp chip */
 | |
| static int __devinit lx_init_dsp(struct lx6464es *chip)
 | |
| {
 | |
| 	int err;
 | |
| 	u8 mac_address[6];
 | |
| 	int i;
 | |
| 
 | |
| 	snd_printdd("->lx_init_dsp\n");
 | |
| 
 | |
| 	snd_printd(LXP "initialize board\n");
 | |
| 	err = lx_init_xilinx_reset(chip);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	snd_printd(LXP "testing board\n");
 | |
| 	err = lx_init_xilinx_test(chip);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	snd_printd(LXP "initialize ethersound configuration\n");
 | |
| 	err = lx_init_ethersound_config(chip);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	lx_irq_enable(chip);
 | |
| 
 | |
| 	/** \todo the mac address should be ready by not, but it isn't,
 | |
| 	 *  so we wait for it */
 | |
| 	for (i = 0; i != 1000; ++i) {
 | |
| 		err = lx_dsp_get_mac(chip, mac_address);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		if (mac_address[0] || mac_address[1] || mac_address[2] ||
 | |
| 		    mac_address[3] || mac_address[4] || mac_address[5])
 | |
| 			goto mac_ready;
 | |
| 		msleep(1);
 | |
| 	}
 | |
| 	return -ETIMEDOUT;
 | |
| 
 | |
| mac_ready:
 | |
| 	snd_printd(LXP "mac address ready read after: %dms\n", i);
 | |
| 	snd_printk(LXP "mac address: %02X.%02X.%02X.%02X.%02X.%02X\n",
 | |
| 		   mac_address[0], mac_address[1], mac_address[2],
 | |
| 		   mac_address[3], mac_address[4], mac_address[5]);
 | |
| 
 | |
| 	err = lx_init_get_version_features(chip);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	lx_set_granularity(chip, MICROBLAZE_IBL_DEFAULT);
 | |
| 
 | |
| 	chip->playback_mute = 0;
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static struct snd_pcm_ops lx_ops_playback = {
 | |
| 	.open      = lx_pcm_open,
 | |
| 	.close     = lx_pcm_close,
 | |
| 	.ioctl     = snd_pcm_lib_ioctl,
 | |
| 	.prepare   = lx_pcm_prepare,
 | |
| 	.hw_params = lx_pcm_hw_params_playback,
 | |
| 	.hw_free   = lx_pcm_hw_free,
 | |
| 	.trigger   = lx_pcm_trigger,
 | |
| 	.pointer   = lx_pcm_stream_pointer,
 | |
| };
 | |
| 
 | |
| static struct snd_pcm_ops lx_ops_capture = {
 | |
| 	.open      = lx_pcm_open,
 | |
| 	.close     = lx_pcm_close,
 | |
| 	.ioctl     = snd_pcm_lib_ioctl,
 | |
| 	.prepare   = lx_pcm_prepare,
 | |
| 	.hw_params = lx_pcm_hw_params_capture,
 | |
| 	.hw_free   = lx_pcm_hw_free,
 | |
| 	.trigger   = lx_pcm_trigger,
 | |
| 	.pointer   = lx_pcm_stream_pointer,
 | |
| };
 | |
| 
 | |
| static int __devinit lx_pcm_create(struct lx6464es *chip)
 | |
| {
 | |
| 	int err;
 | |
| 	struct snd_pcm *pcm;
 | |
| 
 | |
| 	u32 size = 64 *		     /* channels */
 | |
| 		3 *		     /* 24 bit samples */
 | |
| 		MAX_STREAM_BUFFER *  /* periods */
 | |
| 		MICROBLAZE_IBL_MAX * /* frames per period */
 | |
| 		2;		     /* duplex */
 | |
| 
 | |
| 	size = PAGE_ALIGN(size);
 | |
| 
 | |
| 	/* hardcoded device name & channel count */
 | |
| 	err = snd_pcm_new(chip->card, (char *)card_name, 0,
 | |
| 			  1, 1, &pcm);
 | |
| 
 | |
| 	pcm->private_data = chip;
 | |
| 
 | |
| 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &lx_ops_playback);
 | |
| 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &lx_ops_capture);
 | |
| 
 | |
| 	pcm->info_flags = 0;
 | |
| 	strcpy(pcm->name, card_name);
 | |
| 
 | |
| 	err = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
 | |
| 						    snd_dma_pci_data(chip->pci),
 | |
| 						    size, size);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	chip->pcm = pcm;
 | |
| 	chip->capture_stream.is_capture = 1;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int lx_control_playback_info(struct snd_kcontrol *kcontrol,
 | |
| 				    struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
 | |
| 	uinfo->count = 1;
 | |
| 	uinfo->value.integer.min = 0;
 | |
| 	uinfo->value.integer.max = 1;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int lx_control_playback_get(struct snd_kcontrol *kcontrol,
 | |
| 				   struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
 | |
| 	ucontrol->value.integer.value[0] = chip->playback_mute;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int lx_control_playback_put(struct snd_kcontrol *kcontrol,
 | |
| 				   struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct lx6464es *chip = snd_kcontrol_chip(kcontrol);
 | |
| 	int changed = 0;
 | |
| 	int current_value = chip->playback_mute;
 | |
| 
 | |
| 	if (current_value != ucontrol->value.integer.value[0]) {
 | |
| 		lx_level_unmute(chip, 0, !current_value);
 | |
| 		chip->playback_mute = !current_value;
 | |
| 		changed = 1;
 | |
| 	}
 | |
| 	return changed;
 | |
| }
 | |
| 
 | |
| static struct snd_kcontrol_new lx_control_playback_switch __devinitdata = {
 | |
| 	.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 | |
| 	.name = "PCM Playback Switch",
 | |
| 	.index = 0,
 | |
| 	.access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 | |
| 	.private_value = 0,
 | |
| 	.info = lx_control_playback_info,
 | |
| 	.get = lx_control_playback_get,
 | |
| 	.put = lx_control_playback_put
 | |
| };
 | |
| 
 | |
| 
 | |
| 
 | |
| static void lx_proc_levels_read(struct snd_info_entry *entry,
 | |
| 				struct snd_info_buffer *buffer)
 | |
| {
 | |
| 	u32 levels[64];
 | |
| 	int err;
 | |
| 	int i, j;
 | |
| 	struct lx6464es *chip = entry->private_data;
 | |
| 
 | |
| 	snd_iprintf(buffer, "capture levels:\n");
 | |
| 	err = lx_level_peaks(chip, 1, 64, levels);
 | |
| 	if (err < 0)
 | |
| 		return;
 | |
| 
 | |
| 	for (i = 0; i != 8; ++i) {
 | |
| 		for (j = 0; j != 8; ++j)
 | |
| 			snd_iprintf(buffer, "%08x ", levels[i*8+j]);
 | |
| 		snd_iprintf(buffer, "\n");
 | |
| 	}
 | |
| 
 | |
| 	snd_iprintf(buffer, "\nplayback levels:\n");
 | |
| 
 | |
| 	err = lx_level_peaks(chip, 0, 64, levels);
 | |
| 	if (err < 0)
 | |
| 		return;
 | |
| 
 | |
| 	for (i = 0; i != 8; ++i) {
 | |
| 		for (j = 0; j != 8; ++j)
 | |
| 			snd_iprintf(buffer, "%08x ", levels[i*8+j]);
 | |
| 		snd_iprintf(buffer, "\n");
 | |
| 	}
 | |
| 
 | |
| 	snd_iprintf(buffer, "\n");
 | |
| }
 | |
| 
 | |
| static int __devinit lx_proc_create(struct snd_card *card, struct lx6464es *chip)
 | |
| {
 | |
| 	struct snd_info_entry *entry;
 | |
| 	int err = snd_card_proc_new(card, "levels", &entry);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	snd_info_set_text_ops(entry, chip, lx_proc_levels_read);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int __devinit snd_lx6464es_create(struct snd_card *card,
 | |
| 					 struct pci_dev *pci,
 | |
| 					 struct lx6464es **rchip)
 | |
| {
 | |
| 	struct lx6464es *chip;
 | |
| 	int err;
 | |
| 
 | |
| 	static struct snd_device_ops ops = {
 | |
| 		.dev_free = snd_lx6464es_dev_free,
 | |
| 	};
 | |
| 
 | |
| 	snd_printdd("->snd_lx6464es_create\n");
 | |
| 
 | |
| 	*rchip = NULL;
 | |
| 
 | |
| 	/* enable PCI device */
 | |
| 	err = pci_enable_device(pci);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	pci_set_master(pci);
 | |
| 
 | |
| 	/* check if we can restrict PCI DMA transfers to 32 bits */
 | |
| 	err = pci_set_dma_mask(pci, DMA_BIT_MASK(32));
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR "architecture does not support "
 | |
| 			   "32bit PCI busmaster DMA\n");
 | |
| 		pci_disable_device(pci);
 | |
| 		return -ENXIO;
 | |
| 	}
 | |
| 
 | |
| 	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
 | |
| 	if (chip == NULL) {
 | |
| 		err = -ENOMEM;
 | |
| 		goto alloc_failed;
 | |
| 	}
 | |
| 
 | |
| 	chip->card = card;
 | |
| 	chip->pci = pci;
 | |
| 	chip->irq = -1;
 | |
| 
 | |
| 	/* initialize synchronization structs */
 | |
| 	spin_lock_init(&chip->lock);
 | |
| 	spin_lock_init(&chip->msg_lock);
 | |
| 	mutex_init(&chip->setup_mutex);
 | |
| 	tasklet_init(&chip->trigger_tasklet, lx_trigger_tasklet,
 | |
| 		     (unsigned long)chip);
 | |
| 	tasklet_init(&chip->tasklet_capture, lx_tasklet_capture,
 | |
| 		     (unsigned long)chip);
 | |
| 	tasklet_init(&chip->tasklet_playback, lx_tasklet_playback,
 | |
| 		     (unsigned long)chip);
 | |
| 
 | |
| 	/* request resources */
 | |
| 	err = pci_request_regions(pci, card_name);
 | |
| 	if (err < 0)
 | |
| 		goto request_regions_failed;
 | |
| 
 | |
| 	/* plx port */
 | |
| 	chip->port_plx = pci_resource_start(pci, 1);
 | |
| 	chip->port_plx_remapped = ioport_map(chip->port_plx,
 | |
| 					     pci_resource_len(pci, 1));
 | |
| 
 | |
| 	/* dsp port */
 | |
| 	chip->port_dsp_bar = pci_ioremap_bar(pci, 2);
 | |
| 
 | |
| 	err = request_irq(pci->irq, lx_interrupt, IRQF_SHARED,
 | |
| 			  card_name, chip);
 | |
| 	if (err) {
 | |
| 		snd_printk(KERN_ERR LXP "unable to grab IRQ %d\n", pci->irq);
 | |
| 		goto request_irq_failed;
 | |
| 	}
 | |
| 	chip->irq = pci->irq;
 | |
| 
 | |
| 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops);
 | |
| 	if (err < 0)
 | |
| 		goto device_new_failed;
 | |
| 
 | |
| 	err = lx_init_dsp(chip);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "error during DSP initialization\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	err = lx_pcm_create(chip);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	err = lx_proc_create(card, chip);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	err = snd_ctl_add(card, snd_ctl_new1(&lx_control_playback_switch,
 | |
| 					     chip));
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	snd_card_set_dev(card, &pci->dev);
 | |
| 
 | |
| 	*rchip = chip;
 | |
| 	return 0;
 | |
| 
 | |
| device_new_failed:
 | |
| 	free_irq(pci->irq, chip);
 | |
| 
 | |
| request_irq_failed:
 | |
| 	pci_release_regions(pci);
 | |
| 
 | |
| request_regions_failed:
 | |
| 	kfree(chip);
 | |
| 
 | |
| alloc_failed:
 | |
| 	pci_disable_device(pci);
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int __devinit snd_lx6464es_probe(struct pci_dev *pci,
 | |
| 					const struct pci_device_id *pci_id)
 | |
| {
 | |
| 	static int dev;
 | |
| 	struct snd_card *card;
 | |
| 	struct lx6464es *chip;
 | |
| 	int err;
 | |
| 
 | |
| 	snd_printdd("->snd_lx6464es_probe\n");
 | |
| 
 | |
| 	if (dev >= SNDRV_CARDS)
 | |
| 		return -ENODEV;
 | |
| 	if (!enable[dev]) {
 | |
| 		dev++;
 | |
| 		return -ENOENT;
 | |
| 	}
 | |
| 
 | |
| 	err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	err = snd_lx6464es_create(card, pci, &chip);
 | |
| 	if (err < 0) {
 | |
| 		snd_printk(KERN_ERR LXP "error during snd_lx6464es_create\n");
 | |
| 		goto out_free;
 | |
| 	}
 | |
| 
 | |
| 	strcpy(card->driver, "lx6464es");
 | |
| 	strcpy(card->shortname, "Digigram LX6464ES");
 | |
| 	sprintf(card->longname, "%s at 0x%lx, 0x%p, irq %i",
 | |
| 		card->shortname, chip->port_plx,
 | |
| 		chip->port_dsp_bar, chip->irq);
 | |
| 
 | |
| 	err = snd_card_register(card);
 | |
| 	if (err < 0)
 | |
| 		goto out_free;
 | |
| 
 | |
| 	snd_printdd(LXP "initialization successful\n");
 | |
| 	pci_set_drvdata(pci, card);
 | |
| 	dev++;
 | |
| 	return 0;
 | |
| 
 | |
| out_free:
 | |
| 	snd_card_free(card);
 | |
| 	return err;
 | |
| 
 | |
| }
 | |
| 
 | |
| static void __devexit snd_lx6464es_remove(struct pci_dev *pci)
 | |
| {
 | |
| 	snd_card_free(pci_get_drvdata(pci));
 | |
| 	pci_set_drvdata(pci, NULL);
 | |
| }
 | |
| 
 | |
| 
 | |
| static struct pci_driver driver = {
 | |
| 	.name =     "Digigram LX6464ES",
 | |
| 	.id_table = snd_lx6464es_ids,
 | |
| 	.probe =    snd_lx6464es_probe,
 | |
| 	.remove = __devexit_p(snd_lx6464es_remove),
 | |
| };
 | |
| 
 | |
| 
 | |
| /* module initialization */
 | |
| static int __init mod_init(void)
 | |
| {
 | |
| 	return pci_register_driver(&driver);
 | |
| }
 | |
| 
 | |
| static void __exit mod_exit(void)
 | |
| {
 | |
| 	pci_unregister_driver(&driver);
 | |
| }
 | |
| 
 | |
| module_init(mod_init);
 | |
| module_exit(mod_exit);
 |