blob: ce8d0949b2f4585a6637c7d429e972339ec106b5 [file] [log] [blame]
Rafal Jaworowski8993e542007-07-27 14:43:59 +02001/*
Wolfgang Denk843efb12009-05-16 10:47:43 +02002 * (C) Copyright 2000-2009
Rafal Jaworowski8993e542007-07-27 14:43:59 +02003 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
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>
Rafal Jaworowski8993e542007-07-27 14:43:59 +020029#include <command.h>
Wolfgang Denk843efb12009-05-16 10:47:43 +020030#include <asm/io.h>
Rafal Jaworowski8993e542007-07-27 14:43:59 +020031#include <asm/processor.h>
32
33DECLARE_GLOBAL_DATA_PTR;
34
35static int spmf_mult[] = {
36 68, 1, 12, 16,
37 20, 24, 28, 32,
38 36, 40, 44, 48,
39 52, 56, 60, 64
40};
41
42static int cpmf_mult[][2] = {
43 {0, 1}, {0, 1}, /* 0 and 1 are not valid */
44 {1, 1}, {3, 2},
45 {2, 1}, {5, 2},
46 {3, 1}, {7, 2},
47 {0, 1}, {0, 1}, /* and all above 7 are not valid too */
48 {0, 1}, {0, 1},
49 {0, 1}, {0, 1},
50 {0, 1}, {0, 1}
51};
52
53static int sys_dividors[][2] = {
54 {2, 1}, {5, 2}, {3, 1}, {7, 2}, {4, 1},
55 {9, 2}, {5, 1}, {7, 1}, {6, 1}, {8, 1},
56 {9, 1}, {11, 1}, {10, 1}, {12, 1}, {13, 1},
57 {15, 1}, {14, 1}, {16, 1}, {17, 1}, {19, 1},
58 {18, 1}, {20, 1}, {21, 1}, {23, 1}, {22, 1},
59 {24, 1}, {25, 1}, {27, 1}, {26, 1}, {28, 1},
60 {29, 1}, {31, 1}, {30, 1}, {32, 1}, {33, 1}
61};
62
63int get_clocks (void)
64{
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020065 volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
Rafal Jaworowski8993e542007-07-27 14:43:59 +020066 u8 spmf;
67 u8 cpmf;
68 u8 sys_div;
69 u8 ips_div;
John Rigby5f91db72008-02-26 09:38:14 -070070 u8 pci_div;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020071 u32 ref_clk = CONFIG_SYS_MPC512X_CLKIN;
Rafal Jaworowski8993e542007-07-27 14:43:59 +020072 u32 spll;
73 u32 sys_clk;
74 u32 core_clk;
75 u32 csb_clk;
76 u32 ips_clk;
John Rigby5f91db72008-02-26 09:38:14 -070077 u32 pci_clk;
Wolfgang Denk843efb12009-05-16 10:47:43 +020078 u32 reg;
Rafal Jaworowski8993e542007-07-27 14:43:59 +020079
Wolfgang Denk843efb12009-05-16 10:47:43 +020080 reg = in_be32(&im->sysconf.immrbar);
81 if ((reg & IMMRBAR_BASE_ADDR) != (u32) im)
Rafal Jaworowski8993e542007-07-27 14:43:59 +020082 return -1;
83
Wolfgang Denk843efb12009-05-16 10:47:43 +020084 reg = in_be32(&im->clk.spmr);
85 spmf = (reg & SPMR_SPMF) >> SPMR_SPMF_SHIFT;
Rafal Jaworowski8993e542007-07-27 14:43:59 +020086 spll = ref_clk * spmf_mult[spmf];
Wolfgang Denkb1b54e32007-08-02 21:27:46 +020087
Wolfgang Denk843efb12009-05-16 10:47:43 +020088 reg = in_be32(&im->clk.scfr[1]);
89 sys_div = (reg & SCFR2_SYS_DIV) >> SCFR2_SYS_DIV_SHIFT;
Rafal Jaworowski8993e542007-07-27 14:43:59 +020090 sys_clk = (spll * sys_dividors[sys_div][1]) / sys_dividors[sys_div][0];
91
92 csb_clk = sys_clk / 2;
93
Wolfgang Denk843efb12009-05-16 10:47:43 +020094 reg = in_be32(&im->clk.spmr);
95 cpmf = (reg & SPMR_CPMF) >> SPMR_CPMF_SHIFT;
Wolfgang Denkb1b54e32007-08-02 21:27:46 +020096 core_clk = (csb_clk * cpmf_mult[cpmf][0]) / cpmf_mult[cpmf][1];
Rafal Jaworowski8993e542007-07-27 14:43:59 +020097
Wolfgang Denk843efb12009-05-16 10:47:43 +020098 reg = in_be32(&im->clk.scfr[0]);
99 ips_div = (reg & SCFR1_IPS_DIV_MASK) >> SCFR1_IPS_DIV_SHIFT;
Rafal Jaworowski8993e542007-07-27 14:43:59 +0200100 if (ips_div != 0) {
101 ips_clk = csb_clk / ips_div;
102 } else {
103 /* in case we cannot get a sane IPS divisor, fail gracefully */
104 ips_clk = 0;
105 }
Wolfgang Denk843efb12009-05-16 10:47:43 +0200106
107 reg = in_be32(&im->clk.scfr[0]);
108 pci_div = (reg & SCFR1_PCI_DIV_MASK) >> SCFR1_PCI_DIV_SHIFT;
John Rigby5f91db72008-02-26 09:38:14 -0700109 if (pci_div != 0) {
110 pci_clk = csb_clk / pci_div;
111 } else {
112 /* in case we cannot get a sane IPS divisor, fail gracefully */
113 pci_clk = 333333;
114 }
Rafal Jaworowski8993e542007-07-27 14:43:59 +0200115
Grzegorz Bernacki5d49e0e2008-01-11 12:03:43 +0100116 gd->ips_clk = ips_clk;
John Rigby5f91db72008-02-26 09:38:14 -0700117 gd->pci_clk = pci_clk;
Rafal Jaworowski8993e542007-07-27 14:43:59 +0200118 gd->csb_clk = csb_clk;
119 gd->cpu_clk = core_clk;
120 gd->bus_clk = csb_clk;
121 return 0;
122
123}
124
125/********************************************
126 * get_bus_freq
127 * return system bus freq in Hz
128 *********************************************/
129ulong get_bus_freq (ulong dummy)
130{
131 return gd->csb_clk;
132}
133
134int do_clocks (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
135{
Wolfgang Denk08ef89e2008-10-19 02:35:49 +0200136 char buf[32];
137
John Rigby5f91db72008-02-26 09:38:14 -0700138 printf("Clock configuration:\n");
Wolfgang Denk08ef89e2008-10-19 02:35:49 +0200139 printf(" CPU: %-4s MHz\n", strmhz(buf, gd->cpu_clk));
140 printf(" Coherent System Bus: %-4s MHz\n", strmhz(buf, gd->csb_clk));
141 printf(" IPS Bus: %-4s MHz\n", strmhz(buf, gd->ips_clk));
142 printf(" PCI: %-4s MHz\n", strmhz(buf, gd->pci_clk));
143 printf(" DDR: %-4s MHz\n", strmhz(buf, 2*gd->csb_clk));
Rafal Jaworowski8993e542007-07-27 14:43:59 +0200144 return 0;
145}
146
147U_BOOT_CMD(clocks, 1, 0, do_clocks,
Peter Tyser2fb26042009-01-27 18:03:12 -0600148 "print clock configuration",
Wolfgang Denka89c33d2009-05-24 17:06:54 +0200149 " clocks"
Rafal Jaworowski8993e542007-07-27 14:43:59 +0200150);
151
152int prt_mpc512x_clks (void)
153{
154 do_clocks (NULL, 0, 0, NULL);
155 return (0);
156}