linux-imx

/*

 * Copyright (c) 2015, National Instruments Corp.

 *

 * Xilinx Zynq Reset controller driver

 *

 * Author: Moritz Fischer <moritz.fischer@ettus.com>

 *

 * 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; version 2 of the License.

 *

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

 */

​

#include <linux/err.h>

#include <linux/io.h>

#include <linux/init.h>

#include <linux/mfd/syscon.h>

#include <linux/of.h>

#include <linux/platform_device.h>

#include <linux/reset-controller.h>

#include <linux/regmap.h>

#include <linux/types.h>

​

struct zynq_reset_data {

    struct regmap *slcr;

    struct reset_controller_dev rcdev;

    u32 offset;

};

​

#define to_zynq_reset_data(p)       \

    container_of((p), struct zynq_reset_data, rcdev)

​

static int zynq_reset_assert(struct reset_controller_dev *rcdev,

                 unsigned long id)

{

    struct zynq_reset_data *priv = to_zynq_reset_data(rcdev);

​

    int bank = id / BITS_PER_LONG;

    int offset = id % BITS_PER_LONG;

​

    pr_debug("%s: %s reset bank %u offset %u\n", KBUILD_MODNAME, __func__,

         bank, offset);

​

    return regmap_update_bits(priv->slcr,

                  priv->offset + (bank * 4),

                  BIT(offset),

                  BIT(offset));

}

​

static int zynq_reset_deassert(struct reset_controller_dev *rcdev,

                   unsigned long id)

{

    struct zynq_reset_data *priv = to_zynq_reset_data(rcdev);

​

    int bank = id / BITS_PER_LONG;

    int offset = id % BITS_PER_LONG;

​

    pr_debug("%s: %s reset bank %u offset %u\n", KBUILD_MODNAME, __func__,

         bank, offset);