au1x00.c 18.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43
/*
 * BRIEF MODULE DESCRIPTION
 *  Driver for AMD Au1000 MIPS Processor, AC'97 Sound Port
 *
 * Copyright 2004 Cooper Street Innovations Inc.
 * Author: Charles Eidsness	<charles@cooper-street.com>
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
 *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
 *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
 *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
 *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *  You should have received a copy of the  GNU General Public License along
 *  with this program; if not, write  to the Free Software Foundation, Inc.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * History:
 *
 * 2004-09-09 Charles Eidsness	-- Original verion -- based on
 * 				  sa11xx-uda1341.c ALSA driver and the
 *				  au1000.c OSS driver.
 * 2004-09-09 Matt Porter	-- Added support for ALSA 1.0.6
 *
 */

#include <linux/ioport.h>
#include <linux/interrupt.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <sound/core.h>
#include <sound/initval.h>
#include <sound/pcm.h>
44
#include <sound/pcm_params.h>
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68
#include <sound/ac97_codec.h>
#include <asm/mach-au1x00/au1000.h>
#include <asm/mach-au1x00/au1000_dma.h>

MODULE_AUTHOR("Charles Eidsness <charles@cooper-street.com>");
MODULE_DESCRIPTION("Au1000 AC'97 ALSA Driver");
MODULE_LICENSE("GPL");
MODULE_SUPPORTED_DEVICE("{{AMD,Au1000 AC'97}}");

#define PLAYBACK 0
#define CAPTURE 1
#define AC97_SLOT_3 0x01
#define AC97_SLOT_4 0x02
#define AC97_SLOT_6 0x08
#define AC97_CMD_IRQ 31
#define READ 0
#define WRITE 1
#define READ_WAIT 2
#define RW_DONE 3

struct au1000_period
{
	u32 start;
	u32 relative_end;	/*realtive to start of buffer*/
69
	struct au1000_period * next;
L
Linus Torvalds 已提交
70 71 72 73 74 75 76 77 78 79 80 81
};

/*Au1000 AC97 Port Control Reisters*/
struct au1000_ac97_reg {
	u32 volatile config;
	u32 volatile status;
	u32 volatile data;
	u32 volatile cmd;
	u32 volatile cntrl;
};

struct audio_stream {
82
	struct snd_pcm_substream *substream;
L
Linus Torvalds 已提交
83 84
	int dma;
	spinlock_t dma_lock;
85
	struct au1000_period * buffer;
T
Takashi Iwai 已提交
86 87
	unsigned int period_size;
	unsigned int periods;
L
Linus Torvalds 已提交
88 89
};

90 91 92
struct snd_au1000 {
	struct snd_card *card;
	struct au1000_ac97_reg volatile *ac97_ioport;
L
Linus Torvalds 已提交
93 94 95

	struct resource *ac97_res_port;
	spinlock_t ac97_lock;
96
	struct snd_ac97 *ac97;
L
Linus Torvalds 已提交
97

98 99 100
	struct snd_pcm *pcm;
	struct audio_stream *stream[2];	/* playback & capture */
};
L
Linus Torvalds 已提交
101 102 103

/*--------------------------- Local Functions --------------------------------*/
static void
104
au1000_set_ac97_xmit_slots(struct snd_au1000 *au1000, long xmit_slots)
L
Linus Torvalds 已提交
105 106 107 108 109 110 111 112 113 114 115 116
{
	u32 volatile ac97_config;

	spin_lock(&au1000->ac97_lock);
	ac97_config = au1000->ac97_ioport->config;
	ac97_config = ac97_config & ~AC97C_XMIT_SLOTS_MASK;
	ac97_config |= (xmit_slots << AC97C_XMIT_SLOTS_BIT);
	au1000->ac97_ioport->config = ac97_config;
	spin_unlock(&au1000->ac97_lock);
}

static void
117
au1000_set_ac97_recv_slots(struct snd_au1000 *au1000, long recv_slots)
L
Linus Torvalds 已提交
118 119 120 121 122 123 124 125 126 127 128 129 130
{
	u32 volatile ac97_config;

	spin_lock(&au1000->ac97_lock);
	ac97_config = au1000->ac97_ioport->config;
	ac97_config = ac97_config & ~AC97C_RECV_SLOTS_MASK;
	ac97_config |= (recv_slots << AC97C_RECV_SLOTS_BIT);
	au1000->ac97_ioport->config = ac97_config;
	spin_unlock(&au1000->ac97_lock);
}


