drivers/reset/reset-hisilicon.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2019, Linaro Limited
   4  */
   5
   6 #include <log.h>
   7 #include <malloc.h>
   8 #include <asm/io.h>
   9 #include <common.h>
  10 #include <dm.h>
  11 #include <dt-bindings/reset/ti-syscon.h>
  12 #include <reset-uclass.h>
  13 #include <linux/bitops.h>
  14
  15 struct hisi_reset_priv {
  16         void __iomem *base;
  17 };
  18
  19 static int hisi_reset_deassert(struct reset_ctl *rst)
  20 {
  21         struct hisi_reset_priv *priv = dev_get_priv(rst->dev);
  22         u32 val;
  23
  24         val = readl(priv->base + rst->data);
  25         if (rst->polarity & DEASSERT_SET)
  26                 val |= BIT(rst->id);
  27         else
  28                 val &= ~BIT(rst->id);
  29         writel(val, priv->base + rst->data);
  30
  31         return 0;
  32 }
  33
  34 static int hisi_reset_assert(struct reset_ctl *rst)
  35 {
  36         struct hisi_reset_priv *priv = dev_get_priv(rst->dev);
  37         u32 val;
  38
  39         val = readl(priv->base + rst->data);
  40         if (rst->polarity & ASSERT_SET)
  41                 val |= BIT(rst->id);
  42         else
  43                 val &= ~BIT(rst->id);
  44         writel(val, priv->base + rst->data);
  45
  46         return 0;
  47 }
  48
  49 static int hisi_reset_of_xlate(struct reset_ctl *rst,
  50                                struct ofnode_phandle_args *args)
  51 {
  52         if (args->args_count != 3) {
  53                 debug("Invalid args_count: %d\n", args->args_count);
  54                 return -EINVAL;
  55         }
  56
  57         /* Use .data field as register offset and .id field as bit shift */
  58         rst->data = args->args[0];
  59         rst->id = args->args[1];
  60         rst->polarity = args->args[2];
  61
  62         return 0;
  63 }
  64
  65 static const struct reset_ops hisi_reset_reset_ops = {
  66         .of_xlate = hisi_reset_of_xlate,
  67         .rst_assert = hisi_reset_assert,
  68         .rst_deassert = hisi_reset_deassert,
  69 };
  70
  71 static const struct udevice_id hisi_reset_ids[] = {
  72         { .compatible = "hisilicon,hi3798cv200-reset" },
  73         { }
  74 };
  75
  76 static int hisi_reset_probe(struct udevice *dev)
  77 {
  78         struct hisi_reset_priv *priv = dev_get_priv(dev);
  79
  80         priv->base = dev_remap_addr(dev);
  81         if (!priv->base)
  82                 return -ENOMEM;
  83
  84         return 0;
  85 }
  86
  87 U_BOOT_DRIVER(hisi_reset) = {
  88         .name = "hisilicon_reset",
  89         .id = UCLASS_RESET,
  90         .of_match = hisi_reset_ids,
  91         .ops = &hisi_reset_reset_ops,
  92         .probe = hisi_reset_probe,
  93         .priv_auto      = sizeof(struct hisi_reset_priv),
  94 };