linux-imx

/*

 * Copyright (C) 2014 Marvell Technology Group Ltd.

 *

 * Marvell Berlin reset driver

 *

 * Antoine Tenart <antoine.tenart@free-electrons.com>

 * Sebastian Hesselbarth <sebastian.hesselbarth@gmail.com>

 *

 * This file is licensed under the terms of the GNU General Public

 * License version 2. This program is licensed "as is" without any

 * warranty of any kind, whether express or implied.

 */

​

#include <linux/delay.h>

#include <linux/io.h>

#include <linux/mfd/syscon.h>

#include <linux/init.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

#include <linux/reset-controller.h>

#include <linux/slab.h>

#include <linux/types.h>

​

#define BERLIN_MAX_RESETS   32

​

#define to_berlin_reset_priv(p)     \

    container_of((p), struct berlin_reset_priv, rcdev)

​

struct berlin_reset_priv {

    struct regmap           *regmap;

    struct reset_controller_dev rcdev;

};

​

static int berlin_reset_reset(struct reset_controller_dev *rcdev,

                  unsigned long id)

{

    struct berlin_reset_priv *priv = to_berlin_reset_priv(rcdev);

    int offset = id >> 8;

    int mask = BIT(id & 0x1f);

​

    regmap_write(priv->regmap, offset, mask);

​

    /* let the reset be effective */

    udelay(10);

​

    return 0;

}

​

static const struct reset_control_ops berlin_reset_ops = {

    .reset  = berlin_reset_reset,

};

​

static int berlin_reset_xlate(struct reset_controller_dev *rcdev,

                  const struct of_phandle_args *reset_spec)

{

    unsigned offset, bit;

​

    offset = reset_spec->args[0];

    bit = reset_spec->args[1];

​

    if (bit >= BERLIN_MAX_RESETS)