[PATCH] reset: axs10x: Implement assert and deassert callbacks

[Vitor Soares <vitor.soares@synopsys.com>]

Some custom IP-block connected to ARC AXS10x board need assert and
deassert functions to control reset signal of selected peripherals.

This patch improve AXS10x reset driver by adding assert and deassert
callbacks.

Signed-off-by: Vitor Soares <vitor.soares@synopsys.com>

Cc: Eugeniy Paltsev <eugeniy.Paltsev@synopsys.com>
Cc: Alexey Brodkin <abrodkin@synopsys.com>
Cc: Joao Pinto <jpinto@synopsys.com>
Cc: Jose Abreu <jose.abreu@synopsys.com>
Cc: Luis Oliveira <lolivei@synopsys.com>
Cc: Gustavo Pimentel <gustavo.pimentel@synopsys.com>
Cc: Nelson Costa <nelson.costa@synopsys.com>
Cc: Pedro Sousa <pedrom.sousa@synopsys.com>
Cc: Philipp Zabel <p.zabel@pengutronix.de>
---
 drivers/reset/reset-axs10x.c | 30 +++++++++++++++++++++++++++++-
 1 file changed, 29 insertions(+), 1 deletion(-)

diff --git a/drivers/reset/reset-axs10x.c b/drivers/reset/reset-axs10x.c
index a854ef41..12dac8b 100644
--- a/drivers/reset/reset-axs10x.c
+++ b/drivers/reset/reset-axs10x.c
@@ -37,8 +37,36 @@ static int axs10x_reset_reset(struct reset_controller_dev *rcdev,
 	return 0;
 }
 
+static int axs10x_reset_assert(struct reset_controller_dev *rcdev,
+			       unsigned long id)
+{
+	struct axs10x_rst *rst = to_axs10x_rst(rcdev);
+	unsigned long flags;
+
+	spin_lock_irqsave(&rst->lock, flags);
+	writel(readl(rst->regs_rst) & ~BIT(id), rst->regs_rst);
+	spin_unlock_irqrestore(&rst->lock, flags);
+
+	return 0;
+}
+
+static int axs10x_reset_deassert(struct reset_controller_dev *rcdev,
+				 unsigned long id)
+{
+	struct axs10x_rst *rst = to_axs10x_rst(rcdev);
+	unsigned long flags;
+
+	spin_lock_irqsave(&rst->lock, flags);
+	writel(readl(rst->regs_rst) | BIT(id), rst->regs_rst);
+	spin_unlock_irqrestore(&rst->lock, flags);
+
+	return 0;
+}
+
 static const struct reset_control_ops axs10x_reset_ops = {
-	.reset	= axs10x_reset_reset,
+	.reset		= axs10x_reset_reset,
+	.assert		= axs10x_reset_assert,
+	.deassert	= axs10x_reset_deassert,
 };
 
 static int axs10x_reset_probe(struct platform_device *pdev)
-- 
2.7.4