arch/arm/mach-davinci/psc.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Power and Sleep Controller (PSC) functions.
   4  *
   5  * Copyright (C) 2007 Sergey Kubushyn <ksi@koi8.net>
   6  * Copyright (C) 2008 Lyrtech <www.lyrtech.com>
   7  * Copyright (C) 2004 Texas Instruments.
   8  */
   9
  10 #include <common.h>
  11 #include <asm/arch/hardware.h>
  12 #include <asm/io.h>
  13
  14 /*
  15  * The PSC manages three inputs to a "module" which may be a peripheral or
  16  * CPU.  Those inputs are the module's:  clock; reset signal; and sometimes
  17  * its power domain.  For our purposes, we only care whether clock and power
  18  * are active, and the module is out of reset.
  19  *
  20  * DaVinci chips may include two separate power domains: "Always On" and "DSP".
  21  * Chips without a DSP generally have only one domain.
  22  *
  23  * The "Always On" power domain is always on when the chip is on, and is
  24  * powered by the VDD pins (on DM644X). The majority of DaVinci modules
  25  * lie within the "Always On" power domain.
  26  *
  27  * A separate domain called the "DSP" domain houses the C64x+ and other video
  28  * hardware such as VICP. In some chips, the "DSP" domain is not always on.
  29  * The "DSP" power domain is powered by the CVDDDSP pins (on DM644X).
  30  */
  31
  32 /* Works on Always On power domain only (no PD argument) */
  33 static void lpsc_transition(unsigned int id, unsigned int state)
  34 {
  35         dv_reg_p mdstat, mdctl, ptstat, ptcmd;
  36         struct davinci_psc_regs *psc_regs;
  37
  38         if (id < DAVINCI_LPSC_PSC1_BASE) {
  39                 if (id >= PSC_PSC0_MODULE_ID_CNT)
  40                         return;
  41                 psc_regs = davinci_psc0_regs;
  42                 mdstat = &psc_regs->psc0.mdstat[id];
  43                 mdctl = &psc_regs->psc0.mdctl[id];
  44         } else {
  45                 id -= DAVINCI_LPSC_PSC1_BASE;
  46                 if (id >= PSC_PSC1_MODULE_ID_CNT)
  47                         return;
  48                 psc_regs = davinci_psc1_regs;
  49                 mdstat = &psc_regs->psc1.mdstat[id];
  50                 mdctl = &psc_regs->psc1.mdctl[id];
  51         }
  52         ptstat = &psc_regs->ptstat;
  53         ptcmd = &psc_regs->ptcmd;
  54
  55         while (readl(ptstat) & 0x01)
  56                 continue;
  57
  58         if ((readl(mdstat) & PSC_MDSTAT_STATE) == state)
  59                 return; /* Already in that state */
  60
  61         writel((readl(mdctl) & ~PSC_MDCTL_NEXT) | state, mdctl);
  62         writel(0x01, ptcmd);
  63
  64         while (readl(ptstat) & 0x01)
  65                 continue;
  66         while ((readl(mdstat) & PSC_MDSTAT_STATE) != state)
  67                 continue;
  68 }
  69
  70 void lpsc_on(unsigned int id)
  71 {
  72         lpsc_transition(id, 0x03);
  73 }
  74
  75 void lpsc_syncreset(unsigned int id)
  76 {
  77         lpsc_transition(id, 0x01);
  78 }
  79
  80 void lpsc_disable(unsigned int id)
  81 {
  82         lpsc_transition(id, 0x0);
  83 }