linux-imx

/*

 * System Control Driver

 *

 * Copyright (C) 2012 Freescale Semiconductor, Inc.

 * Copyright (C) 2012 Linaro Ltd.

 *

 * Author: Dong Aisheng <dong.aisheng@linaro.org>

 *

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

 */

​

#include <linux/err.h>

#include <linux/hwspinlock.h>

#include <linux/io.h>

#include <linux/init.h>

#include <linux/list.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/of_platform.h>

#include <linux/platform_data/syscon.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

#include <linux/mfd/syscon.h>

#include <linux/slab.h>

​

static struct platform_driver syscon_driver;

​

static DEFINE_SPINLOCK(syscon_list_slock);

static LIST_HEAD(syscon_list);

​

struct syscon {

    struct device_node *np;

    struct regmap *regmap;

    struct list_head list;

};

​

static const struct regmap_config syscon_regmap_config = {

    .reg_bits = 32,

    .val_bits = 32,

    .reg_stride = 4,

};

​

static struct syscon *of_syscon_register(struct device_node *np)

{

    struct syscon *syscon;

    struct regmap *regmap;

    void __iomem *base;

    u32 reg_io_width;

    int ret;

    struct regmap_config syscon_config = syscon_regmap_config;

    struct resource res;

​

    if (!of_device_is_compatible(np, "syscon"))

        return ERR_PTR(-EINVAL);

​

    syscon = kzalloc(sizeof(*syscon), GFP_KERNEL);

    if (!syscon)

        return ERR_PTR(-ENOMEM);

​

    if (of_address_to_resource(np, 0, &res)) {