From: Ley Foon Tan Date: Tue, 24 Dec 2019 16:23:44 +0800 Subject: [PATCH v2 1/2] reset: socfpga: Add reset status callback function In-Reply-To: <1577175825-6424-1-git-send-email-ley.foon.tan@intel.com> References: <1577175825-6424-1-git-send-email-ley.foon.tan@intel.com> Message-ID: <1577175825-6424-2-git-send-email-ley.foon.tan@intel.com> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de Add .rst_status callback function. Read reset status from register, return 0 if deasserted, non-zero if asserted Signed-off-by: Ley Foon Tan --- drivers/reset/reset-socfpga.c | 12 ++++++++++++ 1 file changed, 12 insertions(+) diff --git a/drivers/reset/reset-socfpga.c b/drivers/reset/reset-socfpga.c index 93ec9cfdb6..b77c893b76 100644 --- a/drivers/reset/reset-socfpga.c +++ b/drivers/reset/reset-socfpga.c @@ -99,11 +99,23 @@ static int socfpga_reset_free(struct reset_ctl *reset_ctl) return 0; } +static int socfpga_reset_status(struct reset_ctl *reset_ctl) +{ + struct socfpga_reset_data *data = dev_get_priv(reset_ctl->dev); + int id = reset_ctl->id; + int reg_width = sizeof(u32); + int bank = id / (reg_width * BITS_PER_BYTE); + int offset = id % (reg_width * BITS_PER_BYTE); + + return readl(data->modrst_base + (bank * BANK_INCREMENT)) & BIT(offset); +} + static const struct reset_ops socfpga_reset_ops = { .request = socfpga_reset_request, .free = socfpga_reset_free, .rst_assert = socfpga_reset_assert, .rst_deassert = socfpga_reset_deassert, + .rst_status = socfpga_reset_status, }; static int socfpga_reset_probe(struct udevice *dev) -- 2.19.0