tqm5200.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751
  1. /*
  2. * (C) Copyright 2003-2006
  3. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  4. *
  5. * (C) Copyright 2004
  6. * Mark Jonas, Freescale Semiconductor, mark.jonas@motorola.com.
  7. *
  8. * (C) Copyright 2004-2006
  9. * Martin Krause, TQ-Systems GmbH, martin.krause@tqs.de
  10. *
  11. * See file CREDITS for list of people who contributed to this
  12. * project.
  13. *
  14. * This program is free software; you can redistribute it and/or
  15. * modify it under the terms of the GNU General Public License as
  16. * published by the Free Software Foundation; either version 2 of
  17. * the License, or (at your option) any later version.
  18. *
  19. * This program is distributed in the hope that it will be useful,
  20. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  22. * GNU General Public License for more details.
  23. *
  24. * You should have received a copy of the GNU General Public License
  25. * along with this program; if not, write to the Free Software
  26. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  27. * MA 02111-1307 USA
  28. */
  29. #include <common.h>
  30. #include <mpc5xxx.h>
  31. #include <pci.h>
  32. #include <asm/processor.h>
  33. #include <libfdt.h>
  34. #ifdef CONFIG_VIDEO_SM501
  35. #include <sm501.h>
  36. #endif
  37. #if defined(CONFIG_MPC5200_DDR)
  38. #include "mt46v16m16-75.h"
  39. #else
  40. #include "mt48lc16m16a2-75.h"
  41. #endif
  42. #ifdef CONFIG_OF_LIBFDT
  43. #include <fdt_support.h>
  44. #endif /* CONFIG_OF_LIBFDT */
  45. DECLARE_GLOBAL_DATA_PTR;
  46. #ifdef CONFIG_PS2MULT
  47. void ps2mult_early_init(void);
  48. #endif
  49. #ifndef CFG_RAMBOOT
  50. static void sdram_start (int hi_addr)
  51. {
  52. long hi_addr_bit = hi_addr ? 0x01000000 : 0;
  53. /* unlock mode register */
  54. *(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000000 |
  55. hi_addr_bit;
  56. __asm__ volatile ("sync");
  57. /* precharge all banks */
  58. *(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000002 |
  59. hi_addr_bit;
  60. __asm__ volatile ("sync");
  61. #if SDRAM_DDR
  62. /* set mode register: extended mode */
  63. *(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_EMODE;
  64. __asm__ volatile ("sync");
  65. /* set mode register: reset DLL */
  66. *(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_MODE | 0x04000000;
  67. __asm__ volatile ("sync");
  68. #endif
  69. /* precharge all banks */
  70. *(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000002 |
  71. hi_addr_bit;
  72. __asm__ volatile ("sync");
  73. /* auto refresh */
  74. *(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000004 |
  75. hi_addr_bit;
  76. __asm__ volatile ("sync");
  77. /* set mode register */
  78. *(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_MODE;
  79. __asm__ volatile ("sync");
  80. /* normal operation */
  81. *(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | hi_addr_bit;
  82. __asm__ volatile ("sync");
  83. }
  84. #endif
  85. /*
  86. * ATTENTION: Although partially referenced initdram does NOT make real use
  87. * use of CFG_SDRAM_BASE. The code does not work if CFG_SDRAM_BASE
  88. * is something else than 0x00000000.
  89. */
  90. long int initdram (int board_type)
  91. {
  92. ulong dramsize = 0;
  93. ulong dramsize2 = 0;
  94. uint svr, pvr;
  95. #ifndef CFG_RAMBOOT
  96. ulong test1, test2;
  97. /* setup SDRAM chip selects */
  98. *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x0000001c; /* 512MB at 0x0 */
  99. *(vu_long *)MPC5XXX_SDRAM_CS1CFG = 0x40000000; /* disabled */
  100. __asm__ volatile ("sync");
  101. /* setup config registers */
  102. *(vu_long *)MPC5XXX_SDRAM_CONFIG1 = SDRAM_CONFIG1;
  103. *(vu_long *)MPC5XXX_SDRAM_CONFIG2 = SDRAM_CONFIG2;
  104. __asm__ volatile ("sync");
  105. #if SDRAM_DDR
  106. /* set tap delay */
  107. *(vu_long *)MPC5XXX_CDM_PORCFG = SDRAM_TAPDELAY;
  108. __asm__ volatile ("sync");
  109. #endif
  110. /* find RAM size using SDRAM CS0 only */
  111. sdram_start(0);
  112. test1 = get_ram_size((long *)CFG_SDRAM_BASE, 0x20000000);
  113. sdram_start(1);
  114. test2 = get_ram_size((long *)CFG_SDRAM_BASE, 0x20000000);
  115. if (test1 > test2) {
  116. sdram_start(0);
  117. dramsize = test1;
  118. } else {
  119. dramsize = test2;
  120. }
  121. /* memory smaller than 1MB is impossible */
  122. if (dramsize < (1 << 20)) {
  123. dramsize = 0;
  124. }
  125. /* set SDRAM CS0 size according to the amount of RAM found */
  126. if (dramsize > 0) {
  127. *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x13 +
  128. __builtin_ffs(dramsize >> 20) - 1;
  129. } else {
  130. *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0; /* disabled */
  131. }
  132. /* let SDRAM CS1 start right after CS0 */
  133. *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize + 0x0000001c; /* 512MB */
  134. /* find RAM size using SDRAM CS1 only */
  135. if (!dramsize)
  136. sdram_start(0);
  137. test2 = test1 = get_ram_size((long *)(CFG_SDRAM_BASE + dramsize), 0x20000000);
  138. if (!dramsize) {
  139. sdram_start(1);
  140. test2 = get_ram_size((long *)(CFG_SDRAM_BASE + dramsize), 0x20000000);
  141. }
  142. if (test1 > test2) {
  143. sdram_start(0);
  144. dramsize2 = test1;
  145. } else {
  146. dramsize2 = test2;
  147. }
  148. /* memory smaller than 1MB is impossible */
  149. if (dramsize2 < (1 << 20)) {
  150. dramsize2 = 0;
  151. }
  152. /* set SDRAM CS1 size according to the amount of RAM found */
  153. if (dramsize2 > 0) {
  154. *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize
  155. | (0x13 + __builtin_ffs(dramsize2 >> 20) - 1);
  156. } else {
  157. *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize; /* disabled */
  158. }
  159. #else /* CFG_RAMBOOT */
  160. /* retrieve size of memory connected to SDRAM CS0 */
  161. dramsize = *(vu_long *)MPC5XXX_SDRAM_CS0CFG & 0xFF;
  162. if (dramsize >= 0x13) {
  163. dramsize = (1 << (dramsize - 0x13)) << 20;
  164. } else {
  165. dramsize = 0;
  166. }
  167. /* retrieve size of memory connected to SDRAM CS1 */
  168. dramsize2 = *(vu_long *)MPC5XXX_SDRAM_CS1CFG & 0xFF;
  169. if (dramsize2 >= 0x13) {
  170. dramsize2 = (1 << (dramsize2 - 0x13)) << 20;
  171. } else {
  172. dramsize2 = 0;
  173. }
  174. #endif /* CFG_RAMBOOT */
  175. /*
  176. * On MPC5200B we need to set the special configuration delay in the
  177. * DDR controller. Please refer to Freescale's AN3221 "MPC5200B SDRAM
  178. * Initialization and Configuration", 3.3.1 SDelay--MBAR + 0x0190:
  179. *
  180. * "The SDelay should be written to a value of 0x00000004. It is
  181. * required to account for changes caused by normal wafer processing
  182. * parameters."
  183. */
  184. svr = get_svr();
  185. pvr = get_pvr();
  186. if ((SVR_MJREV(svr) >= 2) &&
  187. (PVR_MAJ(pvr) == 1) && (PVR_MIN(pvr) == 4)) {
  188. *(vu_long *)MPC5XXX_SDRAM_SDELAY = 0x04;
  189. __asm__ volatile ("sync");
  190. }
  191. #if defined(CONFIG_TQM5200_B)
  192. return dramsize + dramsize2;
  193. #else
  194. return dramsize;
  195. #endif /* CONFIG_TQM5200_B */
  196. }
  197. int checkboard (void)
  198. {
  199. #if defined(CONFIG_AEVFIFO)
  200. puts ("Board: AEVFIFO\n");
  201. return 0;
  202. #endif
  203. #if defined(CONFIG_TQM5200S)
  204. # define MODULE_NAME "TQM5200S"
  205. #else
  206. # define MODULE_NAME "TQM5200"
  207. #endif
  208. #if defined(CONFIG_STK52XX)
  209. # define CARRIER_NAME "STK52xx"
  210. #elif defined(CONFIG_TB5200)
  211. # define CARRIER_NAME "TB5200"
  212. #elif defined(CONFIG_CAM5200)
  213. # define CARRIER_NAME "CAM5200"
  214. #elif defined(CONFIG_FO300)
  215. # define CARRIER_NAME "FO300"
  216. #else
  217. # error "UNKNOWN"
  218. #endif
  219. puts ( "Board: " MODULE_NAME " (TQ-Components GmbH)\n"
  220. " on a " CARRIER_NAME " carrier board\n");
  221. return 0;
  222. }
  223. #undef MODULE_NAME
  224. #undef CARRIER_NAME
  225. void flash_preinit(void)
  226. {
  227. /*
  228. * Now, when we are in RAM, enable flash write
  229. * access for detection process.
  230. * Note that CS_BOOT cannot be cleared when
  231. * executing in flash.
  232. */
  233. *(vu_long *)MPC5XXX_BOOTCS_CFG &= ~0x1; /* clear RO */
  234. }
  235. #ifdef CONFIG_PCI
  236. static struct pci_controller hose;
  237. extern void pci_mpc5xxx_init(struct pci_controller *);
  238. void pci_init_board(void)
  239. {
  240. pci_mpc5xxx_init(&hose);
  241. }
  242. #endif
  243. #if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_RESET)
  244. #if defined (CONFIG_MINIFAP)
  245. #define SM501_POWER_MODE0_GATE 0x00000040UL
  246. #define SM501_POWER_MODE1_GATE 0x00000048UL
  247. #define POWER_MODE_GATE_GPIO_PWM_I2C 0x00000040UL
  248. #define SM501_GPIO_DATA_DIR_HIGH 0x0001000CUL
  249. #define SM501_GPIO_DATA_HIGH 0x00010004UL
  250. #define SM501_GPIO_51 0x00080000UL
  251. #endif /* CONFIG MINIFAP */
  252. void init_ide_reset (void)
  253. {
  254. debug ("init_ide_reset\n");
  255. #if defined (CONFIG_MINIFAP)
  256. /* Configure GPIO_51 of the SM501 grafic controller as ATA reset */
  257. /* enable GPIO control (in both power modes) */
  258. *(vu_long *) (SM501_MMIO_BASE+SM501_POWER_MODE0_GATE) |=
  259. POWER_MODE_GATE_GPIO_PWM_I2C;
  260. *(vu_long *) (SM501_MMIO_BASE+SM501_POWER_MODE1_GATE) |=
  261. POWER_MODE_GATE_GPIO_PWM_I2C;
  262. /* configure GPIO51 as output */
  263. *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_DIR_HIGH) |=
  264. SM501_GPIO_51;
  265. #else
  266. /* Configure PSC1_4 as GPIO output for ATA reset */
  267. *(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_PSC1_4;
  268. *(vu_long *) MPC5XXX_WU_GPIO_DIR |= GPIO_PSC1_4;
  269. /* by default the ATA reset is de-asserted */
  270. *(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_PSC1_4;
  271. #endif
  272. }
  273. void ide_set_reset (int idereset)
  274. {
  275. debug ("ide_reset(%d)\n", idereset);
  276. #if defined (CONFIG_MINIFAP)
  277. if (idereset) {
  278. *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) &=
  279. ~SM501_GPIO_51;
  280. } else {
  281. *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) |=
  282. SM501_GPIO_51;
  283. }
  284. #else
  285. if (idereset) {
  286. *(vu_long *) MPC5XXX_WU_GPIO_DATA_O &= ~GPIO_PSC1_4;
  287. } else {
  288. *(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_PSC1_4;
  289. }
  290. #endif
  291. }
  292. #endif
  293. #ifdef CONFIG_POST
  294. /*
  295. * Reads GPIO pin PSC6_3. A keypress is reported, if PSC6_3 is low. If PSC6_3
  296. * is left open, no keypress is detected.
  297. */
  298. int post_hotkeys_pressed(void)
  299. {
  300. #ifdef CONFIG_STK52XX
  301. struct mpc5xxx_gpio *gpio;
  302. gpio = (struct mpc5xxx_gpio*) MPC5XXX_GPIO;
  303. /*
  304. * Configure PSC6_1 and PSC6_3 as GPIO. PSC6 then couldn't be used in
  305. * CODEC or UART mode. Consumer IrDA should still be possible.
  306. */
  307. gpio->port_config &= ~(0x07000000);
  308. gpio->port_config |= 0x03000000;
  309. /* Enable GPIO for GPIO_IRDA_1 (IR_USB_CLK pin) = PSC6_3 */
  310. gpio->simple_gpioe |= 0x20000000;
  311. /* Configure GPIO_IRDA_1 as input */
  312. gpio->simple_ddr &= ~(0x20000000);
  313. return ((gpio->simple_ival & 0x20000000) ? 0 : 1);
  314. #else
  315. return 0;
  316. #endif
  317. }
  318. #endif
  319. #if defined(CONFIG_POST) || defined(CONFIG_LOGBUFFER)
  320. void post_word_store (ulong a)
  321. {
  322. volatile ulong *save_addr =
  323. (volatile ulong *)(MPC5XXX_SRAM + MPC5XXX_SRAM_POST_SIZE);
  324. *save_addr = a;
  325. }
  326. ulong post_word_load (void)
  327. {
  328. volatile ulong *save_addr =
  329. (volatile ulong *)(MPC5XXX_SRAM + MPC5XXX_SRAM_POST_SIZE);
  330. return *save_addr;
  331. }
  332. #endif /* CONFIG_POST || CONFIG_LOGBUFFER*/
  333. #ifdef CONFIG_BOARD_EARLY_INIT_R
  334. int board_early_init_r (void)
  335. {
  336. extern int usb_cpu_init(void);
  337. #ifdef CONFIG_PS2MULT
  338. ps2mult_early_init();
  339. #endif /* CONFIG_PS2MULT */
  340. #if defined(CONFIG_USB_OHCI_NEW) && defined(CFG_USB_OHCI_CPU_INIT)
  341. /* Low level USB init, required for proper kernel operation */
  342. usb_cpu_init();
  343. #endif
  344. return (0);
  345. }
  346. #endif
  347. #ifdef CONFIG_FO300
  348. int silent_boot (void)
  349. {
  350. vu_long timer3_status;
  351. /* Configure GPT3 as GPIO input */
  352. *(vu_long *)MPC5XXX_GPT3_ENABLE = 0x00000004;
  353. /* Read in TIMER_3 pin status */
  354. timer3_status = *(vu_long *)MPC5XXX_GPT3_STATUS;
  355. #ifdef FO300_SILENT_CONSOLE_WHEN_S1_CLOSED
  356. /* Force silent console mode if S1 switch
  357. * is in closed position (TIMER_3 pin status is LOW). */
  358. if (MPC5XXX_GPT_GPIO_PIN(timer3_status) == 0)
  359. return 1;
  360. #else
  361. /* Force silent console mode if S1 switch
  362. * is in open position (TIMER_3 pin status is HIGH). */
  363. if (MPC5XXX_GPT_GPIO_PIN(timer3_status) == 1)
  364. return 1;
  365. #endif
  366. return 0;
  367. }
  368. int board_early_init_f (void)
  369. {
  370. if (silent_boot())
  371. gd->flags |= GD_FLG_SILENT;
  372. return 0;
  373. }
  374. #endif /* CONFIG_FO300 */
  375. int last_stage_init (void)
  376. {
  377. /*
  378. * auto scan for really existing devices and re-set chip select
  379. * configuration.
  380. */
  381. u16 save, tmp;
  382. int restore;
  383. /*
  384. * Check for SRAM and SRAM size
  385. */
  386. /* save original SRAM content */
  387. save = *(volatile u16 *)CFG_CS2_START;
  388. restore = 1;
  389. /* write test pattern to SRAM */
  390. *(volatile u16 *)CFG_CS2_START = 0xA5A5;
  391. __asm__ volatile ("sync");
  392. /*
  393. * Put a different pattern on the data lines: otherwise they may float
  394. * long enough to read back what we wrote.
  395. */
  396. tmp = *(volatile u16 *)CFG_FLASH_BASE;
  397. if (tmp == 0xA5A5)
  398. puts ("!! possible error in SRAM detection\n");
  399. if (*(volatile u16 *)CFG_CS2_START != 0xA5A5) {
  400. /* no SRAM at all, disable cs */
  401. *(vu_long *)MPC5XXX_ADDECR &= ~(1 << 18);
  402. *(vu_long *)MPC5XXX_CS2_START = 0x0000FFFF;
  403. *(vu_long *)MPC5XXX_CS2_STOP = 0x0000FFFF;
  404. restore = 0;
  405. __asm__ volatile ("sync");
  406. } else if (*(volatile u16 *)(CFG_CS2_START + (1<<19)) == 0xA5A5) {
  407. /* make sure that we access a mirrored address */
  408. *(volatile u16 *)CFG_CS2_START = 0x1111;
  409. __asm__ volatile ("sync");
  410. if (*(volatile u16 *)(CFG_CS2_START + (1<<19)) == 0x1111) {
  411. /* SRAM size = 512 kByte */
  412. *(vu_long *)MPC5XXX_CS2_STOP = STOP_REG(CFG_CS2_START,
  413. 0x80000);
  414. __asm__ volatile ("sync");
  415. puts ("SRAM: 512 kB\n");
  416. }
  417. else
  418. puts ("!! possible error in SRAM detection\n");
  419. } else {
  420. puts ("SRAM: 1 MB\n");
  421. }
  422. /* restore origianl SRAM content */
  423. if (restore) {
  424. *(volatile u16 *)CFG_CS2_START = save;
  425. __asm__ volatile ("sync");
  426. }
  427. #ifndef CONFIG_TQM5200S /* The TQM5200S has no SM501 grafic controller */
  428. /*
  429. * Check for Grafic Controller
  430. */
  431. /* save origianl FB content */
  432. save = *(volatile u16 *)CFG_CS1_START;
  433. restore = 1;
  434. /* write test pattern to FB memory */
  435. *(volatile u16 *)CFG_CS1_START = 0xA5A5;
  436. __asm__ volatile ("sync");
  437. /*
  438. * Put a different pattern on the data lines: otherwise they may float
  439. * long enough to read back what we wrote.
  440. */
  441. tmp = *(volatile u16 *)CFG_FLASH_BASE;
  442. if (tmp == 0xA5A5)
  443. puts ("!! possible error in grafic controller detection\n");
  444. if (*(volatile u16 *)CFG_CS1_START != 0xA5A5) {
  445. /* no grafic controller at all, disable cs */
  446. *(vu_long *)MPC5XXX_ADDECR &= ~(1 << 17);
  447. *(vu_long *)MPC5XXX_CS1_START = 0x0000FFFF;
  448. *(vu_long *)MPC5XXX_CS1_STOP = 0x0000FFFF;
  449. restore = 0;
  450. __asm__ volatile ("sync");
  451. } else {
  452. puts ("VGA: SMI501 (Voyager) with 8 MB\n");
  453. }
  454. /* restore origianl FB content */
  455. if (restore) {
  456. *(volatile u16 *)CFG_CS1_START = save;
  457. __asm__ volatile ("sync");
  458. }
  459. #ifdef CONFIG_FO300
  460. if (silent_boot()) {
  461. setenv("bootdelay", "0");
  462. disable_ctrlc(1);
  463. }
  464. #endif
  465. #endif /* !CONFIG_TQM5200S */
  466. return 0;
  467. }
  468. #ifdef CONFIG_VIDEO_SM501
  469. #ifdef CONFIG_FO300
  470. #define DISPLAY_WIDTH 800
  471. #else
  472. #define DISPLAY_WIDTH 640
  473. #endif
  474. #define DISPLAY_HEIGHT 480
  475. #ifdef CONFIG_VIDEO_SM501_8BPP
  476. #error CONFIG_VIDEO_SM501_8BPP not supported.
  477. #endif /* CONFIG_VIDEO_SM501_8BPP */
  478. #ifdef CONFIG_VIDEO_SM501_16BPP
  479. #error CONFIG_VIDEO_SM501_16BPP not supported.
  480. #endif /* CONFIG_VIDEO_SM501_16BPP */
  481. #ifdef CONFIG_VIDEO_SM501_32BPP
  482. static const SMI_REGS init_regs [] =
  483. {
  484. #if 0 /* CRT only */
  485. {0x00004, 0x0},
  486. {0x00048, 0x00021807},
  487. {0x0004C, 0x10090a01},
  488. {0x00054, 0x1},
  489. {0x00040, 0x00021807},
  490. {0x00044, 0x10090a01},
  491. {0x00054, 0x0},
  492. {0x80200, 0x00010000},
  493. {0x80204, 0x0},
  494. {0x80208, 0x0A000A00},
  495. {0x8020C, 0x02fa027f},
  496. {0x80210, 0x004a028b},
  497. {0x80214, 0x020c01df},
  498. {0x80218, 0x000201e9},
  499. {0x80200, 0x00013306},
  500. #else /* panel + CRT */
  501. #ifdef CONFIG_FO300
  502. {0x00004, 0x0},
  503. {0x00048, 0x00021807},
  504. {0x0004C, 0x301a0a01},
  505. {0x00054, 0x1},
  506. {0x00040, 0x00021807},
  507. {0x00044, 0x091a0a01},
  508. {0x00054, 0x0},
  509. {0x80000, 0x0f013106},
  510. {0x80004, 0xc428bb17},
  511. {0x8000C, 0x00000000},
  512. {0x80010, 0x0C800C80},
  513. {0x80014, 0x03200000},
  514. {0x80018, 0x01e00000},
  515. {0x8001C, 0x00000000},
  516. {0x80020, 0x01e00320},
  517. {0x80024, 0x042a031f},
  518. {0x80028, 0x0086034a},
  519. {0x8002C, 0x020c01df},
  520. {0x80030, 0x000201ea},
  521. {0x80200, 0x00010000},
  522. #else
  523. {0x00004, 0x0},
  524. {0x00048, 0x00021807},
  525. {0x0004C, 0x091a0a01},
  526. {0x00054, 0x1},
  527. {0x00040, 0x00021807},
  528. {0x00044, 0x091a0a01},
  529. {0x00054, 0x0},
  530. {0x80000, 0x0f013106},
  531. {0x80004, 0xc428bb17},
  532. {0x8000C, 0x00000000},
  533. {0x80010, 0x0a000a00},
  534. {0x80014, 0x02800000},
  535. {0x80018, 0x01e00000},
  536. {0x8001C, 0x00000000},
  537. {0x80020, 0x01e00280},
  538. {0x80024, 0x02fa027f},
  539. {0x80028, 0x004a028b},
  540. {0x8002C, 0x020c01df},
  541. {0x80030, 0x000201e9},
  542. {0x80200, 0x00010000},
  543. #endif /* #ifdef CONFIG_FO300 */
  544. #endif
  545. {0, 0}
  546. };
  547. #endif /* CONFIG_VIDEO_SM501_32BPP */
  548. #ifdef CONFIG_CONSOLE_EXTRA_INFO
  549. /*
  550. * Return text to be printed besides the logo.
  551. */
  552. void video_get_info_str (int line_number, char *info)
  553. {
  554. if (line_number == 1) {
  555. strcpy (info, " Board: TQM5200 (TQ-Components GmbH)");
  556. #if defined (CONFIG_STK52XX) || defined (CONFIG_TB5200) || defined(CONFIG_FO300)
  557. } else if (line_number == 2) {
  558. #if defined (CONFIG_STK52XX)
  559. strcpy (info, " on a STK52xx carrier board");
  560. #endif
  561. #if defined (CONFIG_TB5200)
  562. strcpy (info, " on a TB5200 carrier board");
  563. #endif
  564. #if defined (CONFIG_FO300)
  565. strcpy (info, " on a FO300 carrier board");
  566. #endif
  567. #endif
  568. }
  569. else {
  570. info [0] = '\0';
  571. }
  572. }
  573. #endif
  574. /*
  575. * Returns SM501 register base address. First thing called in the
  576. * driver. Checks if SM501 is physically present.
  577. */
  578. unsigned int board_video_init (void)
  579. {
  580. u16 save, tmp;
  581. int restore, ret;
  582. /*
  583. * Check for Grafic Controller
  584. */
  585. /* save origianl FB content */
  586. save = *(volatile u16 *)CFG_CS1_START;
  587. restore = 1;
  588. /* write test pattern to FB memory */
  589. *(volatile u16 *)CFG_CS1_START = 0xA5A5;
  590. __asm__ volatile ("sync");
  591. /*
  592. * Put a different pattern on the data lines: otherwise they may float
  593. * long enough to read back what we wrote.
  594. */
  595. tmp = *(volatile u16 *)CFG_FLASH_BASE;
  596. if (tmp == 0xA5A5)
  597. puts ("!! possible error in grafic controller detection\n");
  598. if (*(volatile u16 *)CFG_CS1_START != 0xA5A5) {
  599. /* no grafic controller found */
  600. restore = 0;
  601. ret = 0;
  602. } else {
  603. ret = SM501_MMIO_BASE;
  604. }
  605. if (restore) {
  606. *(volatile u16 *)CFG_CS1_START = save;
  607. __asm__ volatile ("sync");
  608. }
  609. return ret;
  610. }
  611. /*
  612. * Returns SM501 framebuffer address
  613. */
  614. unsigned int board_video_get_fb (void)
  615. {
  616. return SM501_FB_BASE;
  617. }
  618. /*
  619. * Called after initializing the SM501 and before clearing the screen.
  620. */
  621. void board_validate_screen (unsigned int base)
  622. {
  623. }
  624. /*
  625. * Return a pointer to the initialization sequence.
  626. */
  627. const SMI_REGS *board_get_regs (void)
  628. {
  629. return init_regs;
  630. }
  631. int board_get_width (void)
  632. {
  633. return DISPLAY_WIDTH;
  634. }
  635. int board_get_height (void)
  636. {
  637. return DISPLAY_HEIGHT;
  638. }
  639. #endif /* CONFIG_VIDEO_SM501 */
  640. #if defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP)
  641. void ft_board_setup(void *blob, bd_t *bd)
  642. {
  643. ft_cpu_setup(blob, bd);
  644. fdt_fixup_memory(blob, (u64)bd->bi_memstart, (u64)bd->bi_memsize);
  645. }
  646. #endif /* defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP) */