linux-imx

/*

 * PMac Burgundy lowlevel functions

 *

 * Copyright (c) by Takashi Iwai <tiwai@suse.de>

 * code based on dmasound.c.

 *

 *   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; if not, write to the Free Software

 *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA

 */

​

#include <linux/io.h>

#include <linux/init.h>

#include <linux/delay.h>

#include <sound/core.h>

#include "pmac.h"

#include "burgundy.h"

​

​

/* Waits for busy flag to clear */

static inline void

snd_pmac_burgundy_busy_wait(struct snd_pmac *chip)

{

    int timeout = 50;

    while ((in_le32(&chip->awacs->codec_ctrl) & MASK_NEWECMD) && timeout--)

        udelay(1);

    if (timeout < 0)

        printk(KERN_DEBUG "burgundy_busy_wait: timeout\n");

}

​

static inline void

snd_pmac_burgundy_extend_wait(struct snd_pmac *chip)

{

    int timeout;

    timeout = 50;

    while (!(in_le32(&chip->awacs->codec_stat) & MASK_EXTEND) && timeout--)

        udelay(1);

    if (timeout < 0)

        printk(KERN_DEBUG "burgundy_extend_wait: timeout #1\n");

    timeout = 50;

    while ((in_le32(&chip->awacs->codec_stat) & MASK_EXTEND) && timeout--)

        udelay(1);

    if (timeout < 0)

        printk(KERN_DEBUG "burgundy_extend_wait: timeout #2\n");

}

​

static void

snd_pmac_burgundy_wcw(struct snd_pmac *chip, unsigned addr, unsigned val)

{

    out_le32(&chip->awacs->codec_ctrl, addr + 0x200c00 + (val & 0xff));

    snd_pmac_burgundy_busy_wait(chip);

    out_le32(&chip->awacs->codec_ctrl, addr + 0x200d00 +((val>>8) & 0xff));

    snd_pmac_burgundy_busy_wait(chip);

    out_le32(&chip->awacs->codec_ctrl, addr + 0x200e00 +((val>>16) & 0xff));

    snd_pmac_burgundy_busy_wait(chip);

    out_le32(&chip->awacs->codec_ctrl, addr + 0x200f00 +((val>>24) & 0xff));

    snd_pmac_burgundy_busy_wait(chip);

}

​

static unsigned

snd_pmac_burgundy_rcw(struct snd_pmac *chip, unsigned addr)

{

    unsigned val = 0;

    unsigned long flags;

​

    spin_lock_irqsave(&chip->reg_lock, flags);

​

    out_le32(&chip->awacs->codec_ctrl, addr + 0x100000);

    snd_pmac_burgundy_busy_wait(chip);

    snd_pmac_burgundy_extend_wait(chip);

    val += (in_le32(&chip->awacs->codec_stat) >> 4) & 0xff;

​

    out_le32(&chip->awacs->codec_ctrl, addr + 0x100100);

    snd_pmac_burgundy_busy_wait(chip);

    snd_pmac_burgundy_extend_wait(chip);

    val += ((in_le32(&chip->awacs->codec_stat)>>4) & 0xff) <<8;

​

    out_le32(&chip->awacs->codec_ctrl, addr + 0x100200);

    snd_pmac_burgundy_busy_wait(chip);

    snd_pmac_burgundy_extend_wait(chip);

    val += ((in_le32(&chip->awacs->codec_stat)>>4) & 0xff) <<16;

​