static void
131
au1000_release_dma_link(struct audio_stream *stream)
L
Linus Torvalds 已提交
132
{
133 134
	struct au1000_period * pointer;
	struct au1000_period * pointer_next;
L
Linus Torvalds 已提交
135

T
Takashi Iwai 已提交
136 137 138 139 140 141 142 143 144 145 146 147 148 149
	stream->period_size = 0;
	stream->periods = 0;
	pointer = stream->buffer;
	if (! pointer)
		return;
	do {
		pointer_next = pointer->next;
		kfree(pointer);
		pointer = pointer_next;
	} while (pointer != stream->buffer);
	stream->buffer = NULL;
}

static int
150
au1000_setup_dma_link(struct audio_stream *stream, unsigned int period_bytes,
T
Takashi Iwai 已提交
151 152
		      unsigned int periods)
{
153 154
	struct snd_pcm_substream *substream = stream->substream;
	struct snd_pcm_runtime *runtime = substream->runtime;
155
	struct au1000_period *pointer;
T
Takashi Iwai 已提交
156 157 158 159
	unsigned long dma_start;
	int i;

	dma_start = virt_to_phys(runtime->dma_area);
L
Linus Torvalds 已提交
160

T
Takashi Iwai 已提交
161 162 163
	if (stream->period_size == period_bytes &&
	    stream->periods == periods)
		return 0; /* not changed */
L
Linus Torvalds 已提交
164

T
Takashi Iwai 已提交
165
	au1000_release_dma_link(stream);
L
Linus Torvalds 已提交
166

T
Takashi Iwai 已提交
167 168 169
	stream->period_size = period_bytes;
	stream->periods = periods;

170
	stream->buffer = kmalloc(sizeof(struct au1000_period), GFP_KERNEL);
T
Takashi Iwai 已提交
171 172 173 174 175 176 177 178 179 180 181 182 183 184
	if (! stream->buffer)
		return -ENOMEM;
	pointer = stream->buffer;
	for (i = 0; i < periods; i++) {
		pointer->start = (u32)(dma_start + (i * period_bytes));
		pointer->relative_end = (u32) (((i+1) * period_bytes) - 0x1);
		if (i < periods - 1) {
			pointer->next = kmalloc(sizeof(struct au1000_period), GFP_KERNEL);
			if (! pointer->next) {
				au1000_release_dma_link(stream);
				return -ENOMEM;
			}
			pointer = pointer->next;
		}
L
Linus Torvalds 已提交
185
	}
T
Takashi Iwai 已提交
186 187
	pointer->next = stream->buffer;
	return 0;
L
Linus Torvalds 已提交
188 189 190
}

static void
191
au1000_dma_stop(struct audio_stream *stream)
L
Linus Torvalds 已提交
192
{
T
Takashi Iwai 已提交
193 194 195
	snd_assert(stream->buffer, return);
	disable_dma(stream->dma);
}
L
Linus Torvalds 已提交
196

T
Takashi Iwai 已提交
197
static void
198
au1000_dma_start(struct audio_stream *stream)
T
Takashi Iwai 已提交
199 200
{
	snd_assert(stream->buffer, return);
L
Linus Torvalds 已提交
201

T
Takashi Iwai 已提交
202 203 204 205 206 207 208 209 210 211 212 213 214
	init_dma(stream->dma);
	if (get_dma_active_buffer(stream->dma) == 0) {
		clear_dma_done0(stream->dma);
		set_dma_addr0(stream->dma, stream->buffer->start);
		set_dma_count0(stream->dma, stream->period_size >> 1);
		set_dma_addr1(stream->dma, stream->buffer->next->start);
		set_dma_count1(stream->dma, stream->period_size >> 1);
	} else {
		clear_dma_done1(stream->dma);
		set_dma_addr1(stream->dma, stream->buffer->start);
		set_dma_count1(stream->dma, stream->period_size >> 1);
		set_dma_addr0(stream->dma, stream->buffer->next->start);
		set_dma_count0(stream->dma, stream->period_size >> 1);
L
Linus Torvalds 已提交
215
	}
T
Takashi Iwai 已提交
216 217
	enable_dma_buffers(stream->dma);
	start_dma(stream->dma);
L
Linus Torvalds 已提交
218 219 220
}

