123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright 2020 ASPEED Technology Inc.
- */
- #include <common.h>
- #include <dm.h>
- #include <log.h>
- #include <misc.h>
- #include <reset.h>
- #include <reset-uclass.h>
- #include <linux/err.h>
- #include <asm/io.h>
- #include <asm/arch/scu_ast2600.h>
- struct ast2600_reset_priv {
- struct ast2600_scu *scu;
- };
- static int ast2600_reset_request(struct reset_ctl *reset_ctl)
- {
- debug("%s(reset_ctl=%p) (dev=%p, id=%lu)\n", __func__, reset_ctl,
- reset_ctl->dev, reset_ctl->id);
- return 0;
- }
- static int ast2600_reset_free(struct reset_ctl *reset_ctl)
- {
- debug("%s(reset_ctl=%p) (dev=%p, id=%lu)\n", __func__, reset_ctl,
- reset_ctl->dev, reset_ctl->id);
- return 0;
- }
- static int ast2600_reset_assert(struct reset_ctl *reset_ctl)
- {
- struct ast2600_reset_priv *priv = dev_get_priv(reset_ctl->dev);
- struct ast2600_scu *scu = priv->scu;
- debug("%s: reset_ctl->id: %lu\n", __func__, reset_ctl->id);
- if (reset_ctl->id < 32)
- writel(BIT(reset_ctl->id), &scu->modrst_ctrl1);
- else
- writel(BIT(reset_ctl->id - 32), &scu->modrst_ctrl2);
- return 0;
- }
- static int ast2600_reset_deassert(struct reset_ctl *reset_ctl)
- {
- struct ast2600_reset_priv *priv = dev_get_priv(reset_ctl->dev);
- struct ast2600_scu *scu = priv->scu;
- debug("%s: reset_ctl->id: %lu\n", __func__, reset_ctl->id);
- if (reset_ctl->id < 32)
- writel(BIT(reset_ctl->id), &scu->modrst_clr1);
- else
- writel(BIT(reset_ctl->id - 32), &scu->modrst_clr2);
- return 0;
- }
- static int ast2600_reset_probe(struct udevice *dev)
- {
- int rc;
- struct ast2600_reset_priv *priv = dev_get_priv(dev);
- struct udevice *scu_dev;
- /* get SCU base from clock device */
- rc = uclass_get_device_by_driver(UCLASS_CLK,
- DM_DRIVER_GET(aspeed_ast2600_scu), &scu_dev);
- if (rc) {
- debug("%s: clock device not found, rc=%d\n", __func__, rc);
- return rc;
- }
- priv->scu = devfdt_get_addr_ptr(scu_dev);
- if (IS_ERR_OR_NULL(priv->scu)) {
- debug("%s: invalid SCU base pointer\n", __func__);
- return PTR_ERR(priv->scu);
- }
- return 0;
- }
- static const struct udevice_id ast2600_reset_ids[] = {
- { .compatible = "aspeed,ast2600-reset" },
- { }
- };
- struct reset_ops ast2600_reset_ops = {
- .request = ast2600_reset_request,
- .rfree = ast2600_reset_free,
- .rst_assert = ast2600_reset_assert,
- .rst_deassert = ast2600_reset_deassert,
- };
- U_BOOT_DRIVER(ast2600_reset) = {
- .name = "ast2600_reset",
- .id = UCLASS_RESET,
- .of_match = ast2600_reset_ids,
- .probe = ast2600_reset_probe,
- .ops = &ast2600_reset_ops,
- .priv_auto = sizeof(struct ast2600_reset_priv),
- };
|