mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-24 05:04:00 +08:00
c942fddf87
Based on 3 normalized pattern(s): 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 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 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 [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] 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 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 [author] [graeme] [gregory] [gg]@[slimlogic] [co] [uk] [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] [based] [on] [twl6030]_[usb] [c] [author] [hema] [hk] [hemahk]@[ti] [com] 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 extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 1105 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Richard Fontana <rfontana@redhat.com> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070033.202006027@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
110 lines
2.7 KiB
C
110 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (c) 2014 MundoReader S.L.
|
|
* Author: Heiko Stuebner <heiko@sntech.de>
|
|
*/
|
|
|
|
#include <linux/slab.h>
|
|
#include <linux/io.h>
|
|
#include <linux/reset-controller.h>
|
|
#include <linux/spinlock.h>
|
|
#include "clk.h"
|
|
|
|
struct rockchip_softrst {
|
|
struct reset_controller_dev rcdev;
|
|
void __iomem *reg_base;
|
|
int num_regs;
|
|
int num_per_reg;
|
|
u8 flags;
|
|
spinlock_t lock;
|
|
};
|
|
|
|
static int rockchip_softrst_assert(struct reset_controller_dev *rcdev,
|
|
unsigned long id)
|
|
{
|
|
struct rockchip_softrst *softrst = container_of(rcdev,
|
|
struct rockchip_softrst,
|
|
rcdev);
|
|
int bank = id / softrst->num_per_reg;
|
|
int offset = id % softrst->num_per_reg;
|
|
|
|
if (softrst->flags & ROCKCHIP_SOFTRST_HIWORD_MASK) {
|
|
writel(BIT(offset) | (BIT(offset) << 16),
|
|
softrst->reg_base + (bank * 4));
|
|
} else {
|
|
unsigned long flags;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&softrst->lock, flags);
|
|
|
|
reg = readl(softrst->reg_base + (bank * 4));
|
|
writel(reg | BIT(offset), softrst->reg_base + (bank * 4));
|
|
|
|
spin_unlock_irqrestore(&softrst->lock, flags);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rockchip_softrst_deassert(struct reset_controller_dev *rcdev,
|
|
unsigned long id)
|
|
{
|
|
struct rockchip_softrst *softrst = container_of(rcdev,
|
|
struct rockchip_softrst,
|
|
rcdev);
|
|
int bank = id / softrst->num_per_reg;
|
|
int offset = id % softrst->num_per_reg;
|
|
|
|
if (softrst->flags & ROCKCHIP_SOFTRST_HIWORD_MASK) {
|
|
writel((BIT(offset) << 16), softrst->reg_base + (bank * 4));
|
|
} else {
|
|
unsigned long flags;
|
|
u32 reg;
|
|
|
|
spin_lock_irqsave(&softrst->lock, flags);
|
|
|
|
reg = readl(softrst->reg_base + (bank * 4));
|
|
writel(reg & ~BIT(offset), softrst->reg_base + (bank * 4));
|
|
|
|
spin_unlock_irqrestore(&softrst->lock, flags);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct reset_control_ops rockchip_softrst_ops = {
|
|
.assert = rockchip_softrst_assert,
|
|
.deassert = rockchip_softrst_deassert,
|
|
};
|
|
|
|
void __init rockchip_register_softrst(struct device_node *np,
|
|
unsigned int num_regs,
|
|
void __iomem *base, u8 flags)
|
|
{
|
|
struct rockchip_softrst *softrst;
|
|
int ret;
|
|
|
|
softrst = kzalloc(sizeof(*softrst), GFP_KERNEL);
|
|
if (!softrst)
|
|
return;
|
|
|
|
spin_lock_init(&softrst->lock);
|
|
|
|
softrst->reg_base = base;
|
|
softrst->flags = flags;
|
|
softrst->num_regs = num_regs;
|
|
softrst->num_per_reg = (flags & ROCKCHIP_SOFTRST_HIWORD_MASK) ? 16
|
|
: 32;
|
|
|
|
softrst->rcdev.owner = THIS_MODULE;
|
|
softrst->rcdev.nr_resets = num_regs * softrst->num_per_reg;
|
|
softrst->rcdev.ops = &rockchip_softrst_ops;
|
|
softrst->rcdev.of_node = np;
|
|
ret = reset_controller_register(&softrst->rcdev);
|
|
if (ret) {
|
|
pr_err("%s: could not register reset controller, %d\n",
|
|
__func__, ret);
|
|
kfree(softrst);
|
|
}
|
|
};
|