static irqreturn_t
221
au1000_dma_interrupt(int irq, void *dev_id)
L
Linus Torvalds 已提交
222
{
223 224
	struct audio_stream *stream = (struct audio_stream *) dev_id;
	struct snd_pcm_substream *substream = stream->substream;
L
Linus Torvalds 已提交
225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257

	spin_lock(&stream->dma_lock);
	switch (get_dma_buffer_done(stream->dma)) {
	case DMA_D0:
		stream->buffer = stream->buffer->next;
		clear_dma_done0(stream->dma);
		set_dma_addr0(stream->dma, stream->buffer->next->start);
		set_dma_count0(stream->dma, stream->period_size >> 1);
		enable_dma_buffer0(stream->dma);
		break;
	case DMA_D1:
		stream->buffer = stream->buffer->next;
		clear_dma_done1(stream->dma);
		set_dma_addr1(stream->dma, stream->buffer->next->start);
		set_dma_count1(stream->dma, stream->period_size >> 1);
		enable_dma_buffer1(stream->dma);
		break;
	case (DMA_D0 | DMA_D1):
		printk(KERN_ERR "DMA %d missed interrupt.\n",stream->dma);
		au1000_dma_stop(stream);
		au1000_dma_start(stream);
		break;
	case (~DMA_D0 & ~DMA_D1):
		printk(KERN_ERR "DMA %d empty irq.\n",stream->dma);
	}
	spin_unlock(&stream->dma_lock);
	snd_pcm_period_elapsed(substream);
	return IRQ_HANDLED;
}

/*-------------------------- PCM Audio Streams -------------------------------*/

static unsigned int rates[] = {8000, 11025, 16000, 22050};
258
static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
259
	.count	= ARRAY_SIZE(rates),
L
Linus Torvalds 已提交
260 261 262 263
	.list	= rates,
	.mask	= 0,
};

264
static struct snd_pcm_hardware snd_au1000_hw =
L
Linus Torvalds 已提交
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283
{
	.info			= (SNDRV_PCM_INFO_INTERLEAVED | \
				SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID),
	.formats		= SNDRV_PCM_FMTBIT_S16_LE,
	.rates			= (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
				SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050),
	.rate_min		= 8000,
	.rate_max		= 22050,
	.channels_min		= 1,
	.channels_max		= 2,
	.buffer_bytes_max	= 128*1024,
	.period_bytes_min	= 32,
	.period_bytes_max	= 16*1024,
	.periods_min		= 8,
	.periods_max		= 255,
	.fifo_size		= 16,
};

