root/arch/powerpc/boot/pq2.c

DEFINITIONS

1. pq2_get_clocks
2. pq2_set_clocks
3. pq2_fixup_clocks

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * PowerQUICC II support functions
   4  *
   5  * Author: Scott Wood <scottwood@freescale.com>
   6  *
   7  * Copyright (c) 2007 Freescale Semiconductor, Inc.
   8  */
   9 
  10 #include "ops.h"
  11 #include "types.h"
  12 #include "fsl-soc.h"
  13 #include "pq2.h"
  14 #include "stdio.h"
  15 #include "io.h"
  16 
  17 #define PQ2_SCCR (0x10c80/4) /* System Clock Configuration Register */
  18 #define PQ2_SCMR (0x10c88/4) /* System Clock Mode Register */
  19 
  20 static int pq2_corecnf_map[] = {
  21         3, 2, 2, 2, 4, 4, 5, 9, 6, 11, 8, 10, 3, 12, 7, -1,
  22         6, 5, 13, 2, 14, 4, 15, 9, 0, 11, 8, 10, 16, 12, 7, -1
  23 };
  24 
  25 /* Get various clocks from crystal frequency.
  26  * Returns zero on failure and non-zero on success.
  27  */
  28 int pq2_get_clocks(u32 crystal, u32 *sysfreq, u32 *corefreq,
  29                    u32 *timebase, u32 *brgfreq)
  30 {
  31         u32 *immr;
  32         u32 sccr, scmr, mainclk, busclk;
  33         int corecnf, busdf, plldf, pllmf, dfbrg;
  34 
  35         immr = fsl_get_immr();
  36         if (!immr) {
  37                 printf("pq2_get_clocks: Couldn't get IMMR base.\r\n");
  38                 return 0;
  39         }
  40 
  41         sccr = in_be32(&immr[PQ2_SCCR]);
  42         scmr = in_be32(&immr[PQ2_SCMR]);
  43 
  44         dfbrg = sccr & 3;
  45         corecnf = (scmr >> 24) & 0x1f;
  46         busdf = (scmr >> 20) & 0xf;
  47         plldf = (scmr >> 12) & 1;
  48         pllmf = scmr & 0xfff;
  49 
  50         mainclk = crystal * (pllmf + 1) / (plldf + 1);
  51         busclk = mainclk / (busdf + 1);
  52 
  53         if (sysfreq)
  54                 *sysfreq = mainclk / 2;
  55         if (timebase)
  56                 *timebase = busclk / 4;
  57         if (brgfreq)
  58                 *brgfreq = mainclk / (1 << ((dfbrg + 1) * 2));
  59 
  60         if (corefreq) {
  61                 int coremult = pq2_corecnf_map[corecnf];
  62 
  63                 if (coremult < 0)
  64                         *corefreq = mainclk / 2;
  65                 else if (coremult == 0)
  66                         return 0;
  67                 else
  68                         *corefreq = busclk * coremult / 2;
  69         }
  70 
  71         return 1;
  72 }
  73 
  74 /* Set common device tree fields based on the given clock frequencies. */
  75 void pq2_set_clocks(u32 sysfreq, u32 corefreq, u32 timebase, u32 brgfreq)
  76 {
  77         void *node;
  78 
  79         dt_fixup_cpu_clocks(corefreq, timebase, sysfreq);
  80 
  81         node = finddevice("/soc/cpm");
  82         if (node)
  83                 setprop(node, "clock-frequency", &sysfreq, 4);
  84 
  85         node = finddevice("/soc/cpm/brg");
  86         if (node)
  87                 setprop(node, "clock-frequency", &brgfreq, 4);
  88 }
  89 
  90 int pq2_fixup_clocks(u32 crystal)
  91 {
  92         u32 sysfreq, corefreq, timebase, brgfreq;
  93 
  94         if (!pq2_get_clocks(crystal, &sysfreq, &corefreq, &timebase, &brgfreq))
  95                 return 0;
  96 
  97         pq2_set_clocks(sysfreq, corefreq, timebase, brgfreq);
  98         return 1;
  99 }