linux-imx

/*

 *  linux/drivers/mfd/mcp-sa11x0.c

 *

 *  Copyright (C) 2001-2005 Russell King

 *

 * 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.

 *

 *  SA11x0 MCP (Multimedia Communications Port) driver.

 *

 *  MCP read/write timeouts from Jordi Colomer, rehacked by rmk.

 */

#include <linux/module.h>

#include <linux/io.h>

#include <linux/errno.h>

#include <linux/kernel.h>

#include <linux/delay.h>

#include <linux/spinlock.h>

#include <linux/platform_device.h>

#include <linux/pm.h>

#include <linux/mfd/mcp.h>

​

#include <mach/hardware.h>

#include <asm/mach-types.h>

#include <linux/platform_data/mfd-mcp-sa11x0.h>

​

#define DRIVER_NAME "sa11x0-mcp"

​

struct mcp_sa11x0 {

    void __iomem    *base0;

    void __iomem    *base1;

    u32     mccr0;

    u32     mccr1;

};

​

/* Register offsets */

#define MCCR0(m)    ((m)->base0 + 0x00)

#define MCDR0(m)    ((m)->base0 + 0x08)

#define MCDR1(m)    ((m)->base0 + 0x0c)

#define MCDR2(m)    ((m)->base0 + 0x10)

#define MCSR(m)     ((m)->base0 + 0x18)

#define MCCR1(m)    ((m)->base1 + 0x00)

​

#define priv(mcp)   ((struct mcp_sa11x0 *)mcp_priv(mcp))

​

static void

mcp_sa11x0_set_telecom_divisor(struct mcp *mcp, unsigned int divisor)

{

    struct mcp_sa11x0 *m = priv(mcp);

​

    divisor /= 32;

​

    m->mccr0 &= ~0x00007f00;

    m->mccr0 |= divisor << 8;

    writel_relaxed(m->mccr0, MCCR0(m));

}

​

static void

mcp_sa11x0_set_audio_divisor(struct mcp *mcp, unsigned int divisor)

{

    struct mcp_sa11x0 *m = priv(mcp);

​

    divisor /= 32;

​

    m->mccr0 &= ~0x0000007f;

    m->mccr0 |= divisor;

    writel_relaxed(m->mccr0, MCCR0(m));

}

​

/*

 * Write data to the device.  The bit should be set after 3 subframe

 * times (each frame is 64 clocks).  We wait a maximum of 6 subframes.

 * We really should try doing something more productive while we

 * wait.

 */

static void

mcp_sa11x0_write(struct mcp *mcp, unsigned int reg, unsigned int val)

{

    struct mcp_sa11x0 *m = priv(mcp);

    int ret = -ETIME;

    int i;

​

    writel_relaxed(reg << 17 | MCDR2_Wr | (val & 0xffff), MCDR2(m));

​

    for (i = 0; i < 2; i++) {

        udelay(mcp->rw_timeout);

        if (readl_relaxed(MCSR(m)) & MCSR_CWC) {

            ret = 0;

            break;

        }

    }