cpu/mpc512x/speed.c

   1 /*
   2  * (C) Copyright 2000-2009
   3  * Wolfgang Denk, DENX Software Engineering, [email protected].
   4  *
   5  * Copyright (C) 2004-2006 Freescale Semiconductor, Inc.
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License as
  12  * published by the Free Software Foundation; either version 2 of
  13  * the License, or (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23  * MA 02111-1307 USA
  24  *
  25  * Based on the MPC83xx code.
  26  */
  27
  28 #include <common.h>
  29 #include <mpc512x.h>
  30 #include <command.h>
  31 #include <asm/io.h>
  32 #include <asm/processor.h>
  33
  34 DECLARE_GLOBAL_DATA_PTR;
  35
  36 static int spmf_mult[] = {
  37         68, 1, 12, 16,
  38         20, 24, 28, 32,
  39         36, 40, 44, 48,
  40         52, 56, 60, 64
  41 };
  42
  43 static int cpmf_mult[][2] = {
  44         {0, 1}, {0, 1}, /* 0 and 1 are not valid */
  45         {1, 1}, {3, 2},
  46         {2, 1}, {5, 2},
  47         {3, 1}, {7, 2},
  48         {0, 1}, {0, 1}, /* and all above 7 are not valid too */
  49         {0, 1}, {0, 1},
  50         {0, 1}, {0, 1},
  51         {0, 1}, {0, 1}
  52 };
  53
  54 static int sys_dividors[][2] = {
  55         {2, 1}, {5, 2}, {3, 1}, {7, 2}, {4, 1},
  56         {9, 2}, {5, 1}, {7, 1}, {6, 1}, {8, 1},
  57         {9, 1}, {11, 1}, {10, 1}, {12, 1}, {13, 1},
  58         {15, 1}, {14, 1}, {16, 1}, {17, 1}, {19, 1},
  59         {18, 1}, {20, 1}, {21, 1}, {23, 1}, {22, 1},
  60         {24, 1}, {25, 1}, {27, 1}, {26, 1}, {28, 1},
  61         {29, 1}, {31, 1}, {30, 1}, {32, 1}, {33, 1}
  62 };
  63
  64 int get_clocks (void)
  65 {
  66         volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
  67         u8 spmf;
  68         u8 cpmf;
  69         u8 sys_div;
  70         u8 ips_div;
  71         u8 pci_div;
  72         u32 ref_clk = CONFIG_SYS_MPC512X_CLKIN;
  73         u32 spll;
  74         u32 sys_clk;
  75         u32 core_clk;
  76         u32 csb_clk;
  77         u32 ips_clk;
  78         u32 pci_clk;
  79         u32 reg;
  80
  81         reg = in_be32(&im->sysconf.immrbar);
  82         if ((reg & IMMRBAR_BASE_ADDR) != (u32) im)
  83                 return -1;
  84
  85         reg = in_be32(&im->clk.spmr);
  86         spmf = (reg & SPMR_SPMF) >> SPMR_SPMF_SHIFT;
  87         spll = ref_clk * spmf_mult[spmf];
  88
  89         reg = in_be32(&im->clk.scfr[1]);
  90         sys_div = (reg & SCFR2_SYS_DIV) >> SCFR2_SYS_DIV_SHIFT;
  91         sys_clk = (spll * sys_dividors[sys_div][1]) / sys_dividors[sys_div][0];
  92
  93         csb_clk = sys_clk / 2;
  94
  95         reg = in_be32(&im->clk.spmr);
  96         cpmf = (reg & SPMR_CPMF) >> SPMR_CPMF_SHIFT;
  97         core_clk = (csb_clk * cpmf_mult[cpmf][0]) / cpmf_mult[cpmf][1];
  98
  99         reg = in_be32(&im->clk.scfr[0]);
 100         ips_div = (reg & SCFR1_IPS_DIV_MASK) >> SCFR1_IPS_DIV_SHIFT;
 101         if (ips_div != 0) {
 102                 ips_clk = csb_clk / ips_div;
 103         } else {
 104                 /* in case we cannot get a sane IPS divisor, fail gracefully */
 105                 ips_clk = 0;
 106         }
 107
 108         reg = in_be32(&im->clk.scfr[0]);
 109         pci_div = (reg & SCFR1_PCI_DIV_MASK) >> SCFR1_PCI_DIV_SHIFT;
 110         if (pci_div != 0) {
 111                 pci_clk = csb_clk / pci_div;
 112         } else {
 113                 /* in case we cannot get a sane IPS divisor, fail gracefully */
 114                 pci_clk = 333333;
 115         }
 116
 117         gd->ips_clk = ips_clk;
 118         gd->pci_clk = pci_clk;
 119         gd->csb_clk = csb_clk;
 120         gd->cpu_clk = core_clk;
 121         gd->bus_clk = csb_clk;
 122         return 0;
 123
 124 }
 125
 126 /********************************************
 127  * get_bus_freq
 128  * return system bus freq in Hz
 129  *********************************************/
 130 ulong get_bus_freq (ulong dummy)
 131 {
 132         return gd->csb_clk;
 133 }
 134
 135 int do_clocks (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 136 {
 137         char buf[32];
 138
 139         printf("Clock configuration:\n");
 140         printf("  CPU:                 %-4s MHz\n", strmhz(buf, gd->cpu_clk));
 141         printf("  Coherent System Bus: %-4s MHz\n", strmhz(buf, gd->csb_clk));
 142         printf("  IPS Bus:             %-4s MHz\n", strmhz(buf, gd->ips_clk));
 143         printf("  PCI:                 %-4s MHz\n", strmhz(buf, gd->pci_clk));
 144         printf("  DDR:                 %-4s MHz\n", strmhz(buf, 2*gd->csb_clk));
 145         return 0;
 146 }
 147
 148 U_BOOT_CMD(clocks, 1, 0, do_clocks,
 149         "print clock configuration",
 150         "    clocks"
 151 );
 152
 153 int prt_mpc512x_clks (void)
 154 {
 155         do_clocks (NULL, 0, 0, NULL);
 156         return (0);
 157 }