arch/arm/cpu/tegra-common/powergate.c

   1 /*
   2  * Copyright (c) 2014, NVIDIA CORPORATION.  All rights reserved.
   3  *
   4  * SPDX-License-Identifier: GPL-2.0
   5  */
   6
   7 #include <common.h>
   8 #include <errno.h>
   9
  10 #include <asm/io.h>
  11 #include <asm/types.h>
  12
  13 #include <asm/arch/powergate.h>
  14 #include <asm/arch/tegra.h>
  15
  16 #define PWRGATE_TOGGLE 0x30
  17 #define  PWRGATE_TOGGLE_START (1 << 8)
  18
  19 #define REMOVE_CLAMPING 0x34
  20
  21 #define PWRGATE_STATUS 0x38
  22
  23 static int tegra_powergate_set(enum tegra_powergate id, bool state)
  24 {
  25         u32 value, mask = state ? (1 << id) : 0, old_mask;
  26         unsigned long start, timeout = 25;
  27
  28         value = readl(NV_PA_PMC_BASE + PWRGATE_STATUS);
  29         old_mask = value & (1 << id);
  30
  31         if (mask == old_mask)
  32                 return 0;
  33
  34         writel(PWRGATE_TOGGLE_START | id, NV_PA_PMC_BASE + PWRGATE_TOGGLE);
  35
  36         start = get_timer(0);
  37
  38         while (get_timer(start) < timeout) {
  39                 value = readl(NV_PA_PMC_BASE + PWRGATE_STATUS);
  40                 if ((value & (1 << id)) == mask)
  41                         return 0;
  42         }
  43
  44         return -ETIMEDOUT;
  45 }
  46
  47 static int tegra_powergate_power_on(enum tegra_powergate id)
  48 {
  49         return tegra_powergate_set(id, true);
  50 }
  51
  52 int tegra_powergate_power_off(enum tegra_powergate id)
  53 {
  54         return tegra_powergate_set(id, false);
  55 }
  56
  57 static int tegra_powergate_remove_clamping(enum tegra_powergate id)
  58 {
  59         unsigned long value;
  60
  61         /*
  62          * The REMOVE_CLAMPING register has the bits for the PCIE and VDEC
  63          * partitions reversed. This was originally introduced on Tegra20 but
  64          * has since been carried forward for backwards-compatibility.
  65          */
  66         if (id == TEGRA_POWERGATE_VDEC)
  67                 value = 1 << TEGRA_POWERGATE_PCIE;
  68         else if (id == TEGRA_POWERGATE_PCIE)
  69                 value = 1 << TEGRA_POWERGATE_VDEC;
  70         else
  71                 value = 1 << id;
  72
  73         writel(value, NV_PA_PMC_BASE + REMOVE_CLAMPING);
  74
  75         return 0;
  76 }
  77
  78 int tegra_powergate_sequence_power_up(enum tegra_powergate id,
  79                                       enum periph_id periph)
  80 {
  81         int err;
  82
  83         reset_set_enable(periph, 1);
  84
  85         err = tegra_powergate_power_on(id);
  86         if (err < 0)
  87                 return err;
  88
  89         clock_enable(periph);
  90
  91         udelay(10);
  92
  93         err = tegra_powergate_remove_clamping(id);
  94         if (err < 0)
  95                 return err;
  96
  97         udelay(10);
  98
  99         reset_set_enable(periph, 0);
 100
 101         return 0;
 102 }