linux-imx

/*

 * Copyright (C) 2014 Free Electrons

 * Copyright (C) 2014 Atmel

 *

 * Author: Boris BREZILLON <boris.brezillon@free-electrons.com>

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License version 2 as published by

 * the Free Software Foundation.

 *

 * 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, see <http://www.gnu.org/licenses/>.

 */

​

#include <linux/clk.h>

#include <linux/iopoll.h>

#include <linux/mfd/atmel-hlcdc.h>

#include <linux/mfd/core.h>

#include <linux/module.h>

#include <linux/mod_devicetable.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

​

#define ATMEL_HLCDC_REG_MAX     (0x4000 - 0x4)

​

struct atmel_hlcdc_regmap {

    void __iomem *regs;

};

​

static const struct mfd_cell atmel_hlcdc_cells[] = {

    {

        .name = "atmel-hlcdc-pwm",

        .of_compatible = "atmel,hlcdc-pwm",

    },

    {

        .name = "atmel-hlcdc-dc",

        .of_compatible = "atmel,hlcdc-display-controller",

    },

};

​

static int regmap_atmel_hlcdc_reg_write(void *context, unsigned int reg,

                    unsigned int val)

{

    struct atmel_hlcdc_regmap *hregmap = context;

​

    if (reg <= ATMEL_HLCDC_DIS) {

        u32 status;

​

        readl_poll_timeout_atomic(hregmap->regs + ATMEL_HLCDC_SR,

                      status, !(status & ATMEL_HLCDC_SIP),

                      1, 100);

    }

​

    writel(val, hregmap->regs + reg);

​

    return 0;

}

​