cpu_init.c 7.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249
  1. /*
  2. * (C) Copyright 2000-2010
  3. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  4. *
  5. * See file CREDITS for list of people who contributed to this
  6. * project.
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License as
  10. * published by the Free Software Foundation; either version 2 of
  11. * the License, or (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21. * MA 02111-1307 USA
  22. */
  23. #include <common.h>
  24. #include <mpc5xxx.h>
  25. #include <asm/io.h>
  26. #include <watchdog.h>
  27. DECLARE_GLOBAL_DATA_PTR;
  28. /*
  29. * Breath some life into the CPU...
  30. *
  31. * Set up the memory map,
  32. * initialize a bunch of registers.
  33. */
  34. void cpu_init_f (void)
  35. {
  36. volatile struct mpc5xxx_mmap_ctl *mm =
  37. (struct mpc5xxx_mmap_ctl *) CONFIG_SYS_MBAR;
  38. volatile struct mpc5xxx_lpb *lpb =
  39. (struct mpc5xxx_lpb *) MPC5XXX_LPB;
  40. volatile struct mpc5xxx_cdm *cdm =
  41. (struct mpc5xxx_cdm *) MPC5XXX_CDM;
  42. volatile struct mpc5xxx_gpio *gpio =
  43. (struct mpc5xxx_gpio *) MPC5XXX_GPIO;
  44. volatile struct mpc5xxx_xlb *xlb =
  45. (struct mpc5xxx_xlb *) MPC5XXX_XLBARB;
  46. volatile struct mpc5xxx_gpt *gpt0 =
  47. (struct mpc5xxx_gpt *) MPC5XXX_GPT;
  48. unsigned long addecr = (1 << 25); /* Boot_CS */
  49. #if defined(CONFIG_SYS_RAMBOOT) && defined(CONFIG_MGT5100)
  50. addecr |= (1 << 22); /* SDRAM enable */
  51. #endif
  52. /* Pointer is writable since we allocated a register for it */
  53. gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
  54. /* Clear initial global data */
  55. memset ((void *) gd, 0, sizeof (gd_t));
  56. /*
  57. * Memory Controller: configure chip selects and enable them
  58. */
  59. #if defined(CONFIG_SYS_BOOTCS_START) && defined(CONFIG_SYS_BOOTCS_SIZE)
  60. out_be32(&mm->boot_start, START_REG(CONFIG_SYS_BOOTCS_START));
  61. out_be32(&mm->boot_stop, STOP_REG(CONFIG_SYS_BOOTCS_START,
  62. CONFIG_SYS_BOOTCS_SIZE));
  63. #endif
  64. #if defined(CONFIG_SYS_BOOTCS_CFG)
  65. out_be32(&lpb->cs0_cfg, CONFIG_SYS_BOOTCS_CFG);
  66. #endif
  67. #if defined(CONFIG_SYS_CS0_START) && defined(CONFIG_SYS_CS0_SIZE)
  68. out_be32(&mm->cs0_start, START_REG(CONFIG_SYS_CS0_START));
  69. out_be32(&mm->cs0_stop, STOP_REG(CONFIG_SYS_CS0_START,
  70. CONFIG_SYS_CS0_SIZE));
  71. /* CS0 and BOOT_CS cannot be enabled at once. */
  72. /* addecr |= (1 << 16); */
  73. #endif
  74. #if defined(CONFIG_SYS_CS0_CFG)
  75. out_be32(&lpb->cs0_cfg, CONFIG_SYS_CS0_CFG);
  76. #endif
  77. #if defined(CONFIG_SYS_CS1_START) && defined(CONFIG_SYS_CS1_SIZE)
  78. out_be32(&mm->cs1_start, START_REG(CONFIG_SYS_CS1_START));
  79. out_be32(&mm->cs1_stop, STOP_REG(CONFIG_SYS_CS1_START,
  80. CONFIG_SYS_CS1_SIZE));
  81. addecr |= (1 << 17);
  82. #endif
  83. #if defined(CONFIG_SYS_CS1_CFG)
  84. out_be32(&lpb->cs1_cfg, CONFIG_SYS_CS1_CFG);
  85. #endif
  86. #if defined(CONFIG_SYS_CS2_START) && defined(CONFIG_SYS_CS2_SIZE)
  87. out_be32(&mm->cs2_start, START_REG(CONFIG_SYS_CS2_START));
  88. out_be32(&mm->cs2_stop, STOP_REG(CONFIG_SYS_CS2_START,
  89. CONFIG_SYS_CS2_SIZE));
  90. addecr |= (1 << 18);
  91. #endif
  92. #if defined(CONFIG_SYS_CS2_CFG)
  93. out_be32(&lpb->cs2_cfg, CONFIG_SYS_CS2_CFG);
  94. #endif
  95. #if defined(CONFIG_SYS_CS3_START) && defined(CONFIG_SYS_CS3_SIZE)
  96. out_be32(&mm->cs3_start, START_REG(CONFIG_SYS_CS3_START));
  97. out_be32(&mm->cs3_stop, STOP_REG(CONFIG_SYS_CS3_START,
  98. CONFIG_SYS_CS3_SIZE));
  99. addecr |= (1 << 19);
  100. #endif
  101. #if defined(CONFIG_SYS_CS3_CFG)
  102. out_be32(&lpb->cs3_cfg, CONFIG_SYS_CS3_CFG);
  103. #endif
  104. #if defined(CONFIG_SYS_CS4_START) && defined(CONFIG_SYS_CS4_SIZE)
  105. out_be32(&mm->cs4_start, START_REG(CONFIG_SYS_CS4_START));
  106. out_be32(&mm->cs4_stop, STOP_REG(CONFIG_SYS_CS4_START,
  107. CONFIG_SYS_CS4_SIZE));
  108. addecr |= (1 << 20);
  109. #endif
  110. #if defined(CONFIG_SYS_CS4_CFG)
  111. out_be32(&lpb->cs4_cfg, CONFIG_SYS_CS4_CFG);
  112. #endif
  113. #if defined(CONFIG_SYS_CS5_START) && defined(CONFIG_SYS_CS5_SIZE)
  114. out_be32(&mm->cs5_start, START_REG(CONFIG_SYS_CS5_START));
  115. out_be32(&mm->cs5_stop, STOP_REG(CONFIG_SYS_CS5_START,
  116. CONFIG_SYS_CS5_SIZE));
  117. addecr |= (1 << 21);
  118. #endif
  119. #if defined(CONFIG_SYS_CS5_CFG)
  120. out_be32(&lpb->cs5_cfg, CONFIG_SYS_CS5_CFG);
  121. #endif
  122. #if defined(CONFIG_MPC5200)
  123. addecr |= 1;
  124. #if defined(CONFIG_SYS_CS6_START) && defined(CONFIG_SYS_CS6_SIZE)
  125. out_be32(&mm->cs6_start, START_REG(CONFIG_SYS_CS6_START));
  126. out_be32(&mm->cs6_stop, STOP_REG(CONFIG_SYS_CS6_START,
  127. CONFIG_SYS_CS6_SIZE));
  128. addecr |= (1 << 26);
  129. #endif
  130. #if defined(CONFIG_SYS_CS6_CFG)
  131. out_be32(&lpb->cs6_cfg, CONFIG_SYS_CS6_CFG);
  132. #endif
  133. #if defined(CONFIG_SYS_CS7_START) && defined(CONFIG_SYS_CS7_SIZE)
  134. out_be32(&mm->cs7_start, START_REG(CONFIG_SYS_CS7_START));
  135. out_be32(&mm->cs7_stop, STOP_REG(CONFIG_SYS_CS7_START,
  136. CONFIG_SYS_CS7_SIZE));
  137. addecr |= (1 << 27);
  138. #endif
  139. #if defined(CONFIG_SYS_CS7_CFG)
  140. out_be32(&lpb->cs7_cfg, CONFIG_SYS_CS7_CFG);
  141. #endif
  142. #if defined(CONFIG_SYS_CS_BURST)
  143. out_be32(&lpb->cs_burst, CONFIG_SYS_CS_BURST);
  144. #endif
  145. #if defined(CONFIG_SYS_CS_DEADCYCLE)
  146. out_be32(&lpb->cs_deadcycle, CONFIG_SYS_CS_DEADCYCLE);
  147. #endif
  148. #endif /* CONFIG_MPC5200 */
  149. /* Enable chip selects */
  150. #if defined(CONFIG_MGT5100)
  151. out_be32(&mm->addecr, addecr);
  152. #elif defined(CONFIG_MPC5200)
  153. out_be32(&mm->ipbi_ws_ctrl, addecr);
  154. #endif
  155. out_be32(&lpb->cs_ctrl, (1 << 24));
  156. /* Setup pin multiplexing */
  157. #if defined(CONFIG_SYS_GPS_PORT_CONFIG)
  158. out_be32(&gpio->port_config, CONFIG_SYS_GPS_PORT_CONFIG);
  159. #endif
  160. #if defined(CONFIG_MPC5200)
  161. /* enable timebase */
  162. setbits_be32(&xlb->config, (1 << 13));
  163. /* Enable snooping for RAM */
  164. setbits_be32(&xlb->config, (1 << 15));
  165. out_be32(&xlb->snoop_window, CONFIG_SYS_SDRAM_BASE | 0x1d);
  166. # if defined(CONFIG_SYS_IPBCLK_EQUALS_XLBCLK)
  167. /* Motorola reports IPB should better run at 133 MHz. */
  168. #if defined(CONFIG_MGT5100)
  169. setbits_be32(&mm->addecr, 1);
  170. #elif defined(CONFIG_MPC5200)
  171. setbits_be32(&mm->ipbi_ws_ctrl, 1);
  172. #endif
  173. /* pci_clk_sel = 0x02, ipb_clk_sel = 0x00; */
  174. addecr = in_be32(&cdm->cfg);
  175. addecr &= ~0x103;
  176. # if defined(CONFIG_SYS_PCICLK_EQUALS_IPBCLK_DIV2)
  177. /* pci_clk_sel = 0x01 -> IPB_CLK/2 */
  178. addecr |= 0x01;
  179. # else
  180. /* pci_clk_sel = 0x02 -> XLB_CLK/4 = IPB_CLK/4 */
  181. addecr |= 0x02;
  182. # endif /* CONFIG_SYS_PCICLK_EQUALS_IPBCLK_DIV2 */
  183. out_be32(&cdm->cfg, addecr);
  184. # endif /* CONFIG_SYS_IPBCLK_EQUALS_XLBCLK */
  185. /* Configure the XLB Arbiter */
  186. out_be32(&xlb->master_pri_enable, 0xff);
  187. out_be32(&xlb->master_priority, 0x11111111);
  188. # if defined(CONFIG_SYS_XLB_PIPELINING)
  189. /* Enable piplining */
  190. clrbits_be32(&xlb->config, (1 << 31));
  191. # endif
  192. #if defined(CONFIG_WATCHDOG)
  193. /* Charge the watchdog timer - prescaler = 64k, count = 64k*/
  194. out_be32(&gpt0->cir, 0x0000ffff);
  195. out_be32(&gpt0->emsr, 0x9004); /* wden|ce|timer_ms */
  196. reset_5xxx_watchdog();
  197. #endif /* CONFIG_WATCHDOG */
  198. #endif /* CONFIG_MPC5200 */
  199. }
  200. /*
  201. * initialize higher level parts of CPU like time base and timers
  202. */
  203. int cpu_init_r (void)
  204. {
  205. volatile struct mpc5xxx_intr *intr =
  206. (struct mpc5xxx_intr *) MPC5XXX_ICTL;
  207. /* mask all interrupts */
  208. #if defined(CONFIG_MGT5100)
  209. out_be32(&intr->per_mask, 0xfffffc00);
  210. #elif defined(CONFIG_MPC5200)
  211. out_be32(&intr->per_mask, 0xffffff00);
  212. #endif
  213. setbits_be32(&intr->main_mask, 0x0001ffff);
  214. clrbits_be32(&intr->ctrl, 0x00000f00);
  215. /* route critical ints to normal ints */
  216. setbits_be32(&intr->ctrl, 0x00000001);
  217. #if defined(CONFIG_CMD_NET) && defined(CONFIG_MPC5xxx_FEC)
  218. /* load FEC microcode */
  219. loadtask(0, 2);
  220. #endif
  221. return (0);
  222. }