pxa_lcd.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641
  1. /*
  2. * PXA LCD Controller
  3. *
  4. * (C) Copyright 2001-2002
  5. * Wolfgang Denk, DENX Software Engineering -- wd@denx.de
  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. /************************************************************************/
  26. /* ** HEADER FILES */
  27. /************************************************************************/
  28. #include <config.h>
  29. #include <common.h>
  30. #include <version.h>
  31. #include <stdarg.h>
  32. #include <linux/types.h>
  33. #include <stdio_dev.h>
  34. #include <lcd.h>
  35. #include <asm/arch/pxa-regs.h>
  36. #include <asm/io.h>
  37. /* #define DEBUG */
  38. #ifdef CONFIG_LCD
  39. /*----------------------------------------------------------------------*/
  40. /*
  41. * Define panel bpp, LCCR0, LCCR3 and panel_info video struct for
  42. * your display.
  43. */
  44. #ifdef CONFIG_PXA_VGA
  45. /* LCD outputs connected to a video DAC */
  46. # define LCD_BPP LCD_COLOR8
  47. /* you have to set lccr0 and lccr3 (including pcd) */
  48. # define REG_LCCR0 0x003008f8
  49. # define REG_LCCR3 0x0300FF01
  50. /* 640x480x16 @ 61 Hz */
  51. vidinfo_t panel_info = {
  52. .vl_col = 640,
  53. .vl_row = 480,
  54. .vl_width = 640,
  55. .vl_height = 480,
  56. .vl_clkp = CONFIG_SYS_HIGH,
  57. .vl_oep = CONFIG_SYS_HIGH,
  58. .vl_hsp = CONFIG_SYS_HIGH,
  59. .vl_vsp = CONFIG_SYS_HIGH,
  60. .vl_dp = CONFIG_SYS_HIGH,
  61. .vl_bpix = LCD_BPP,
  62. .vl_lbw = 0,
  63. .vl_splt = 0,
  64. .vl_clor = 0,
  65. .vl_tft = 1,
  66. .vl_hpw = 40,
  67. .vl_blw = 56,
  68. .vl_elw = 56,
  69. .vl_vpw = 20,
  70. .vl_bfw = 8,
  71. .vl_efw = 8,
  72. };
  73. #endif /* CONFIG_PXA_VIDEO */
  74. /*----------------------------------------------------------------------*/
  75. #ifdef CONFIG_SHARP_LM8V31
  76. # define LCD_BPP LCD_COLOR8
  77. # define LCD_INVERT_COLORS /* Needed for colors to be correct, but why? */
  78. /* you have to set lccr0 and lccr3 (including pcd) */
  79. # define REG_LCCR0 0x0030087C
  80. # define REG_LCCR3 0x0340FF08
  81. vidinfo_t panel_info = {
  82. .vl_col = 640,
  83. .vl_row = 480,
  84. .vl_width = 157,
  85. .vl_height = 118,
  86. .vl_clkp = CONFIG_SYS_HIGH,
  87. .vl_oep = CONFIG_SYS_HIGH,
  88. .vl_hsp = CONFIG_SYS_HIGH,
  89. .vl_vsp = CONFIG_SYS_HIGH,
  90. .vl_dp = CONFIG_SYS_HIGH,
  91. .vl_bpix = LCD_BPP,
  92. .vl_lbw = 0,
  93. .vl_splt = 1,
  94. .vl_clor = 1,
  95. .vl_tft = 0,
  96. .vl_hpw = 1,
  97. .vl_blw = 3,
  98. .vl_elw = 3,
  99. .vl_vpw = 1,
  100. .vl_bfw = 0,
  101. .vl_efw = 0,
  102. };
  103. #endif /* CONFIG_SHARP_LM8V31 */
  104. /*----------------------------------------------------------------------*/
  105. #ifdef CONFIG_VOIPAC_LCD
  106. # define LCD_BPP LCD_COLOR8
  107. # define LCD_INVERT_COLORS
  108. /* you have to set lccr0 and lccr3 (including pcd) */
  109. # define REG_LCCR0 0x043008f8
  110. # define REG_LCCR3 0x0340FF08
  111. vidinfo_t panel_info = {
  112. .vl_col = 640,
  113. .vl_row = 480,
  114. .vl_width = 157,
  115. .vl_height = 118,
  116. .vl_clkp = CONFIG_SYS_HIGH,
  117. .vl_oep = CONFIG_SYS_HIGH,
  118. .vl_hsp = CONFIG_SYS_HIGH,
  119. .vl_vsp = CONFIG_SYS_HIGH,
  120. .vl_dp = CONFIG_SYS_HIGH,
  121. .vl_bpix = LCD_BPP,
  122. .vl_lbw = 0,
  123. .vl_splt = 1,
  124. .vl_clor = 1,
  125. .vl_tft = 1,
  126. .vl_hpw = 32,
  127. .vl_blw = 144,
  128. .vl_elw = 32,
  129. .vl_vpw = 2,
  130. .vl_bfw = 13,
  131. .vl_efw = 30,
  132. };
  133. #endif /* CONFIG_VOIPAC_LCD */
  134. /*----------------------------------------------------------------------*/
  135. #ifdef CONFIG_HITACHI_SX14
  136. /* Hitachi SX14Q004-ZZA color STN LCD */
  137. #define LCD_BPP LCD_COLOR8
  138. /* you have to set lccr0 and lccr3 (including pcd) */
  139. #define REG_LCCR0 0x00301079
  140. #define REG_LCCR3 0x0340FF20
  141. vidinfo_t panel_info = {
  142. .vl_col = 320,
  143. .vl_row = 240,
  144. .vl_width = 167,
  145. .vl_height = 109,
  146. .vl_clkp = CONFIG_SYS_HIGH,
  147. .vl_oep = CONFIG_SYS_HIGH,
  148. .vl_hsp = CONFIG_SYS_HIGH,
  149. .vl_vsp = CONFIG_SYS_HIGH,
  150. .vl_dp = CONFIG_SYS_HIGH,
  151. .vl_bpix = LCD_BPP,
  152. .vl_lbw = 1,
  153. .vl_splt = 0,
  154. .vl_clor = 1,
  155. .vl_tft = 0,
  156. .vl_hpw = 1,
  157. .vl_blw = 1,
  158. .vl_elw = 1,
  159. .vl_vpw = 7,
  160. .vl_bfw = 0,
  161. .vl_efw = 0,
  162. };
  163. #endif /* CONFIG_HITACHI_SX14 */
  164. /*----------------------------------------------------------------------*/
  165. #ifdef CONFIG_LMS283GF05
  166. # define LCD_BPP LCD_COLOR8
  167. /*# define LCD_INVERT_COLORS*/
  168. /* you have to set lccr0 and lccr3 (including pcd) */
  169. # define REG_LCCR0 0x043008f8
  170. # define REG_LCCR3 0x03b00009
  171. vidinfo_t panel_info = {
  172. .vl_col = 240,
  173. .vl_row = 320,
  174. .vl_width = 240,
  175. .vl_height = 320,
  176. .vl_clkp = CONFIG_SYS_HIGH,
  177. .vl_oep = CONFIG_SYS_LOW,
  178. .vl_hsp = CONFIG_SYS_LOW,
  179. .vl_vsp = CONFIG_SYS_LOW,
  180. .vl_dp = CONFIG_SYS_HIGH,
  181. .vl_bpix = LCD_BPP,
  182. .vl_lbw = 0,
  183. .vl_splt = 1,
  184. .vl_clor = 1,
  185. .vl_tft = 1,
  186. .vl_hpw = 4,
  187. .vl_blw = 4,
  188. .vl_elw = 8,
  189. .vl_vpw = 4,
  190. .vl_bfw = 4,
  191. .vl_efw = 8,
  192. };
  193. #endif /* CONFIG_LMS283GF05 */
  194. /*----------------------------------------------------------------------*/
  195. #ifdef CONFIG_ACX517AKN
  196. # define LCD_BPP LCD_COLOR8
  197. /* you have to set lccr0 and lccr3 (including pcd) */
  198. # define REG_LCCR0 0x003008f9
  199. # define REG_LCCR3 0x03700006
  200. vidinfo_t panel_info = {
  201. .vl_col = 320,
  202. .vl_row = 320,
  203. .vl_width = 320,
  204. .vl_height = 320,
  205. .vl_clkp = CONFIG_SYS_HIGH,
  206. .vl_oep = CONFIG_SYS_LOW,
  207. .vl_hsp = CONFIG_SYS_LOW,
  208. .vl_vsp = CONFIG_SYS_LOW,
  209. .vl_dp = CONFIG_SYS_HIGH,
  210. .vl_bpix = LCD_BPP,
  211. .vl_lbw = 0,
  212. .vl_splt = 1,
  213. .vl_clor = 1,
  214. .vl_tft = 1,
  215. .vl_hpw = 0x04,
  216. .vl_blw = 0x1c,
  217. .vl_elw = 0x08,
  218. .vl_vpw = 0x01,
  219. .vl_bfw = 0x07,
  220. .vl_efw = 0x08,
  221. };
  222. #endif /* CONFIG_ACX517AKN */
  223. #ifdef CONFIG_ACX544AKN
  224. # define LCD_BPP LCD_COLOR16
  225. /* you have to set lccr0 and lccr3 (including pcd) */
  226. # define REG_LCCR0 0x003008f9
  227. # define REG_LCCR3 0x04700007 /* 16bpp */
  228. vidinfo_t panel_info = {
  229. .vl_col = 320,
  230. .vl_row = 320,
  231. .vl_width = 320,
  232. .vl_height = 320,
  233. .vl_clkp = CONFIG_SYS_LOW,
  234. .vl_oep = CONFIG_SYS_LOW,
  235. .vl_hsp = CONFIG_SYS_LOW,
  236. .vl_vsp = CONFIG_SYS_LOW,
  237. .vl_dp = CONFIG_SYS_LOW,
  238. .vl_bpix = LCD_BPP,
  239. .vl_lbw = 0,
  240. .vl_splt = 0,
  241. .vl_clor = 1,
  242. .vl_tft = 1,
  243. .vl_hpw = 0x05,
  244. .vl_blw = 0x13,
  245. .vl_elw = 0x08,
  246. .vl_vpw = 0x02,
  247. .vl_bfw = 0x07,
  248. .vl_efw = 0x05,
  249. };
  250. #endif /* CONFIG_ACX544AKN */
  251. /*----------------------------------------------------------------------*/
  252. #ifdef CONFIG_LQ038J7DH53
  253. # define LCD_BPP LCD_COLOR8
  254. /* you have to set lccr0 and lccr3 (including pcd) */
  255. # define REG_LCCR0 0x003008f9
  256. # define REG_LCCR3 0x03700004
  257. vidinfo_t panel_info = {
  258. .vl_col = 320,
  259. .vl_row = 480,
  260. .vl_width = 320,
  261. .vl_height = 480,
  262. .vl_clkp = CONFIG_SYS_HIGH,
  263. .vl_oep = CONFIG_SYS_LOW,
  264. .vl_hsp = CONFIG_SYS_LOW,
  265. .vl_vsp = CONFIG_SYS_LOW,
  266. .vl_dp = CONFIG_SYS_HIGH,
  267. .vl_bpix = LCD_BPP,
  268. .vl_lbw = 0,
  269. .vl_splt = 1,
  270. .vl_clor = 1,
  271. .vl_tft = 1,
  272. .vl_hpw = 0x04,
  273. .vl_blw = 0x20,
  274. .vl_elw = 0x01,
  275. .vl_vpw = 0x01,
  276. .vl_bfw = 0x04,
  277. .vl_efw = 0x01,
  278. };
  279. #endif /* CONFIG_ACX517AKN */
  280. /*----------------------------------------------------------------------*/
  281. #ifdef CONFIG_LITTLETON_LCD
  282. # define LCD_BPP LCD_COLOR8
  283. /* you have to set lccr0 and lccr3 (including pcd) */
  284. # define REG_LCCR0 0x003008f8
  285. # define REG_LCCR3 0x0300FF04
  286. vidinfo_t panel_info = {
  287. .vl_col = 480,
  288. .vl_row = 640,
  289. .vl_width = 480,
  290. .vl_height = 640,
  291. .vl_clkp = CONFIG_SYS_HIGH,
  292. .vl_oep = CONFIG_SYS_HIGH,
  293. .vl_hsp = CONFIG_SYS_HIGH,
  294. .vl_vsp = CONFIG_SYS_HIGH,
  295. .vl_dp = CONFIG_SYS_HIGH,
  296. .vl_bpix = LCD_BPP,
  297. .vl_lbw = 0,
  298. .vl_splt = 0,
  299. .vl_clor = 0,
  300. .vl_tft = 1,
  301. .vl_hpw = 9,
  302. .vl_blw = 8,
  303. .vl_elw = 24,
  304. .vl_vpw = 2,
  305. .vl_bfw = 2,
  306. .vl_efw = 4,
  307. };
  308. #endif /* CONFIG_LITTLETON_LCD */
  309. /*----------------------------------------------------------------------*/
  310. static int pxafb_init_mem (void *lcdbase, vidinfo_t *vid);
  311. static void pxafb_setup_gpio (vidinfo_t *vid);
  312. static void pxafb_enable_controller (vidinfo_t *vid);
  313. static int pxafb_init (vidinfo_t *vid);
  314. /************************************************************************/
  315. /* --------------- PXA chipset specific functions ------------------- */
  316. /************************************************************************/
  317. void lcd_ctrl_init (void *lcdbase)
  318. {
  319. pxafb_init_mem(lcdbase, &panel_info);
  320. pxafb_init(&panel_info);
  321. pxafb_setup_gpio(&panel_info);
  322. pxafb_enable_controller(&panel_info);
  323. }
  324. /*----------------------------------------------------------------------*/
  325. #if LCD_BPP == LCD_COLOR8
  326. void
  327. lcd_setcolreg (ushort regno, ushort red, ushort green, ushort blue)
  328. {
  329. struct pxafb_info *fbi = &panel_info.pxa;
  330. unsigned short *palette = (unsigned short *)fbi->palette;
  331. u_int val;
  332. if (regno < fbi->palette_size) {
  333. val = ((red << 8) & 0xf800);
  334. val |= ((green << 4) & 0x07e0);
  335. val |= (blue & 0x001f);
  336. #ifdef LCD_INVERT_COLORS
  337. palette[regno] = ~val;
  338. #else
  339. palette[regno] = val;
  340. #endif
  341. }
  342. debug ("setcolreg: reg %2d @ %p: R=%02X G=%02X B=%02X => %04X\n",
  343. regno, &palette[regno],
  344. red, green, blue,
  345. palette[regno]);
  346. }
  347. #endif /* LCD_COLOR8 */
  348. /*----------------------------------------------------------------------*/
  349. #if LCD_BPP == LCD_MONOCHROME
  350. void lcd_initcolregs (void)
  351. {
  352. struct pxafb_info *fbi = &panel_info.pxa;
  353. cmap = (ushort *)fbi->palette;
  354. ushort regno;
  355. for (regno = 0; regno < 16; regno++) {
  356. cmap[regno * 2] = 0;
  357. cmap[(regno * 2) + 1] = regno & 0x0f;
  358. }
  359. }
  360. #endif /* LCD_MONOCHROME */
  361. /*----------------------------------------------------------------------*/
  362. __weak void lcd_enable(void)
  363. {
  364. }
  365. /************************************************************************/
  366. /* ** PXA255 specific routines */
  367. /************************************************************************/
  368. /*
  369. * Calculate fb size for VIDEOLFB_ATAG. Size returned contains fb,
  370. * descriptors and palette areas.
  371. */
  372. ulong calc_fbsize (void)
  373. {
  374. ulong size;
  375. int line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8;
  376. size = line_length * panel_info.vl_row;
  377. size += PAGE_SIZE;
  378. return size;
  379. }
  380. static int pxafb_init_mem (void *lcdbase, vidinfo_t *vid)
  381. {
  382. u_long palette_mem_size;
  383. struct pxafb_info *fbi = &vid->pxa;
  384. int fb_size = vid->vl_row * (vid->vl_col * NBITS (vid->vl_bpix)) / 8;
  385. fbi->screen = (u_long)lcdbase;
  386. fbi->palette_size = NBITS(vid->vl_bpix) == 8 ? 256 : 16;
  387. palette_mem_size = fbi->palette_size * sizeof(u16);
  388. debug("palette_mem_size = 0x%08lx\n", (u_long) palette_mem_size);
  389. /* locate palette and descs at end of page following fb */
  390. fbi->palette = (u_long)lcdbase + fb_size + PAGE_SIZE - palette_mem_size;
  391. return 0;
  392. }
  393. #ifdef CONFIG_CPU_MONAHANS
  394. static inline void pxafb_setup_gpio (vidinfo_t *vid) {}
  395. #else
  396. static void pxafb_setup_gpio (vidinfo_t *vid)
  397. {
  398. u_long lccr0;
  399. /*
  400. * setup is based on type of panel supported
  401. */
  402. lccr0 = vid->pxa.reg_lccr0;
  403. /* 4 bit interface */
  404. if ((lccr0 & LCCR0_CMS) && (lccr0 & LCCR0_SDS) && !(lccr0 & LCCR0_DPD))
  405. {
  406. debug("Setting GPIO for 4 bit data\n");
  407. /* bits 58-61 */
  408. writel(readl(GPDR1) | (0xf << 26), GPDR1);
  409. writel((readl(GAFR1_U) & ~(0xff << 20)) | (0xaa << 20),
  410. GAFR1_U);
  411. /* bits 74-77 */
  412. writel(readl(GPDR2) | (0xf << 10), GPDR2);
  413. writel((readl(GAFR2_L) & ~(0xff << 20)) | (0xaa << 20),
  414. GAFR2_L);
  415. }
  416. /* 8 bit interface */
  417. else if (((lccr0 & LCCR0_CMS) && ((lccr0 & LCCR0_SDS) || (lccr0 & LCCR0_DPD))) ||
  418. (!(lccr0 & LCCR0_CMS) && !(lccr0 & LCCR0_PAS) && !(lccr0 & LCCR0_SDS)))
  419. {
  420. debug("Setting GPIO for 8 bit data\n");
  421. /* bits 58-65 */
  422. writel(readl(GPDR1) | (0x3f << 26), GPDR1);
  423. writel(readl(GPDR2) | (0x3), GPDR2);
  424. writel((readl(GAFR1_U) & ~(0xfff << 20)) | (0xaaa << 20),
  425. GAFR1_U);
  426. writel((readl(GAFR2_L) & ~0xf) | (0xa), GAFR2_L);
  427. /* bits 74-77 */
  428. writel(readl(GPDR2) | (0xf << 10), GPDR2);
  429. writel((readl(GAFR2_L) & ~(0xff << 20)) | (0xaa << 20),
  430. GAFR2_L);
  431. }
  432. /* 16 bit interface */
  433. else if (!(lccr0 & LCCR0_CMS) && ((lccr0 & LCCR0_SDS) || (lccr0 & LCCR0_PAS)))
  434. {
  435. debug("Setting GPIO for 16 bit data\n");
  436. /* bits 58-77 */
  437. writel(readl(GPDR1) | (0x3f << 26), GPDR1);
  438. writel(readl(GPDR2) | 0x00003fff, GPDR2);
  439. writel((readl(GAFR1_U) & ~(0xfff << 20)) | (0xaaa << 20),
  440. GAFR1_U);
  441. writel((readl(GAFR2_L) & 0xf0000000) | 0x0aaaaaaa, GAFR2_L);
  442. }
  443. else
  444. {
  445. printf("pxafb_setup_gpio: unable to determine bits per pixel\n");
  446. }
  447. }
  448. #endif
  449. static void pxafb_enable_controller (vidinfo_t *vid)
  450. {
  451. debug("Enabling LCD controller\n");
  452. /* Sequence from 11.7.10 */
  453. writel(vid->pxa.reg_lccr3, LCCR3);
  454. writel(vid->pxa.reg_lccr2, LCCR2);
  455. writel(vid->pxa.reg_lccr1, LCCR1);
  456. writel(vid->pxa.reg_lccr0 & ~LCCR0_ENB, LCCR0);
  457. writel(vid->pxa.fdadr0, FDADR0);
  458. writel(vid->pxa.fdadr1, FDADR1);
  459. writel(readl(LCCR0) | LCCR0_ENB, LCCR0);
  460. #ifdef CONFIG_CPU_MONAHANS
  461. writel(readl(CKENA) | CKENA_1_LCD, CKENA);
  462. #else
  463. writel(readl(CKEN) | CKEN16_LCD, CKEN);
  464. #endif
  465. debug("FDADR0 = 0x%08x\n", readl(FDADR0));
  466. debug("FDADR1 = 0x%08x\n", readl(FDADR1));
  467. debug("LCCR0 = 0x%08x\n", readl(LCCR0));
  468. debug("LCCR1 = 0x%08x\n", readl(LCCR1));
  469. debug("LCCR2 = 0x%08x\n", readl(LCCR2));
  470. debug("LCCR3 = 0x%08x\n", readl(LCCR3));
  471. }
  472. static int pxafb_init (vidinfo_t *vid)
  473. {
  474. struct pxafb_info *fbi = &vid->pxa;
  475. debug("Configuring PXA LCD\n");
  476. fbi->reg_lccr0 = REG_LCCR0;
  477. fbi->reg_lccr3 = REG_LCCR3;
  478. debug("vid: vl_col=%d hslen=%d lm=%d rm=%d\n",
  479. vid->vl_col, vid->vl_hpw,
  480. vid->vl_blw, vid->vl_elw);
  481. debug("vid: vl_row=%d vslen=%d um=%d bm=%d\n",
  482. vid->vl_row, vid->vl_vpw,
  483. vid->vl_bfw, vid->vl_efw);
  484. fbi->reg_lccr1 =
  485. LCCR1_DisWdth(vid->vl_col) +
  486. LCCR1_HorSnchWdth(vid->vl_hpw) +
  487. LCCR1_BegLnDel(vid->vl_blw) +
  488. LCCR1_EndLnDel(vid->vl_elw);
  489. fbi->reg_lccr2 =
  490. LCCR2_DisHght(vid->vl_row) +
  491. LCCR2_VrtSnchWdth(vid->vl_vpw) +
  492. LCCR2_BegFrmDel(vid->vl_bfw) +
  493. LCCR2_EndFrmDel(vid->vl_efw);
  494. fbi->reg_lccr3 = REG_LCCR3 & ~(LCCR3_HSP | LCCR3_VSP);
  495. fbi->reg_lccr3 |= (vid->vl_hsp ? LCCR3_HorSnchL : LCCR3_HorSnchH)
  496. | (vid->vl_vsp ? LCCR3_VrtSnchL : LCCR3_VrtSnchH);
  497. /* setup dma descriptors */
  498. fbi->dmadesc_fblow = (struct pxafb_dma_descriptor *)((unsigned int)fbi->palette - 3*16);
  499. fbi->dmadesc_fbhigh = (struct pxafb_dma_descriptor *)((unsigned int)fbi->palette - 2*16);
  500. fbi->dmadesc_palette = (struct pxafb_dma_descriptor *)((unsigned int)fbi->palette - 1*16);
  501. #define BYTES_PER_PANEL ((fbi->reg_lccr0 & LCCR0_SDS) ? \
  502. (vid->vl_col * vid->vl_row * NBITS(vid->vl_bpix) / 8 / 2) : \
  503. (vid->vl_col * vid->vl_row * NBITS(vid->vl_bpix) / 8))
  504. /* populate descriptors */
  505. fbi->dmadesc_fblow->fdadr = (u_long)fbi->dmadesc_fblow;
  506. fbi->dmadesc_fblow->fsadr = fbi->screen + BYTES_PER_PANEL;
  507. fbi->dmadesc_fblow->fidr = 0;
  508. fbi->dmadesc_fblow->ldcmd = BYTES_PER_PANEL;
  509. fbi->fdadr1 = (u_long)fbi->dmadesc_fblow; /* only used in dual-panel mode */
  510. fbi->dmadesc_fbhigh->fsadr = fbi->screen;
  511. fbi->dmadesc_fbhigh->fidr = 0;
  512. fbi->dmadesc_fbhigh->ldcmd = BYTES_PER_PANEL;
  513. fbi->dmadesc_palette->fsadr = fbi->palette;
  514. fbi->dmadesc_palette->fidr = 0;
  515. fbi->dmadesc_palette->ldcmd = (fbi->palette_size * 2) | LDCMD_PAL;
  516. if( NBITS(vid->vl_bpix) < 12)
  517. {
  518. /* assume any mode with <12 bpp is palette driven */
  519. fbi->dmadesc_palette->fdadr = (u_long)fbi->dmadesc_fbhigh;
  520. fbi->dmadesc_fbhigh->fdadr = (u_long)fbi->dmadesc_palette;
  521. /* flips back and forth between pal and fbhigh */
  522. fbi->fdadr0 = (u_long)fbi->dmadesc_palette;
  523. }
  524. else
  525. {
  526. /* palette shouldn't be loaded in true-color mode */
  527. fbi->dmadesc_fbhigh->fdadr = (u_long)fbi->dmadesc_fbhigh;
  528. fbi->fdadr0 = (u_long)fbi->dmadesc_fbhigh; /* no pal just fbhigh */
  529. }
  530. debug("fbi->dmadesc_fblow = 0x%lx\n", (u_long)fbi->dmadesc_fblow);
  531. debug("fbi->dmadesc_fbhigh = 0x%lx\n", (u_long)fbi->dmadesc_fbhigh);
  532. debug("fbi->dmadesc_palette = 0x%lx\n", (u_long)fbi->dmadesc_palette);
  533. debug("fbi->dmadesc_fblow->fdadr = 0x%lx\n", fbi->dmadesc_fblow->fdadr);
  534. debug("fbi->dmadesc_fbhigh->fdadr = 0x%lx\n", fbi->dmadesc_fbhigh->fdadr);
  535. debug("fbi->dmadesc_palette->fdadr = 0x%lx\n", fbi->dmadesc_palette->fdadr);
  536. debug("fbi->dmadesc_fblow->fsadr = 0x%lx\n", fbi->dmadesc_fblow->fsadr);
  537. debug("fbi->dmadesc_fbhigh->fsadr = 0x%lx\n", fbi->dmadesc_fbhigh->fsadr);
  538. debug("fbi->dmadesc_palette->fsadr = 0x%lx\n", fbi->dmadesc_palette->fsadr);
  539. debug("fbi->dmadesc_fblow->ldcmd = 0x%lx\n", fbi->dmadesc_fblow->ldcmd);
  540. debug("fbi->dmadesc_fbhigh->ldcmd = 0x%lx\n", fbi->dmadesc_fbhigh->ldcmd);
  541. debug("fbi->dmadesc_palette->ldcmd = 0x%lx\n", fbi->dmadesc_palette->ldcmd);
  542. return 0;
  543. }
  544. /************************************************************************/
  545. /************************************************************************/
  546. #endif /* CONFIG_LCD */