linux/sound/mips/au1x00.c
<<
>>
Prefs
   1/*
   2 * BRIEF MODULE DESCRIPTION
   3 *  Driver for AMD Au1000 MIPS Processor, AC'97 Sound Port
   4 *
   5 * Copyright 2004 Cooper Street Innovations Inc.
   6 * Author: Charles Eidsness     <charles@cooper-street.com>
   7 *
   8 *  This program is free software; you can redistribute  it and/or modify it
   9 *  under  the terms of  the GNU General  Public License as published by the
  10 *  Free Software Foundation;  either version 2 of the  License, or (at your
  11 *  option) any later version.
  12 *
  13 *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
  14 *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
  15 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
  16 *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
  17 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  18 *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
  19 *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  20 *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
  21 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  22 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  23 *
  24 *  You should have received a copy of the  GNU General Public License along
  25 *  with this program; if not, write  to the Free Software Foundation, Inc.,
  26 *  675 Mass Ave, Cambridge, MA 02139, USA.
  27 *
  28 * History:
  29 *
  30 * 2004-09-09 Charles Eidsness  -- Original verion -- based on
  31 *                                sa11xx-uda1341.c ALSA driver and the
  32 *                                au1000.c OSS driver.
  33 * 2004-09-09 Matt Porter       -- Added support for ALSA 1.0.6
  34 *
  35 */
  36
  37#include <linux/ioport.h>
  38#include <linux/interrupt.h>
  39#include <linux/init.h>
  40#include <linux/slab.h>
  41#include <sound/core.h>
  42#include <sound/initval.h>
  43#include <sound/pcm.h>
  44#include <sound/pcm_params.h>
  45#include <sound/ac97_codec.h>
  46#include <asm/mach-au1x00/au1000.h>
  47#include <asm/mach-au1x00/au1000_dma.h>
  48
  49MODULE_AUTHOR("Charles Eidsness <charles@cooper-street.com>");
  50MODULE_DESCRIPTION("Au1000 AC'97 ALSA Driver");
  51MODULE_LICENSE("GPL");
  52MODULE_SUPPORTED_DEVICE("{{AMD,Au1000 AC'97}}");
  53
  54#define PLAYBACK 0
  55#define CAPTURE 1
  56#define AC97_SLOT_3 0x01
  57#define AC97_SLOT_4 0x02
  58#define AC97_SLOT_6 0x08
  59#define AC97_CMD_IRQ 31
  60#define READ 0
  61#define WRITE 1
  62#define READ_WAIT 2
  63#define RW_DONE 3
  64
  65struct au1000_period
  66{
  67        u32 start;
  68        u32 relative_end;       /*realtive to start of buffer*/
  69        struct au1000_period * next;
  70};
  71
  72/*Au1000 AC97 Port Control Reisters*/
  73struct au1000_ac97_reg {
  74        u32 volatile config;
  75        u32 volatile status;
  76        u32 volatile data;
  77        u32 volatile cmd;
  78        u32 volatile cntrl;
  79};
  80
  81struct audio_stream {
  82        struct snd_pcm_substream *substream;
  83        int dma;
  84        spinlock_t dma_lock;
  85        struct au1000_period * buffer;
  86        unsigned int period_size;
  87        unsigned int periods;
  88};
  89
  90struct snd_au1000 {
  91        struct snd_card *card;
  92        struct au1000_ac97_reg volatile *ac97_ioport;
  93
  94        struct resource *ac97_res_port;
  95        spinlock_t ac97_lock;
  96        struct snd_ac97 *ac97;
  97
  98        struct snd_pcm *pcm;
  99        struct audio_stream *stream[2]; /* playback & capture */
 100};
 101
 102/*--------------------------- Local Functions --------------------------------*/
 103static void
 104au1000_set_ac97_xmit_slots(struct snd_au1000 *au1000, long xmit_slots)
 105{
 106        u32 volatile ac97_config;
 107
 108        spin_lock(&au1000->ac97_lock);
 109        ac97_config = au1000->ac97_ioport->config;
 110        ac97_config = ac97_config & ~AC97C_XMIT_SLOTS_MASK;
 111        ac97_config |= (xmit_slots << AC97C_XMIT_SLOTS_BIT);
 112        au1000->ac97_ioport->config = ac97_config;
 113        spin_unlock(&au1000->ac97_lock);
 114}
 115
 116static void
 117au1000_set_ac97_recv_slots(struct snd_au1000 *au1000, long recv_slots)
 118{
 119        u32 volatile ac97_config;
 120
 121        spin_lock(&au1000->ac97_lock);
 122        ac97_config = au1000->ac97_ioport->config;
 123        ac97_config = ac97_config & ~AC97C_RECV_SLOTS_MASK;
 124        ac97_config |= (recv_slots << AC97C_RECV_SLOTS_BIT);
 125        au1000->ac97_ioport->config = ac97_config;
 126        spin_unlock(&au1000->ac97_lock);
 127}
 128
 129
 130static void
 131au1000_release_dma_link(struct audio_stream *stream)
 132{
 133        struct au1000_period * pointer;
 134        struct au1000_period * pointer_next;
 135
 136        stream->period_size = 0;
 137        stream->periods = 0;
 138        pointer = stream->buffer;
 139        if (! pointer)
 140                return;
 141        do {
 142                pointer_next = pointer->next;
 143                kfree(pointer);
 144                pointer = pointer_next;
 145        } while (pointer != stream->buffer);
 146        stream->buffer = NULL;
 147}
 148
 149static int
 150au1000_setup_dma_link(struct audio_stream *stream, unsigned int period_bytes,
 151                      unsigned int periods)
 152{
 153        struct snd_pcm_substream *substream = stream->substream;
 154        struct snd_pcm_runtime *runtime = substream->runtime;
 155        struct au1000_period *pointer;
 156        unsigned long dma_start;
 157        int i;
 158
 159        dma_start = virt_to_phys(runtime->dma_area);
 160
 161        if (stream->period_size == period_bytes &&
 162            stream->periods == periods)
 163                return 0; /* not changed */
 164
 165        au1000_release_dma_link(stream);
 166
 167        stream->period_size = period_bytes;
 168        stream->periods = periods;
 169
 170        stream->buffer = kmalloc(sizeof(struct au1000_period), GFP_KERNEL);
 171        if (! stream->buffer)
 172                return -ENOMEM;
 173        pointer = stream->buffer;
 174        for (i = 0; i < periods; i++) {
 175                pointer->start = (u32)(dma_start + (i * period_bytes));
 176                pointer->relative_end = (u32) (((i+1) * period_bytes) - 0x1);
 177                if (i < periods - 1) {
 178                        pointer->next = kmalloc(sizeof(struct au1000_period), GFP_KERNEL);
 179                        if (! pointer->next) {
 180                                au1000_release_dma_link(stream);
 181                                return -ENOMEM;
 182                        }
 183                        pointer = pointer->next;
 184                }
 185        }
 186        pointer->next = stream->buffer;
 187        return 0;
 188}
 189
 190static void
 191au1000_dma_stop(struct audio_stream *stream)
 192{
 193        if (snd_BUG_ON(!stream->buffer))
 194                return;
 195        disable_dma(stream->dma);
 196}
 197
 198static void
 199au1000_dma_start(struct audio_stream *stream)
 200{
 201        if (snd_BUG_ON(!stream->buffer))
 202                return;
 203
 204        init_dma(stream->dma);
 205        if (get_dma_active_buffer(stream->dma) == 0) {
 206                clear_dma_done0(stream->dma);
 207                set_dma_addr0(stream->dma, stream->buffer->start);
 208                set_dma_count0(stream->dma, stream->period_size >> 1);
 209                set_dma_addr1(stream->dma, stream->buffer->next->start);
 210                set_dma_count1(stream->dma, stream->period_size >> 1);
 211        } else {
 212                clear_dma_done1(stream->dma);
 213                set_dma_addr1(stream->dma, stream->buffer->start);
 214                set_dma_count1(stream->dma, stream->period_size >> 1);
 215                set_dma_addr0(stream->dma, stream->buffer->next->start);
 216                set_dma_count0(stream->dma, stream->period_size >> 1);
 217        }
 218        enable_dma_buffers(stream->dma);
 219        start_dma(stream->dma);
 220}
 221
 222static irqreturn_t
 223au1000_dma_interrupt(int irq, void *dev_id)
 224{
 225        struct audio_stream *stream = (struct audio_stream *) dev_id;
 226        struct snd_pcm_substream *substream = stream->substream;
 227
 228        spin_lock(&stream->dma_lock);
 229        switch (get_dma_buffer_done(stream->dma)) {
 230        case DMA_D0:
 231                stream->buffer = stream->buffer->next;
 232                clear_dma_done0(stream->dma);
 233                set_dma_addr0(stream->dma, stream->buffer->next->start);
 234                set_dma_count0(stream->dma, stream->period_size >> 1);
 235                enable_dma_buffer0(stream->dma);
 236                break;
 237        case DMA_D1:
 238                stream->buffer = stream->buffer->next;
 239                clear_dma_done1(stream->dma);
 240                set_dma_addr1(stream->dma, stream->buffer->next->start);
 241                set_dma_count1(stream->dma, stream->period_size >> 1);
 242                enable_dma_buffer1(stream->dma);
 243                break;
 244        case (DMA_D0 | DMA_D1):
 245                printk(KERN_ERR "DMA %d missed interrupt.\n",stream->dma);
 246                au1000_dma_stop(stream);
 247                au1000_dma_start(stream);
 248                break;
 249        case (~DMA_D0 & ~DMA_D1):
 250                printk(KERN_ERR "DMA %d empty irq.\n",stream->dma);
 251        }
 252        spin_unlock(&stream->dma_lock);
 253        snd_pcm_period_elapsed(substream);
 254        return IRQ_HANDLED;
 255}
 256
 257/*-------------------------- PCM Audio Streams -------------------------------*/
 258
 259static unsigned int rates[] = {8000, 11025, 16000, 22050};
 260static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
 261        .count  = ARRAY_SIZE(rates),
 262        .list   = rates,
 263        .mask   = 0,
 264};
 265
 266static struct snd_pcm_hardware snd_au1000_hw =
 267{
 268        .info                   = (SNDRV_PCM_INFO_INTERLEAVED | \
 269                                SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID),
 270        .formats                = SNDRV_PCM_FMTBIT_S16_LE,
 271        .rates                  = (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |
 272                                SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050),
 273        .rate_min               = 8000,
 274        .rate_max               = 22050,
 275        .channels_min           = 1,
 276        .channels_max           = 2,
 277        .buffer_bytes_max       = 128*1024,
 278        .period_bytes_min       = 32,
 279        .period_bytes_max       = 16*1024,
 280        .periods_min            = 8,
 281        .periods_max            = 255,
 282        .fifo_size              = 16,
 283};
 284
 285static int
 286snd_au1000_playback_open(struct snd_pcm_substream *substream)
 287{
 288        struct snd_au1000 *au1000 = substream->pcm->private_data;
 289
 290        au1000->stream[PLAYBACK]->substream = substream;
 291        au1000->stream[PLAYBACK]->buffer = NULL;
 292        substream->private_data = au1000->stream[PLAYBACK];
 293        substream->runtime->hw = snd_au1000_hw;
 294        return (snd_pcm_hw_constraint_list(substream->runtime, 0,
 295                SNDRV_PCM_HW_PARAM_RATE, &hw_constraints_rates) < 0);
 296}
 297
 298static int
 299snd_au1000_capture_open(struct snd_pcm_substream *substream)
 300{
 301        struct snd_au1000 *au1000 = substream->pcm->private_data;
 302
 303        au1000->stream[CAPTURE]->substream = substream;
 304        au1000->stream[CAPTURE]->buffer = NULL;
 305        substream->private_data = au1000->stream[CAPTURE];
 306        substream->runtime->hw = snd_au1000_hw;
 307        return (snd_pcm_hw_constraint_list(substream->runtime, 0,
 308                SNDRV_PCM_HW_PARAM_RATE, &hw_constraints_rates) < 0);
 309}
 310
 311static int
 312snd_au1000_playback_close(struct snd_pcm_substream *substream)
 313{
 314        struct snd_au1000 *au1000 = substream->pcm->private_data;
 315
 316        au1000->stream[PLAYBACK]->substream = NULL;
 317        return 0;
 318}
 319
 320static int
 321snd_au1000_capture_close(struct snd_pcm_substream *substream)
 322{
 323        struct snd_au1000 *au1000 = substream->pcm->private_data;
 324
 325        au1000->stream[CAPTURE]->substream = NULL;
 326        return 0;
 327}
 328
 329static int
 330snd_au1000_hw_params(struct snd_pcm_substream *substream,
 331                                        struct snd_pcm_hw_params *hw_params)
 332{
 333        struct audio_stream *stream = substream->private_data;
 334        int err;
 335
 336        err = snd_pcm_lib_malloc_pages(substream,
 337                                       params_buffer_bytes(hw_params));
 338        if (err < 0)
 339                return err;
 340        return au1000_setup_dma_link(stream,
 341                                     params_period_bytes(hw_params),
 342                                     params_periods(hw_params));
 343}
 344
 345static int
 346snd_au1000_hw_free(struct snd_pcm_substream *substream)
 347{
 348        struct audio_stream *stream = substream->private_data;
 349        au1000_release_dma_link(stream);
 350        return snd_pcm_lib_free_pages(substream);
 351}
 352
 353static int
 354snd_au1000_playback_prepare(struct snd_pcm_substream *substream)
 355{
 356        struct snd_au1000 *au1000 = substream->pcm->private_data;
 357        struct snd_pcm_runtime *runtime = substream->runtime;
 358
 359        if (runtime->channels == 1)
 360                au1000_set_ac97_xmit_slots(au1000, AC97_SLOT_4);
 361        else
 362                au1000_set_ac97_xmit_slots(au1000, AC97_SLOT_3 | AC97_SLOT_4);
 363        snd_ac97_set_rate(au1000->ac97, AC97_PCM_FRONT_DAC_RATE, runtime->rate);
 364        return 0;
 365}
 366
 367static int
 368snd_au1000_capture_prepare(struct snd_pcm_substream *substream)
 369{
 370        struct snd_au1000 *au1000 = substream->pcm->private_data;
 371        struct snd_pcm_runtime *runtime = substream->runtime;
 372
 373        if (runtime->channels == 1)
 374                au1000_set_ac97_recv_slots(au1000, AC97_SLOT_4);
 375        else
 376                au1000_set_ac97_recv_slots(au1000, AC97_SLOT_3 | AC97_SLOT_4);
 377        snd_ac97_set_rate(au1000->ac97, AC97_PCM_LR_ADC_RATE, runtime->rate);
 378        return 0;
 379}
 380
 381static int
 382snd_au1000_trigger(struct snd_pcm_substream *substream, int cmd)
 383{
 384        struct audio_stream *stream = substream->private_data;
 385        int err = 0;
 386
 387        spin_lock(&stream->dma_lock);
 388        switch (cmd) {
 389        case SNDRV_PCM_TRIGGER_START:
 390                au1000_dma_start(stream);
 391                break;
 392        case SNDRV_PCM_TRIGGER_STOP:
 393                au1000_dma_stop(stream);
 394                break;
 395        default:
 396                err = -EINVAL;
 397                break;
 398        }
 399        spin_unlock(&stream->dma_lock);
 400        return err;
 401}
 402
 403static snd_pcm_uframes_t
 404snd_au1000_pointer(struct snd_pcm_substream *substream)
 405{
 406        struct audio_stream *stream = substream->private_data;
 407        struct snd_pcm_runtime *runtime = substream->runtime;
 408        long location;
 409
 410        spin_lock(&stream->dma_lock);
 411        location = get_dma_residue(stream->dma);
 412        spin_unlock(&stream->dma_lock);
 413        location = stream->buffer->relative_end - location;
 414        if (location == -1)
 415                location = 0;
 416        return bytes_to_frames(runtime,location);
 417}
 418
 419static struct snd_pcm_ops snd_card_au1000_playback_ops = {
 420        .open                   = snd_au1000_playback_open,
 421        .close                  = snd_au1000_playback_close,
 422        .ioctl                  = snd_pcm_lib_ioctl,
 423        .hw_params              = snd_au1000_hw_params,
 424        .hw_free                = snd_au1000_hw_free,
 425        .prepare                = snd_au1000_playback_prepare,
 426        .trigger                = snd_au1000_trigger,
 427        .pointer                = snd_au1000_pointer,
 428};
 429
 430static struct snd_pcm_ops snd_card_au1000_capture_ops = {
 431        .open                   = snd_au1000_capture_open,
 432        .close                  = snd_au1000_capture_close,
 433        .ioctl                  = snd_pcm_lib_ioctl,
 434        .hw_params              = snd_au1000_hw_params,
 435        .hw_free                = snd_au1000_hw_free,
 436        .prepare                = snd_au1000_capture_prepare,
 437        .trigger                = snd_au1000_trigger,
 438        .pointer                = snd_au1000_pointer,
 439};
 440
 441static int __devinit
 442snd_au1000_pcm_new(struct snd_au1000 *au1000)
 443{
 444        struct snd_pcm *pcm;
 445        int err;
 446        unsigned long flags;
 447
 448        if ((err = snd_pcm_new(au1000->card, "AU1000 AC97 PCM", 0, 1, 1, &pcm)) < 0)
 449                return err;
 450
 451        snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
 452                snd_dma_continuous_data(GFP_KERNEL), 128*1024, 128*1024);
 453
 454        snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
 455                &snd_card_au1000_playback_ops);
 456        snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
 457                &snd_card_au1000_capture_ops);
 458
 459        pcm->private_data = au1000;
 460        pcm->info_flags = 0;
 461        strcpy(pcm->name, "Au1000 AC97 PCM");
 462
 463        spin_lock_init(&au1000->stream[PLAYBACK]->dma_lock);
 464        spin_lock_init(&au1000->stream[CAPTURE]->dma_lock);
 465
 466        flags = claim_dma_lock();
 467        if ((au1000->stream[PLAYBACK]->dma = request_au1000_dma(DMA_ID_AC97C_TX,
 468                        "AC97 TX", au1000_dma_interrupt, IRQF_DISABLED,
 469                        au1000->stream[PLAYBACK])) < 0) {
 470                release_dma_lock(flags);
 471                return -EBUSY;
 472        }
 473        if ((au1000->stream[CAPTURE]->dma = request_au1000_dma(DMA_ID_AC97C_RX,
 474                        "AC97 RX", au1000_dma_interrupt, IRQF_DISABLED,
 475                        au1000->stream[CAPTURE])) < 0){
 476                release_dma_lock(flags);
 477                return -EBUSY;
 478        }
 479        /* enable DMA coherency in read/write DMA channels */
 480        set_dma_mode(au1000->stream[PLAYBACK]->dma,
 481                     get_dma_mode(au1000->stream[PLAYBACK]->dma) & ~DMA_NC);
 482        set_dma_mode(au1000->stream[CAPTURE]->dma,
 483                     get_dma_mode(au1000->stream[CAPTURE]->dma) & ~DMA_NC);
 484        release_dma_lock(flags);
 485        au1000->pcm = pcm;
 486        return 0;
 487}
 488
 489
 490/*-------------------------- AC97 CODEC Control ------------------------------*/
 491
 492static unsigned short
 493snd_au1000_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
 494{
 495        struct snd_au1000 *au1000 = ac97->private_data;
 496        u32 volatile cmd;
 497        u16 volatile data;
 498        int             i;
 499
 500        spin_lock(&au1000->ac97_lock);
 501/* would rather use the interrupt than this polling but it works and I can't
 502get the interrupt driven case to work efficiently */
 503        for (i = 0; i < 0x5000; i++)
 504                if (!(au1000->ac97_ioport->status & AC97C_CP))
 505                        break;
 506        if (i == 0x5000)
 507                printk(KERN_ERR "au1000 AC97: AC97 command read timeout\n");
 508
 509        cmd = (u32) reg & AC97C_INDEX_MASK;
 510        cmd |= AC97C_READ;
 511        au1000->ac97_ioport->cmd = cmd;
 512
 513        /* now wait for the data */
 514        for (i = 0; i < 0x5000; i++)
 515                if (!(au1000->ac97_ioport->status & AC97C_CP))
 516                        break;
 517        if (i == 0x5000) {
 518                printk(KERN_ERR "au1000 AC97: AC97 command read timeout\n");
 519                spin_unlock(&au1000->ac97_lock);
 520                return 0;
 521        }
 522
 523        data = au1000->ac97_ioport->cmd & 0xffff;
 524        spin_unlock(&au1000->ac97_lock);
 525
 526        return data;
 527
 528}
 529
 530
 531static void
 532snd_au1000_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val)
 533{
 534        struct snd_au1000 *au1000 = ac97->private_data;
 535        u32 cmd;
 536        int i;
 537
 538        spin_lock(&au1000->ac97_lock);
 539/* would rather use the interrupt than this polling but it works and I can't
 540get the interrupt driven case to work efficiently */
 541        for (i = 0; i < 0x5000; i++)
 542                if (!(au1000->ac97_ioport->status & AC97C_CP))
 543                        break;
 544        if (i == 0x5000)
 545                printk(KERN_ERR "au1000 AC97: AC97 command write timeout\n");
 546
 547        cmd = (u32) reg & AC97C_INDEX_MASK;
 548        cmd &= ~AC97C_READ;
 549        cmd |= ((u32) val << AC97C_WD_BIT);
 550        au1000->ac97_ioport->cmd = cmd;
 551        spin_unlock(&au1000->ac97_lock);
 552}
 553
 554static int __devinit
 555snd_au1000_ac97_new(struct snd_au1000 *au1000)
 556{
 557        int err;
 558        struct snd_ac97_bus *pbus;
 559        struct snd_ac97_template ac97;
 560        static struct snd_ac97_bus_ops ops = {
 561                .write = snd_au1000_ac97_write,
 562                .read = snd_au1000_ac97_read,
 563        };
 564
 565        if ((au1000->ac97_res_port = request_mem_region(CPHYSADDR(AC97C_CONFIG),
 566                        0x100000, "Au1x00 AC97")) == NULL) {
 567                snd_printk(KERN_ERR "ALSA AC97: can't grap AC97 port\n");
 568                return -EBUSY;
 569        }
 570        au1000->ac97_ioport = (struct au1000_ac97_reg *)
 571                KSEG1ADDR(au1000->ac97_res_port->start);
 572
 573        spin_lock_init(&au1000->ac97_lock);
 574
 575        /* configure pins for AC'97
 576        TODO: move to board_setup.c */
 577        au_writel(au_readl(SYS_PINFUNC) & ~0x02, SYS_PINFUNC);
 578
 579        /* Initialise Au1000's AC'97 Control Block */
 580        au1000->ac97_ioport->cntrl = AC97C_RS | AC97C_CE;
 581        udelay(10);
 582        au1000->ac97_ioport->cntrl = AC97C_CE;
 583        udelay(10);
 584
 585        /* Initialise External CODEC -- cold reset */
 586        au1000->ac97_ioport->config = AC97C_RESET;
 587        udelay(10);
 588        au1000->ac97_ioport->config = 0x0;
 589        mdelay(5);
 590
 591        /* Initialise AC97 middle-layer */
 592        if ((err = snd_ac97_bus(au1000->card, 0, &ops, au1000, &pbus)) < 0)
 593                return err;
 594
 595        memset(&ac97, 0, sizeof(ac97));
 596        ac97.private_data = au1000;
 597        if ((err = snd_ac97_mixer(pbus, &ac97, &au1000->ac97)) < 0)
 598                return err;
 599
 600        return 0;
 601}
 602
 603/*------------------------------ Setup / Destroy ----------------------------*/
 604
 605void
 606snd_au1000_free(struct snd_card *card)
 607{
 608        struct snd_au1000 *au1000 = card->private_data;
 609
 610        if (au1000->ac97_res_port) {
 611                /* put internal AC97 block into reset */
 612                au1000->ac97_ioport->cntrl = AC97C_RS;
 613                au1000->ac97_ioport = NULL;
 614                release_and_free_resource(au1000->ac97_res_port);
 615        }
 616
 617        if (au1000->stream[PLAYBACK]) {
 618                if (au1000->stream[PLAYBACK]->dma >= 0)
 619                        free_au1000_dma(au1000->stream[PLAYBACK]->dma);
 620                kfree(au1000->stream[PLAYBACK]);
 621        }
 622
 623        if (au1000->stream[CAPTURE]) {
 624                if (au1000->stream[CAPTURE]->dma >= 0)
 625                        free_au1000_dma(au1000->stream[CAPTURE]->dma);
 626                kfree(au1000->stream[CAPTURE]);
 627        }
 628}
 629
 630
 631static struct snd_card *au1000_card;
 632
 633static int __init
 634au1000_init(void)
 635{
 636        int err;
 637        struct snd_card *card;
 638        struct snd_au1000 *au1000;
 639
 640        err = snd_card_create(-1, "AC97", THIS_MODULE,
 641                              sizeof(struct snd_au1000), &card);
 642        if (err < 0)
 643                return err;
 644
 645        card->private_free = snd_au1000_free;
 646        au1000 = card->private_data;
 647        au1000->card = card;
 648
 649        au1000->stream[PLAYBACK] = kmalloc(sizeof(struct audio_stream), GFP_KERNEL);
 650        au1000->stream[CAPTURE ] = kmalloc(sizeof(struct audio_stream), GFP_KERNEL);
 651        /* so that snd_au1000_free will work as intended */
 652        au1000->ac97_res_port = NULL;
 653        if (au1000->stream[PLAYBACK])
 654                au1000->stream[PLAYBACK]->dma = -1;
 655        if (au1000->stream[CAPTURE ])
 656                au1000->stream[CAPTURE ]->dma = -1;
 657
 658        if (au1000->stream[PLAYBACK] == NULL ||
 659            au1000->stream[CAPTURE ] == NULL) {
 660                snd_card_free(card);
 661                return -ENOMEM;
 662        }
 663
 664        if ((err = snd_au1000_ac97_new(au1000)) < 0 ) {
 665                snd_card_free(card);
 666                return err;
 667        }
 668
 669        if ((err = snd_au1000_pcm_new(au1000)) < 0) {
 670                snd_card_free(card);
 671                return err;
 672        }
 673
 674        strcpy(card->driver, "Au1000-AC97");
 675        strcpy(card->shortname, "AMD Au1000-AC97");
 676        sprintf(card->longname, "AMD Au1000--AC97 ALSA Driver");
 677
 678        if ((err = snd_card_register(card)) < 0) {
 679                snd_card_free(card);
 680                return err;
 681        }
 682
 683        printk(KERN_INFO "ALSA AC97: Driver Initialized\n");
 684        au1000_card = card;
 685        return 0;
 686}
 687
 688static void __exit au1000_exit(void)
 689{
 690        snd_card_free(au1000_card);
 691}
 692
 693module_init(au1000_init);
 694module_exit(au1000_exit);
 695
 696
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.