Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 1 | /* |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 2 | * (C) Copyright 2000-2009 |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 3 | * 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 Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 29 | #include <command.h> |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 30 | #include <asm/io.h> |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 31 | #include <asm/processor.h> |
| 32 | |
| 33 | DECLARE_GLOBAL_DATA_PTR; |
| 34 | |
| 35 | static 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 | |
| 42 | static 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 | |
| 53 | static 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 | |
| 63 | int get_clocks (void) |
| 64 | { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 65 | volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 66 | u8 spmf; |
| 67 | u8 cpmf; |
| 68 | u8 sys_div; |
| 69 | u8 ips_div; |
John Rigby | d1228c9 | 2008-02-26 09:38:14 -0700 | [diff] [blame] | 70 | u8 pci_div; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 71 | u32 ref_clk = CONFIG_SYS_MPC512X_CLKIN; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 72 | u32 spll; |
| 73 | u32 sys_clk; |
| 74 | u32 core_clk; |
| 75 | u32 csb_clk; |
| 76 | u32 ips_clk; |
John Rigby | d1228c9 | 2008-02-26 09:38:14 -0700 | [diff] [blame] | 77 | u32 pci_clk; |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 78 | u32 reg; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 79 | |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 80 | reg = in_be32(&im->sysconf.immrbar); |
| 81 | if ((reg & IMMRBAR_BASE_ADDR) != (u32) im) |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 82 | return -1; |
| 83 | |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 84 | reg = in_be32(&im->clk.spmr); |
| 85 | spmf = (reg & SPMR_SPMF) >> SPMR_SPMF_SHIFT; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 86 | spll = ref_clk * spmf_mult[spmf]; |
Wolfgang Denk | 530181f | 2007-08-02 21:27:46 +0200 | [diff] [blame] | 87 | |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 88 | reg = in_be32(&im->clk.scfr[1]); |
| 89 | sys_div = (reg & SCFR2_SYS_DIV) >> SCFR2_SYS_DIV_SHIFT; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 90 | sys_clk = (spll * sys_dividors[sys_div][1]) / sys_dividors[sys_div][0]; |
| 91 | |
| 92 | csb_clk = sys_clk / 2; |
| 93 | |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 94 | reg = in_be32(&im->clk.spmr); |
| 95 | cpmf = (reg & SPMR_CPMF) >> SPMR_CPMF_SHIFT; |
Wolfgang Denk | 530181f | 2007-08-02 21:27:46 +0200 | [diff] [blame] | 96 | core_clk = (csb_clk * cpmf_mult[cpmf][0]) / cpmf_mult[cpmf][1]; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 97 | |
Wolfgang Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 98 | reg = in_be32(&im->clk.scfr[0]); |
| 99 | ips_div = (reg & SCFR1_IPS_DIV_MASK) >> SCFR1_IPS_DIV_SHIFT; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 100 | 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 Denk | b853995 | 2009-05-16 10:47:43 +0200 | [diff] [blame] | 106 | |
| 107 | reg = in_be32(&im->clk.scfr[0]); |
| 108 | pci_div = (reg & SCFR1_PCI_DIV_MASK) >> SCFR1_PCI_DIV_SHIFT; |
John Rigby | d1228c9 | 2008-02-26 09:38:14 -0700 | [diff] [blame] | 109 | 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 Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 115 | |
Grzegorz Bernacki | 21305af | 2008-01-11 12:03:43 +0100 | [diff] [blame] | 116 | gd->ips_clk = ips_clk; |
John Rigby | d1228c9 | 2008-02-26 09:38:14 -0700 | [diff] [blame] | 117 | gd->pci_clk = pci_clk; |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 118 | 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 | *********************************************/ |
| 129 | ulong get_bus_freq (ulong dummy) |
| 130 | { |
| 131 | return gd->csb_clk; |
| 132 | } |
| 133 | |
Wolfgang Denk | 6262d021 | 2010-06-28 22:00:46 +0200 | [diff] [blame^] | 134 | int do_clocks (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 135 | { |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 136 | char buf[32]; |
| 137 | |
John Rigby | d1228c9 | 2008-02-26 09:38:14 -0700 | [diff] [blame] | 138 | printf("Clock configuration:\n"); |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 139 | 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 Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 144 | return 0; |
| 145 | } |
| 146 | |
| 147 | U_BOOT_CMD(clocks, 1, 0, do_clocks, |
Peter Tyser | dfb72b8 | 2009-01-27 18:03:12 -0600 | [diff] [blame] | 148 | "print clock configuration", |
Wolfgang Denk | c54781c | 2009-05-24 17:06:54 +0200 | [diff] [blame] | 149 | " clocks" |
Rafal Jaworowski | d3a02c3 | 2007-07-27 14:43:59 +0200 | [diff] [blame] | 150 | ); |
| 151 | |
| 152 | int prt_mpc512x_clks (void) |
| 153 | { |
| 154 | do_clocks (NULL, 0, 0, NULL); |
| 155 | return (0); |
| 156 | } |