Add a the status callback for the reset controller part of the clock
code in the tegra to allow drivers to query the status of a reset line.

Signed-off-by: Ben Dooks <[email protected]>
---
 drivers/clk/tegra/clk.c | 14 ++++++++++++++
 1 file changed, 14 insertions(+)

diff --git a/drivers/clk/tegra/clk.c b/drivers/clk/tegra/clk.c
index ffaf17f71860..a2cb3d0d38bf 100644
--- a/drivers/clk/tegra/clk.c
+++ b/drivers/clk/tegra/clk.c
@@ -146,6 +146,19 @@ static const struct tegra_clk_periph_regs periph_regs[] = {
 
 static void __iomem *clk_base;
 
+static int tegra_clk_rst_status(struct reset_controller_dev *rcdev,
+                               unsigned long id)
+{
+       void __iomem *reg;
+
+       if (id < periph_banks * 32) {
+               reg = clk_base + periph_regs[id / 32].rst_reg;
+               return readl_relaxed(reg) & BIT(id % 32) ? 1 : 0;
+       }
+
+       return -EINVAL;
+}
+
 static int tegra_clk_rst_assert(struct reset_controller_dev *rcdev,
                unsigned long id)
 {
@@ -288,6 +301,7 @@ void __init tegra_init_from_table(struct 
tegra_clk_init_table *tbl,
 }
 
 static const struct reset_control_ops rst_ops = {
+       .status = tegra_clk_rst_status,
        .assert = tegra_clk_rst_assert,
        .deassert = tegra_clk_rst_deassert,
        .reset = tegra_clk_rst_reset,
-- 
2.18.0

Reply via email to