static int
284
snd_au1000_playback_open(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
285
{
286
	struct snd_au1000 *au1000 = substream->pcm->private_data;
T
Takashi Iwai 已提交
287

L
Linus Torvalds 已提交
288 289 290
	au1000->stream[PLAYBACK]->substream = substream;
	au1000->stream[PLAYBACK]->buffer = NULL;
	substream->private_data = au1000->stream[PLAYBACK];
T
Takashi Iwai 已提交
291
	substream->runtime->hw = snd_au1000_hw;
L
Linus Torvalds 已提交
292 293 294 295 296
	return (snd_pcm_hw_constraint_list(substream->runtime, 0,
		SNDRV_PCM_HW_PARAM_RATE, &hw_constraints_rates) < 0);
}

static int
297
snd_au1000_capture_open(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
298
{
299
	struct snd_au1000 *au1000 = substream->pcm->private_data;
T
Takashi Iwai 已提交
300

L
Linus Torvalds 已提交
301 302 303
	au1000->stream[CAPTURE]->substream = substream;
	au1000->stream[CAPTURE]->buffer = NULL;
	substream->private_data = au1000->stream[CAPTURE];
T
Takashi Iwai 已提交
304
	substream->runtime->hw = snd_au1000_hw;
L
Linus Torvalds 已提交
305 306 307 308 309
	return (snd_pcm_hw_constraint_list(substream->runtime, 0,
		SNDRV_PCM_HW_PARAM_RATE, &hw_constraints_rates) < 0);
}

static int
310
snd_au1000_playback_close(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
311
{
312
	struct snd_au1000 *au1000 = substream->pcm->private_data;
T
Takashi Iwai 已提交
313

L
Linus Torvalds 已提交
314 315 316 317 318
	au1000->stream[PLAYBACK]->substream = NULL;
	return 0;
}

static int
319
snd_au1000_capture_close(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
320
{
321
	struct snd_au1000 *au1000 = substream->pcm->private_data;
T
Takashi Iwai 已提交
322

L
Linus Torvalds 已提交
323 324 325 326 327
	au1000->stream[CAPTURE]->substream = NULL;
	return 0;
}

static int
328 329
snd_au1000_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *hw_params)
L
Linus Torvalds 已提交
330
{
331
	struct audio_stream *stream = substream->private_data;
T
Takashi Iwai 已提交
332 333 334 335 336 337 338 339 340
	int err;

	err = snd_pcm_lib_malloc_pages(substream,
				       params_buffer_bytes(hw_params));
	if (err < 0)
		return err;
	return au1000_setup_dma_link(stream,
				     params_period_bytes(hw_params),
				     params_periods(hw_params));
L
Linus Torvalds 已提交
341 342 343
}

static int
344
snd_au1000_hw_free(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
345
{
346
	struct audio_stream *stream = substream->private_data;
T
Takashi Iwai 已提交
347
	au1000_release_dma_link(stream);
L
Linus Torvalds 已提交
348 349 350 351
	return snd_pcm_lib_free_pages(substream);
}

static int
352
snd_au1000_playback_prepare(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
353
{
354 355
	struct snd_au1000 *au1000 = substream->pcm->private_data;
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
356

T
Takashi Iwai 已提交
357 358
	if (runtime->channels == 1)
		au1000_set_ac97_xmit_slots(au1000, AC97_SLOT_4);
L
Linus Torvalds 已提交
359
	else
T
Takashi Iwai 已提交
360
		au1000_set_ac97_xmit_slots(au1000, AC97_SLOT_3 | AC97_SLOT_4);
L
Linus Torvalds 已提交
361 362 363 364 365
	snd_ac97_set_rate(au1000->ac97, AC97_PCM_FRONT_DAC_RATE, runtime->rate);
	return 0;
}

static int
366
snd_au1000_capture_prepare(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
367
{
368 369
	struct snd_au1000 *au1000 = substream->pcm->private_data;
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
370

T
Takashi Iwai 已提交
371 372
	if (runtime->channels == 1)
		au1000_set_ac97_recv_slots(au1000, AC97_SLOT_4);
L
Linus Torvalds 已提交
373
	else
T
Takashi Iwai 已提交
374
		au1000_set_ac97_recv_slots(au1000, AC97_SLOT_3 | AC97_SLOT_4);
L
Linus Torvalds 已提交
375 376 377 378 379
	snd_ac97_set_rate(au1000->ac97, AC97_PCM_LR_ADC_RATE, runtime->rate);
	return 0;
}

static int
380
snd_au1000_trigger(struct snd_pcm_substream *substream, int cmd)
L
Linus Torvalds 已提交
381
{
382
	struct audio_stream *stream = substream->private_data;
L
Linus Torvalds 已提交
383 384
	int err = 0;

T
Takashi Iwai 已提交
385
	spin_lock(&stream->dma_lock);
L
Linus Torvalds 已提交
386 387 388 389 390 391 392 393 394 395 396
	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		au1000_dma_start(stream);
		break;
	case SNDRV_PCM_TRIGGER_STOP:
		au1000_dma_stop(stream);
		break;
	default:
		err = -EINVAL;
		break;
	}
T
Takashi Iwai 已提交
397
	spin_unlock(&stream->dma_lock);
L
Linus Torvalds 已提交
398 399 400 401
	return err;
}

static snd_pcm_uframes_t
402
snd_au1000_pointer(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
403
{
404 405
	struct audio_stream *stream = substream->private_data;
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
406 407
	long location;

T
Takashi Iwai 已提交
408
	spin_lock(&stream->dma_lock);
L
Linus Torvalds 已提交
409
	location = get_dma_residue(stream->dma);
T
Takashi Iwai 已提交
410
	spin_unlock(&stream->dma_lock);
L
Linus Torvalds 已提交
411 412 413 414 415 416
	location = stream->buffer->relative_end - location;
	if (location == -1)
		location = 0;
	return bytes_to_frames(runtime,location);
}

417
static struct snd_pcm_ops snd_card_au1000_playback_ops = {
L
Linus Torvalds 已提交
418 419 420 421 422 423 424 425 426 427
	.open			= snd_au1000_playback_open,
	.close			= snd_au1000_playback_close,
	.ioctl			= snd_pcm_lib_ioctl,
	.hw_params	        = snd_au1000_hw_params,
	.hw_free	        = snd_au1000_hw_free,
	.prepare		= snd_au1000_playback_prepare,
	.trigger		= snd_au1000_trigger,
	.pointer		= snd_au1000_pointer,
};

428
static struct snd_pcm_ops snd_card_au1000_capture_ops = {
L
Linus Torvalds 已提交
429 430 431 432 433 434 435 436 437 438 439
	.open			= snd_au1000_capture_open,
	.close			= snd_au1000_capture_close,
	.ioctl			= snd_pcm_lib_ioctl,
	.hw_params	        = snd_au1000_hw_params,
	.hw_free	        = snd_au1000_hw_free,
	.prepare		= snd_au1000_capture_prepare,
	.trigger		= snd_au1000_trigger,
	.pointer		= snd_au1000_pointer,
};

static int __devinit
440
snd_au1000_pcm_new(struct snd_au1000 *au1000)
L
Linus Torvalds 已提交
441
{
442
	struct snd_pcm *pcm;
L
Linus Torvalds 已提交
443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460
	int err;
	unsigned long flags;

	if ((err = snd_pcm_new(au1000->card, "AU1000 AC97 PCM", 0, 1, 1, &pcm)) < 0)
		return err;

	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
		snd_dma_continuous_data(GFP_KERNEL), 128*1024, 128*1024);

	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
		&snd_card_au1000_playback_ops);
	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
		&snd_card_au1000_capture_ops);

	pcm->private_data = au1000;
	pcm->info_flags = 0;
	strcpy(pcm->name, "Au1000 AC97 PCM");

T
Takashi Iwai 已提交
461 462 463
	spin_lock_init(&au1000->stream[PLAYBACK]->dma_lock);
	spin_lock_init(&au1000->stream[CAPTURE]->dma_lock);

L
Linus Torvalds 已提交
464 465
	flags = claim_dma_lock();
	if ((au1000->stream[PLAYBACK]->dma = request_au1000_dma(DMA_ID_AC97C_TX,
466
			"AC97 TX", au1000_dma_interrupt, IRQF_DISABLED,
L
Linus Torvalds 已提交
467 468 469 470 471
			au1000->stream[PLAYBACK])) < 0) {
		release_dma_lock(flags);
		return -EBUSY;
	}
	if ((au1000->stream[CAPTURE]->dma = request_au1000_dma(DMA_ID_AC97C_RX,
472
			"AC97 RX", au1000_dma_interrupt, IRQF_DISABLED,
L
Linus Torvalds 已提交
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490
			au1000->stream[CAPTURE])) < 0){
		release_dma_lock(flags);
		return -EBUSY;
	}
	/* enable DMA coherency in read/write DMA channels */
	set_dma_mode(au1000->stream[PLAYBACK]->dma,
		     get_dma_mode(au1000->stream[PLAYBACK]->dma) & ~DMA_NC);
	set_dma_mode(au1000->stream[CAPTURE]->dma,
		     get_dma_mode(au1000->stream[CAPTURE]->dma) & ~DMA_NC);
	release_dma_lock(flags);
	au1000->pcm = pcm;
	return 0;
}


/*-------------------------- AC97 CODEC Control ------------------------------*/

static unsigned short
491
snd_au1000_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
L
Linus Torvalds 已提交
492
{
493
	struct snd_au1000 *au1000 = ac97->private_data;
L
Linus Torvalds 已提交
494 495 496
	u32 volatile cmd;
	u16 volatile data;
	int             i;
T
Takashi Iwai 已提交
497

498
	spin_lock(&au1000->ac97_lock);
499 500
/* would rather use the interrupt than this polling but it works and I can't
get the interrupt driven case to work efficiently */
L
Linus Torvalds 已提交
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520
	for (i = 0; i < 0x5000; i++)
		if (!(au1000->ac97_ioport->status & AC97C_CP))
			break;
	if (i == 0x5000)
		printk(KERN_ERR "au1000 AC97: AC97 command read timeout\n");

	cmd = (u32) reg & AC97C_INDEX_MASK;
	cmd |= AC97C_READ;
	au1000->ac97_ioport->cmd = cmd;

	/* now wait for the data */
	for (i = 0; i < 0x5000; i++)
		if (!(au1000->ac97_ioport->status & AC97C_CP))
			break;
	if (i == 0x5000) {
		printk(KERN_ERR "au1000 AC97: AC97 command read timeout\n");
		return 0;
	}

	data = au1000->ac97_ioport->cmd & 0xffff;
521
	spin_unlock(&au1000->ac97_lock);
L
Linus Torvalds 已提交
522 523 524 525 526 527 528

	return data;

}


static void
529
snd_au1000_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val)
L
Linus Torvalds 已提交
530
{
531
	struct snd_au1000 *au1000 = ac97->private_data;
L
Linus Torvalds 已提交
532 533
	u32 cmd;
	int i;
T
Takashi Iwai 已提交
534

535
	spin_lock(&au1000->ac97_lock);
536 537
/* would rather use the interrupt than this polling but it works and I can't
get the interrupt driven case to work efficiently */
L
Linus Torvalds 已提交
538 539 540 541 542 543 544 545 546 547
	for (i = 0; i < 0x5000; i++)
		if (!(au1000->ac97_ioport->status & AC97C_CP))
			break;
	if (i == 0x5000)
		printk(KERN_ERR "au1000 AC97: AC97 command write timeout\n");

	cmd = (u32) reg & AC97C_INDEX_MASK;
	cmd &= ~AC97C_READ;
	cmd |= ((u32) val << AC97C_WD_BIT);
	au1000->ac97_ioport->cmd = cmd;
548
	spin_unlock(&au1000->ac97_lock);
L
Linus Torvalds 已提交
549 550 551
}

static int __devinit
552
snd_au1000_ac97_new(struct snd_au1000 *au1000)
L
Linus Torvalds 已提交
553 554
{
	int err;
555 556 557 558 559 560
	struct snd_ac97_bus *pbus;
	struct snd_ac97_template ac97;
 	static struct snd_ac97_bus_ops ops = {
		.write = snd_au1000_ac97_write,
		.read = snd_au1000_ac97_read,
	};
L
Linus Torvalds 已提交
561

562 563
	if ((au1000->ac97_res_port = request_mem_region(CPHYSADDR(AC97C_CONFIG),
	       		0x100000, "Au1x00 AC97")) == NULL) {
L
Linus Torvalds 已提交
564 565 566
		snd_printk(KERN_ERR "ALSA AC97: can't grap AC97 port\n");
		return -EBUSY;
	}
567 568
	au1000->ac97_ioport = (struct au1000_ac97_reg *)
		KSEG1ADDR(au1000->ac97_res_port->start);
L
Linus Torvalds 已提交
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590

	spin_lock_init(&au1000->ac97_lock);

	/* configure pins for AC'97
	TODO: move to board_setup.c */
	au_writel(au_readl(SYS_PINFUNC) & ~0x02, SYS_PINFUNC);

	/* Initialise Au1000's AC'97 Control Block */
	au1000->ac97_ioport->cntrl = AC97C_RS | AC97C_CE;
	udelay(10);
	au1000->ac97_ioport->cntrl = AC97C_CE;
	udelay(10);

	/* Initialise External CODEC -- cold reset */
	au1000->ac97_ioport->config = AC97C_RESET;
	udelay(10);
	au1000->ac97_ioport->config = 0x0;
	mdelay(5);

	/* Initialise AC97 middle-layer */
	if ((err = snd_ac97_bus(au1000->card, 0, &ops, au1000, &pbus)) < 0)
 		return err;
T
Takashi Iwai 已提交
591

L
Linus Torvalds 已提交
592 593 594 595 596
	memset(&ac97, 0, sizeof(ac97));
	ac97.private_data = au1000;
	if ((err = snd_ac97_mixer(pbus, &ac97, &au1000->ac97)) < 0)
		return err;

T
Takashi Iwai 已提交
597
	return 0;
L
Linus Torvalds 已提交
598 599 600 601 602
}

/*------------------------------ Setup / Destroy ----------------------------*/

void
603
snd_au1000_free(struct snd_card *card)
L
Linus Torvalds 已提交
604
{
605
	struct snd_au1000 *au1000 = card->private_data;
L
Linus Torvalds 已提交
606 607 608 609 610

	if (au1000->ac97_res_port) {
		/* put internal AC97 block into reset */
		au1000->ac97_ioport->cntrl = AC97C_RS;
		au1000->ac97_ioport = NULL;
611
		release_and_free_resource(au1000->ac97_res_port);
L
Linus Torvalds 已提交
612 613
	}

614 615 616 617 618
	if (au1000->stream[PLAYBACK]) {
	  	if (au1000->stream[PLAYBACK]->dma >= 0)
			free_au1000_dma(au1000->stream[PLAYBACK]->dma);
		kfree(au1000->stream[PLAYBACK]);
	}
L
Linus Torvalds 已提交
619

620 621 622 623 624
	if (au1000->stream[CAPTURE]) {
		if (au1000->stream[CAPTURE]->dma >= 0)
			free_au1000_dma(au1000->stream[CAPTURE]->dma);
		kfree(au1000->stream[CAPTURE]);
	}
L
Linus Torvalds 已提交
625 626
}

T
Takashi Iwai 已提交
627

628
static struct snd_card *au1000_card;
T
Takashi Iwai 已提交
629

L
Linus Torvalds 已提交
630 631 632 633
static int __init
au1000_init(void)
{
	int err;
634 635
	struct snd_card *card;
	struct snd_au1000 *au1000;
L
Linus Torvalds 已提交
636

637
	card = snd_card_new(-1, "AC97", THIS_MODULE, sizeof(struct snd_au1000));
T
Takashi Iwai 已提交
638
	if (card == NULL)
L
Linus Torvalds 已提交
639
		return -ENOMEM;
T
Takashi Iwai 已提交
640 641 642 643

	card->private_free = snd_au1000_free;
	au1000 = card->private_data;
	au1000->card = card;
644

645
	au1000->stream[PLAYBACK] = kmalloc(sizeof(struct audio_stream), GFP_KERNEL);
646 647 648 649 650 651 652 653
	au1000->stream[CAPTURE ] = kmalloc(sizeof(struct audio_stream), GFP_KERNEL);
	/* so that snd_au1000_free will work as intended */
 	au1000->ac97_res_port = NULL;
	if (au1000->stream[PLAYBACK])
		au1000->stream[PLAYBACK]->dma = -1;
	if (au1000->stream[CAPTURE ])
		au1000->stream[CAPTURE ]->dma = -1;

T
Takashi Iwai 已提交
654
	if (au1000->stream[PLAYBACK] == NULL ||
655
	    au1000->stream[CAPTURE ] == NULL) {
T
Takashi Iwai 已提交
656
		snd_card_free(card);
L
Linus Torvalds 已提交
657 658 659
		return -ENOMEM;
	}

T
Takashi Iwai 已提交
660 661
	if ((err = snd_au1000_ac97_new(au1000)) < 0 ) {
		snd_card_free(card);
L
Linus Torvalds 已提交
662 663 664
		return err;
	}

T
Takashi Iwai 已提交
665 666
	if ((err = snd_au1000_pcm_new(au1000)) < 0) {
		snd_card_free(card);
L
Linus Torvalds 已提交
667 668 669
		return err;
	}

T
Takashi Iwai 已提交
670 671 672
	strcpy(card->driver, "Au1000-AC97");
	strcpy(card->shortname, "AMD Au1000-AC97");
	sprintf(card->longname, "AMD Au1000--AC97 ALSA Driver");
L
Linus Torvalds 已提交
673

T
Takashi Iwai 已提交
674 675
	if ((err = snd_card_register(card)) < 0) {
		snd_card_free(card);
L
Linus Torvalds 已提交
676 677 678 679
		return err;
	}

	printk( KERN_INFO "ALSA AC97: Driver Initialized\n" );
T
Takashi Iwai 已提交
680
	au1000_card = card;
L
Linus Torvalds 已提交
681 682 683 684 685
	return 0;
}

static void __exit au1000_exit(void)
{
T
Takashi Iwai 已提交
686
	snd_card_free(au1000_card);
L
Linus Torvalds 已提交
687 688 689 690 691
}

module_init(au1000_init);
module_exit(au1000_exit);