3 * Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
5 * HALE electronic GmbH, <helmut.raiger@hale.at>
7 * See file CREDITS for list of people who contributed to this
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.
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.
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,
29 #include <asm/arch/imx-regs.h>
30 #include <asm/arch/clock.h>
31 #include <asm/errno.h>
34 #include "videomodes.h"
36 /* this might need panel specific set-up as-well */
39 /* -------------- controller specific stuff -------------- */
41 /* IPU DMA Controller channel definitions. */
43 IDMAC_IC_0
= 0, /* IC (encoding task) to memory */
44 IDMAC_IC_1
= 1, /* IC (viewfinder task) to memory */
52 IDMAC_IC_7
= 7, /* IC (sensor data) to memory */
59 IDMAC_SDC_0
= 14, /* Background synchronous display data */
60 IDMAC_SDC_1
= 15, /* Foreground data (overlay) */
79 /* More formats can be copied from the Linux driver if needed */
89 struct pixel_fmt_cfg
{
96 static struct pixel_fmt_cfg fmt_cfg
[] = {
97 [IPU_PIX_FMT_RGB24
] = {
98 0x1600AAAA, 0x00E05555, 0x00070000, 3,
100 [IPU_PIX_FMT_RGB666
] = {
101 0x0005000F, 0x000B000F, 0x0011000F, 1,
103 [IPU_PIX_FMT_BGR666
] = {
104 0x0011000F, 0x000B000F, 0x0005000F, 1,
106 [IPU_PIX_FMT_RGB565
] = {
107 0x0004003F, 0x000A000F, 0x000F003F, 1,
116 /* IPU Common registers */
117 /* IPU_CONF and its bits already defined in imx-regs.h */
118 #define IPU_CHA_BUF0_RDY (0x04 + IPU_BASE)
119 #define IPU_CHA_BUF1_RDY (0x08 + IPU_BASE)
120 #define IPU_CHA_DB_MODE_SEL (0x0C + IPU_BASE)
121 #define IPU_CHA_CUR_BUF (0x10 + IPU_BASE)
122 #define IPU_FS_PROC_FLOW (0x14 + IPU_BASE)
123 #define IPU_FS_DISP_FLOW (0x18 + IPU_BASE)
124 #define IPU_TASKS_STAT (0x1C + IPU_BASE)
125 #define IPU_IMA_ADDR (0x20 + IPU_BASE)
126 #define IPU_IMA_DATA (0x24 + IPU_BASE)
127 #define IPU_INT_CTRL_1 (0x28 + IPU_BASE)
128 #define IPU_INT_CTRL_2 (0x2C + IPU_BASE)
129 #define IPU_INT_CTRL_3 (0x30 + IPU_BASE)
130 #define IPU_INT_CTRL_4 (0x34 + IPU_BASE)
131 #define IPU_INT_CTRL_5 (0x38 + IPU_BASE)
132 #define IPU_INT_STAT_1 (0x3C + IPU_BASE)
133 #define IPU_INT_STAT_2 (0x40 + IPU_BASE)
134 #define IPU_INT_STAT_3 (0x44 + IPU_BASE)
135 #define IPU_INT_STAT_4 (0x48 + IPU_BASE)
136 #define IPU_INT_STAT_5 (0x4C + IPU_BASE)
137 #define IPU_BRK_CTRL_1 (0x50 + IPU_BASE)
138 #define IPU_BRK_CTRL_2 (0x54 + IPU_BASE)
139 #define IPU_BRK_STAT (0x58 + IPU_BASE)
140 #define IPU_DIAGB_CTRL (0x5C + IPU_BASE)
142 /* Image Converter Registers */
143 #define IC_CONF (0x88 + IPU_BASE)
144 #define IC_PRP_ENC_RSC (0x8C + IPU_BASE)
145 #define IC_PRP_VF_RSC (0x90 + IPU_BASE)
146 #define IC_PP_RSC (0x94 + IPU_BASE)
147 #define IC_CMBP_1 (0x98 + IPU_BASE)
148 #define IC_CMBP_2 (0x9C + IPU_BASE)
149 #define PF_CONF (0xA0 + IPU_BASE)
150 #define IDMAC_CONF (0xA4 + IPU_BASE)
151 #define IDMAC_CHA_EN (0xA8 + IPU_BASE)
152 #define IDMAC_CHA_PRI (0xAC + IPU_BASE)
153 #define IDMAC_CHA_BUSY (0xB0 + IPU_BASE)
155 /* Image Converter Register bits */
156 #define IC_CONF_PRPENC_EN 0x00000001
157 #define IC_CONF_PRPENC_CSC1 0x00000002
158 #define IC_CONF_PRPENC_ROT_EN 0x00000004
159 #define IC_CONF_PRPVF_EN 0x00000100
160 #define IC_CONF_PRPVF_CSC1 0x00000200
161 #define IC_CONF_PRPVF_CSC2 0x00000400
162 #define IC_CONF_PRPVF_CMB 0x00000800
163 #define IC_CONF_PRPVF_ROT_EN 0x00001000
164 #define IC_CONF_PP_EN 0x00010000
165 #define IC_CONF_PP_CSC1 0x00020000
166 #define IC_CONF_PP_CSC2 0x00040000
167 #define IC_CONF_PP_CMB 0x00080000
168 #define IC_CONF_PP_ROT_EN 0x00100000
169 #define IC_CONF_IC_GLB_LOC_A 0x10000000
170 #define IC_CONF_KEY_COLOR_EN 0x20000000
171 #define IC_CONF_RWS_EN 0x40000000
172 #define IC_CONF_CSI_MEM_WR_EN 0x80000000
175 #define SDC_COM_CONF (0xB4 + IPU_BASE)
176 #define SDC_GW_CTRL (0xB8 + IPU_BASE)
177 #define SDC_FG_POS (0xBC + IPU_BASE)
178 #define SDC_BG_POS (0xC0 + IPU_BASE)
179 #define SDC_CUR_POS (0xC4 + IPU_BASE)
180 #define SDC_PWM_CTRL (0xC8 + IPU_BASE)
181 #define SDC_CUR_MAP (0xCC + IPU_BASE)
182 #define SDC_HOR_CONF (0xD0 + IPU_BASE)
183 #define SDC_VER_CONF (0xD4 + IPU_BASE)
184 #define SDC_SHARP_CONF_1 (0xD8 + IPU_BASE)
185 #define SDC_SHARP_CONF_2 (0xDC + IPU_BASE)
188 #define SDC_COM_TFT_COLOR 0x00000001UL
189 #define SDC_COM_FG_EN 0x00000010UL
190 #define SDC_COM_GWSEL 0x00000020UL
191 #define SDC_COM_GLB_A 0x00000040UL
192 #define SDC_COM_KEY_COLOR_G 0x00000080UL
193 #define SDC_COM_BG_EN 0x00000200UL
194 #define SDC_COM_SHARP 0x00001000UL
196 #define SDC_V_SYNC_WIDTH_L 0x00000001UL
198 /* Display Interface registers */
199 #define DI_DISP_IF_CONF (0x0124 + IPU_BASE)
200 #define DI_DISP_SIG_POL (0x0128 + IPU_BASE)
201 #define DI_SER_DISP1_CONF (0x012C + IPU_BASE)
202 #define DI_SER_DISP2_CONF (0x0130 + IPU_BASE)
203 #define DI_HSP_CLK_PER (0x0134 + IPU_BASE)
204 #define DI_DISP0_TIME_CONF_1 (0x0138 + IPU_BASE)
205 #define DI_DISP0_TIME_CONF_2 (0x013C + IPU_BASE)
206 #define DI_DISP0_TIME_CONF_3 (0x0140 + IPU_BASE)
207 #define DI_DISP1_TIME_CONF_1 (0x0144 + IPU_BASE)
208 #define DI_DISP1_TIME_CONF_2 (0x0148 + IPU_BASE)
209 #define DI_DISP1_TIME_CONF_3 (0x014C + IPU_BASE)
210 #define DI_DISP2_TIME_CONF_1 (0x0150 + IPU_BASE)
211 #define DI_DISP2_TIME_CONF_2 (0x0154 + IPU_BASE)
212 #define DI_DISP2_TIME_CONF_3 (0x0158 + IPU_BASE)
213 #define DI_DISP3_TIME_CONF (0x015C + IPU_BASE)
214 #define DI_DISP0_DB0_MAP (0x0160 + IPU_BASE)
215 #define DI_DISP0_DB1_MAP (0x0164 + IPU_BASE)
216 #define DI_DISP0_DB2_MAP (0x0168 + IPU_BASE)
217 #define DI_DISP0_CB0_MAP (0x016C + IPU_BASE)
218 #define DI_DISP0_CB1_MAP (0x0170 + IPU_BASE)
219 #define DI_DISP0_CB2_MAP (0x0174 + IPU_BASE)
220 #define DI_DISP1_DB0_MAP (0x0178 + IPU_BASE)
221 #define DI_DISP1_DB1_MAP (0x017C + IPU_BASE)
222 #define DI_DISP1_DB2_MAP (0x0180 + IPU_BASE)
223 #define DI_DISP1_CB0_MAP (0x0184 + IPU_BASE)
224 #define DI_DISP1_CB1_MAP (0x0188 + IPU_BASE)
225 #define DI_DISP1_CB2_MAP (0x018C + IPU_BASE)
226 #define DI_DISP2_DB0_MAP (0x0190 + IPU_BASE)
227 #define DI_DISP2_DB1_MAP (0x0194 + IPU_BASE)
228 #define DI_DISP2_DB2_MAP (0x0198 + IPU_BASE)
229 #define DI_DISP2_CB0_MAP (0x019C + IPU_BASE)
230 #define DI_DISP2_CB1_MAP (0x01A0 + IPU_BASE)
231 #define DI_DISP2_CB2_MAP (0x01A4 + IPU_BASE)
232 #define DI_DISP3_B0_MAP (0x01A8 + IPU_BASE)
233 #define DI_DISP3_B1_MAP (0x01AC + IPU_BASE)
234 #define DI_DISP3_B2_MAP (0x01B0 + IPU_BASE)
235 #define DI_DISP_ACC_CC (0x01B4 + IPU_BASE)
236 #define DI_DISP_LLA_CONF (0x01B8 + IPU_BASE)
237 #define DI_DISP_LLA_DATA (0x01BC + IPU_BASE)
239 /* DI_DISP_SIG_POL bits */
240 #define DI_D3_VSYNC_POL (1 << 28)
241 #define DI_D3_HSYNC_POL (1 << 27)
242 #define DI_D3_DRDY_SHARP_POL (1 << 26)
243 #define DI_D3_CLK_POL (1 << 25)
244 #define DI_D3_DATA_POL (1 << 24)
246 /* DI_DISP_IF_CONF bits */
247 #define DI_D3_CLK_IDLE (1 << 26)
248 #define DI_D3_CLK_SEL (1 << 25)
249 #define DI_D3_DATAMSK (1 << 24)
251 #define IOMUX_PADNUM_MASK 0x1ff
252 #define IOMUX_GPIONUM_SHIFT 9
253 #define IOMUX_GPIONUM_MASK (0xff << IOMUX_GPIONUM_SHIFT)
255 #define IOMUX_PIN(gpionum, padnum) ((padnum) & IOMUX_PADNUM_MASK)
257 #define IOMUX_MODE_L(pin, mode) IOMUX_MODE(((pin) + 0xc) ^ 3, mode)
259 struct chan_param_mem_planar
{
297 } __attribute__ ((packed
));
299 struct chan_param_mem_interleaved
{
356 } __attribute__ ((packed
));
358 union chan_param_mem
{
359 struct chan_param_mem_planar pp
;
360 struct chan_param_mem_interleaved ip
;
363 DECLARE_GLOBAL_DATA_PTR
;
366 static GraphicDevice panel
;
367 static struct ctfb_res_modes
*mode
;
368 static struct ctfb_res_modes var_mode
;
371 * sdc_init_panel() - initialize a synchronous LCD panel.
372 * @width: width of panel in pixels.
373 * @height: height of panel in pixels.
374 * @di_setup: pixel format of the frame buffer
375 * @di_panel: either SHARP or normal TFT
376 * @return: 0 on success or negative error code on failure.
378 static int sdc_init_panel(u16 width
, u16 height
,
379 enum pixel_fmt di_setup
, enum ipu_panel di_panel
)
385 debug("%s(width=%d, height=%d)\n", __func__
, width
, height
);
387 /* Init clocking, the IPU receives its clock from the hsp divder */
388 clock
= mxc_get_clock(MXC_IPU_CLK
);
392 /* Init panel size and blanking periods */
393 reg
= width
+ mode
->left_margin
+ mode
->right_margin
- 1;
395 printf("mx3fb: Display width too large, coerced to 1023!");
398 reg
= ((mode
->hsync_len
- 1) << 26) | (reg
<< 16);
399 writel(reg
, SDC_HOR_CONF
);
401 reg
= height
+ mode
->upper_margin
+ mode
->lower_margin
- 1;
403 printf("mx3fb: Display height too large, coerced to 1023!");
406 reg
= ((mode
->vsync_len
- 1) << 26) | SDC_V_SYNC_WIDTH_L
| (reg
<< 16);
407 writel(reg
, SDC_VER_CONF
);
410 case IPU_PANEL_SHARP_TFT
:
411 writel(0x00FD0102L
, SDC_SHARP_CONF_1
);
412 writel(0x00F500F4L
, SDC_SHARP_CONF_2
);
413 writel(SDC_COM_SHARP
| SDC_COM_TFT_COLOR
, SDC_COM_CONF
);
414 /* TODO: probably IF_CONF must be adapted (see below)! */
417 writel(SDC_COM_TFT_COLOR
, SDC_COM_CONF
);
424 * Calculate divider: The fractional part is 4 bits so simply
425 * multiple by 2^4 to get it.
427 * Opposed to the kernel driver mode->pixclock is the time of one
428 * pixel in pico seconds, so:
429 * pixel_clk = 1e12 / mode->pixclock
430 * div = ipu_clk * 16 / pixel_clk
432 * div = ipu_clk * 16 / (1e12 / mode->pixclock)
434 * div = ipu_clk * 16 * mode->pixclock / 1e12
436 * To avoid integer overflows this is split into 2 shifts and
437 * one divide with sufficient accuracy:
438 * 16*1024*128*476837 = 0.9999996682e12
440 div
= ((clock
/1024) * (mode
->pixclock
/128)) / 476837;
441 debug("hsp_clk is %d, div=%d\n", clock
, div
);
442 /* coerce to not less than 4.0, not more than 255.9375 */
445 else if (div
> 0xFFF)
447 /* DISP3_IF_CLK_DOWN_WR is half the divider value and 2 less
448 * fraction bits. Subtract 1 extra from DISP3_IF_CLK_DOWN_WR
449 * based on timing debug DISP3_IF_CLK_UP_WR is 0
451 writel((((div
/ 8) - 1) << 22) | div
, DI_DISP3_TIME_CONF
);
453 /* DI settings for display 3: clock idle (bit 26) during vsync */
454 old_conf
= readl(DI_DISP_IF_CONF
) & 0x78FFFFFF;
455 writel(old_conf
| IF_CONF
, DI_DISP_IF_CONF
);
457 /* only set display 3 polarity bits */
458 old_conf
= readl(DI_DISP_SIG_POL
) & 0xE0FFFFFF;
459 writel(old_conf
| mode
->sync
, DI_DISP_SIG_POL
);
461 writel(fmt_cfg
[di_setup
].b0
, DI_DISP3_B0_MAP
);
462 writel(fmt_cfg
[di_setup
].b1
, DI_DISP3_B1_MAP
);
463 writel(fmt_cfg
[di_setup
].b2
, DI_DISP3_B2_MAP
);
464 writel(readl(DI_DISP_ACC_CC
) |
465 ((fmt_cfg
[di_setup
].acc
- 1) << 12), DI_DISP_ACC_CC
);
467 debug("DI_DISP_IF_CONF = 0x%08X\n", readl(DI_DISP_IF_CONF
));
468 debug("DI_DISP_SIG_POL = 0x%08X\n", readl(DI_DISP_SIG_POL
));
469 debug("DI_DISP3_TIME_CONF = 0x%08X\n", readl(DI_DISP3_TIME_CONF
));
470 debug("SDC_HOR_CONF = 0x%08X\n", readl(SDC_HOR_CONF
));
471 debug("SDC_VER_CONF = 0x%08X\n", readl(SDC_VER_CONF
));
476 static void ipu_ch_param_set_size(union chan_param_mem
*params
,
477 uint pixelfmt
, uint16_t width
,
478 uint16_t height
, uint16_t stride
)
480 debug("%s(pixelfmt=%d, width=%d, height=%d, stride=%d)\n",
481 __func__
, pixelfmt
, width
, height
, stride
);
483 params
->pp
.fw
= width
- 1;
484 params
->pp
.fh_l
= height
- 1;
485 params
->pp
.fh_h
= (height
- 1) >> 8;
486 params
->pp
.sl
= stride
- 1;
488 /* See above, for further formats see the Linux driver */
490 case GDF_16BIT_565RGB
:
494 params
->ip
.sat
= 2; /* SAT = 32-bit access */
495 params
->ip
.ofs0
= 0; /* Red bit offset */
496 params
->ip
.ofs1
= 5; /* Green bit offset */
497 params
->ip
.ofs2
= 11; /* Blue bit offset */
498 params
->ip
.ofs3
= 16; /* Alpha bit offset */
499 params
->ip
.wid0
= 4; /* Red bit width - 1 */
500 params
->ip
.wid1
= 5; /* Green bit width - 1 */
501 params
->ip
.wid2
= 4; /* Blue bit width - 1 */
503 case GDF_32BIT_X888RGB
:
504 params
->ip
.bpp
= 1; /* 24 BPP & RGB PFS */
507 params
->ip
.sat
= 2; /* SAT = 32-bit access */
508 params
->ip
.ofs0
= 16; /* Red bit offset */
509 params
->ip
.ofs1
= 8; /* Green bit offset */
510 params
->ip
.ofs2
= 0; /* Blue bit offset */
511 params
->ip
.ofs3
= 24; /* Alpha bit offset */
512 params
->ip
.wid0
= 7; /* Red bit width - 1 */
513 params
->ip
.wid1
= 7; /* Green bit width - 1 */
514 params
->ip
.wid2
= 7; /* Blue bit width - 1 */
517 printf("mx3fb: Pixel format not supported!\n");
524 static void ipu_ch_param_set_buffer(union chan_param_mem
*params
,
525 void *buf0
, void *buf1
)
527 params
->pp
.eba0
= (u32
)buf0
;
528 params
->pp
.eba1
= (u32
)buf1
;
531 static void ipu_write_param_mem(uint32_t addr
, uint32_t *data
,
534 for (; num_words
> 0; num_words
--) {
535 writel(addr
, IPU_IMA_ADDR
);
536 writel(*data
++, IPU_IMA_DATA
);
538 if ((addr
& 0x7) == 5) {
539 addr
&= ~0x7; /* set to word 0 */
540 addr
+= 8; /* increment to next row */
545 static uint32_t dma_param_addr(enum ipu_channel channel
)
547 /* Channel Parameter Memory */
548 return 0x10000 | (channel
<< 4);
551 static void ipu_init_channel_buffer(enum ipu_channel channel
, void *fbmem
)
553 union chan_param_mem params
= {};
555 uint32_t stride_bytes
;
557 stride_bytes
= (panel
.plnSizeX
* panel
.gdfBytesPP
+ 3) & ~3;
559 debug("%s(channel=%d, fbmem=%p)\n", __func__
, channel
, fbmem
);
561 /* Build parameter memory data for DMA channel */
562 ipu_ch_param_set_size(¶ms
, panel
.gdfIndex
,
563 panel
.plnSizeX
, panel
.plnSizeY
, stride_bytes
);
564 ipu_ch_param_set_buffer(¶ms
, fbmem
, NULL
);
566 /* Some channels (rotation) have restriction on burst length */
570 /* In original code only IPU_PIX_FMT_RGB565 was setting burst */
571 params
.pp
.npb
= 16 - 1;
577 ipu_write_param_mem(dma_param_addr(channel
), (uint32_t *)¶ms
, 10);
579 /* Disable double-buffering */
580 reg
= readl(IPU_CHA_DB_MODE_SEL
);
581 reg
&= ~(1UL << channel
);
582 writel(reg
, IPU_CHA_DB_MODE_SEL
);
585 static void ipu_channel_set_priority(enum ipu_channel channel
,
588 u32 reg
= readl(IDMAC_CHA_PRI
);
591 reg
|= 1UL << channel
;
593 reg
&= ~(1UL << channel
);
595 writel(reg
, IDMAC_CHA_PRI
);
599 * ipu_enable_channel() - enable an IPU channel.
600 * @channel: channel ID.
601 * @return: 0 on success or negative error code on failure.
603 static int ipu_enable_channel(enum ipu_channel channel
)
607 /* Reset to buffer 0 */
608 writel(1UL << channel
, IPU_CHA_CUR_BUF
);
612 ipu_channel_set_priority(channel
, 1);
618 reg
= readl(IDMAC_CHA_EN
);
619 writel(reg
| (1UL << channel
), IDMAC_CHA_EN
);
624 static int ipu_update_channel_buffer(enum ipu_channel channel
, void *buf
)
628 reg
= readl(IPU_CHA_BUF0_RDY
);
629 if (reg
& (1UL << channel
))
632 /* 44.3.3.1.9 - Row Number 1 (WORD1, offset 0) */
633 writel(dma_param_addr(channel
) + 0x0008UL
, IPU_IMA_ADDR
);
634 writel((u32
)buf
, IPU_IMA_DATA
);
639 static int idmac_tx_submit(enum ipu_channel channel
, void *buf
)
643 ipu_init_channel_buffer(channel
, buf
);
646 /* ipu_idmac.c::ipu_submit_channel_buffers() */
647 ret
= ipu_update_channel_buffer(channel
, buf
);
651 /* ipu_idmac.c::ipu_select_buffer() */
652 /* Mark buffer 0 as ready. */
653 writel(1UL << channel
, IPU_CHA_BUF0_RDY
);
656 ret
= ipu_enable_channel(channel
);
660 static void sdc_enable_channel(void *fbmem
)
665 ret
= idmac_tx_submit(IDMAC_SDC_0
, fbmem
);
667 /* mx3fb.c::sdc_fb_init() */
669 reg
= readl(SDC_COM_CONF
);
670 writel(reg
| SDC_COM_BG_EN
, SDC_COM_CONF
);
674 * Attention! Without this msleep the channel keeps generating
675 * interrupts. Next sdc_set_brightness() is going to be called
676 * from mx3fb_blank().
682 * mx3fb_set_par() - set framebuffer parameters and change the operating mode.
683 * @return: 0 on success or negative error code on failure.
684 * TODO: currently only 666 and TFT as DI setup supported
686 static int mx3fb_set_par(void)
690 ret
= sdc_init_panel(panel
.plnSizeX
, panel
.plnSizeY
,
691 IPU_PIX_FMT_RGB666
, IPU_PANEL_TFT
);
695 writel((mode
->left_margin
<< 16) | mode
->upper_margin
, SDC_BG_POS
);
700 static void ll_disp3_enable(void *base
)
704 debug("%s(base=0x%x)\n", __func__
, (u32
) base
);
705 /* pcm037.c::mxc_board_init() */
707 /* Display Interface #3 */
708 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD0
, MUX_CTL_FUNC
));
709 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD1
, MUX_CTL_FUNC
));
710 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD2
, MUX_CTL_FUNC
));
711 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD3
, MUX_CTL_FUNC
));
712 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD4
, MUX_CTL_FUNC
));
713 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD5
, MUX_CTL_FUNC
));
714 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD6
, MUX_CTL_FUNC
));
715 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD7
, MUX_CTL_FUNC
));
716 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD8
, MUX_CTL_FUNC
));
717 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD9
, MUX_CTL_FUNC
));
718 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD10
, MUX_CTL_FUNC
));
719 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD11
, MUX_CTL_FUNC
));
720 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD12
, MUX_CTL_FUNC
));
721 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD13
, MUX_CTL_FUNC
));
722 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD14
, MUX_CTL_FUNC
));
723 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD15
, MUX_CTL_FUNC
));
724 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD16
, MUX_CTL_FUNC
));
725 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_LD17
, MUX_CTL_FUNC
));
726 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_VSYNC3
, MUX_CTL_FUNC
));
727 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_HSYNC
, MUX_CTL_FUNC
));
728 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_FPSHIFT
, MUX_CTL_FUNC
));
729 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_DRDY0
, MUX_CTL_FUNC
));
730 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_D3_REV
, MUX_CTL_FUNC
));
731 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_CONTRAST
, MUX_CTL_FUNC
));
732 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_D3_SPL
, MUX_CTL_FUNC
));
733 mx31_gpio_mux(IOMUX_MODE_L(MX31_PIN_D3_CLS
, MUX_CTL_FUNC
));
736 /* ipu_idmac.c::ipu_probe() */
738 /* Start the clock */
739 __REG(CCM_CGR1
) = __REG(CCM_CGR1
) | (3 << 22);
742 /* ipu_idmac.c::ipu_idmac_init() */
744 /* Service request counter to maximum - shouldn't be needed */
745 writel(0x00000070, IDMAC_CONF
);
748 /* ipu_idmac.c::ipu_init_channel() */
750 /* Enable IPU sub modules */
751 reg
= readl(IPU_CONF
) | IPU_CONF_SDC_EN
| IPU_CONF_DI_EN
;
752 writel(reg
, IPU_CONF
);
755 /* mx3fb.c::init_fb_chan() */
757 /* set Display Interface clock period */
758 writel(0x00100010L
, DI_HSP_CLK_PER
);
759 /* Might need to trigger HSP clock change - see 44.3.3.8.5 */
762 /* mx3fb.c::sdc_set_brightness() */
764 /* This might be board-specific */
765 writel(0x03000000UL
| 255 << 16, SDC_PWM_CTRL
);
768 /* mx3fb.c::sdc_set_global_alpha() */
770 /* Use global - not per-pixel - Alpha-blending */
771 reg
= readl(SDC_GW_CTRL
) & 0x00FFFFFFL
;
772 writel(reg
| ((uint32_t) 0xff << 24), SDC_GW_CTRL
);
774 reg
= readl(SDC_COM_CONF
);
775 writel(reg
| SDC_COM_GLB_A
, SDC_COM_CONF
);
778 /* mx3fb.c::sdc_set_color_key() */
780 /* Disable colour-keying for background */
781 reg
= readl(SDC_COM_CONF
) &
782 ~(SDC_COM_GWSEL
| SDC_COM_KEY_COLOR_G
);
783 writel(reg
, SDC_COM_CONF
);
788 sdc_enable_channel(base
);
791 * Linux driver calls sdc_set_brightness() here again,
792 * once is enough for us
794 debug("%s() done\n", __func__
);
797 /* ------------------------ public part ------------------- */
798 ulong
calc_fbsize(void)
800 return panel
.plnSizeX
* panel
.plnSizeY
* panel
.gdfBytesPP
;
804 * The current implementation is only tested for GDF_16BIT_565RGB!
805 * It was switched from the original CONFIG_LCD setup to CONFIG_VIDEO,
806 * because the lcd code seemed loaded with color table stuff, that
807 * does not relate to most modern TFTs. cfb_console.c looks more
809 * This is the environment setting for the original setup
810 * "unknown=video=ctfb:x:240,y:320,depth:16,mode:0,pclk:185925,le:9,ri:17,
811 * up:7,lo:10,hs:1,vs:1,sync:100663296,vmode:0"
812 * "videomode=unknown"
814 * Settings for VBEST VGG322403 display:
815 * "videomode=video=ctfb:x:320,y:240,depth:16,mode:0,pclk:156000,
816 * "le:20,ri:68,up:7,lo:29,hs:30,vs:3,sync:100663296,vmode:0"
818 * Settings for COM57H5M10XRC display:
819 * "videomode=video=ctfb:x:640,y:480,depth:16,mode:0,pclk:40000,
820 * "le:120,ri:40,up:35,lo:10,hs:30,vs:3,sync:100663296,vmode:0"
822 void *video_hw_init(void)
826 unsigned long t1
, hsynch
, vsynch
;
827 int bits_per_pixel
, i
, tmp
, vesa_idx
= 0, videomode
;
833 videomode
= CONFIG_SYS_DEFAULT_VIDEO_MODE
;
834 /* get video mode via environment */
835 penv
= getenv("videomode");
837 /* decide if it is a string */
838 if (penv
[0] <= '9') {
839 videomode
= (int) simple_strtoul(penv
, NULL
, 16);
846 /* parameter are vesa modes */
848 for (i
= 0; i
< VESA_MODES_COUNT
; i
++) {
849 if (vesa_modes
[i
].vesanr
== videomode
)
852 if (i
== VESA_MODES_COUNT
) {
853 printf("No VESA Mode found, switching to mode 0x%x ",
854 CONFIG_SYS_DEFAULT_VIDEO_MODE
);
857 mode
= (struct ctfb_res_modes
*)
858 &res_mode_init
[vesa_modes
[i
].resindex
];
859 bits_per_pixel
= vesa_modes
[i
].bits_per_pixel
;
860 vesa_idx
= vesa_modes
[i
].resindex
;
862 mode
= (struct ctfb_res_modes
*) &var_mode
;
863 bits_per_pixel
= video_get_params(mode
, penv
);
866 /* calculate hsynch and vsynch freq (info only) */
867 t1
= (mode
->left_margin
+ mode
->xres
+
868 mode
->right_margin
+ mode
->hsync_len
) / 8;
870 t1
*= mode
->pixclock
;
872 hsynch
= 1000000000L / t1
;
873 t1
*= (mode
->upper_margin
+ mode
->yres
+
874 mode
->lower_margin
+ mode
->vsync_len
);
876 vsynch
= 1000000000L / t1
;
878 /* fill in Graphic device struct */
879 sprintf(panel
.modeIdent
, "%dx%dx%d %ldkHz %ldHz",
880 mode
->xres
, mode
->yres
,
881 bits_per_pixel
, (hsynch
/ 1000), (vsynch
/ 1000));
882 printf("%s\n", panel
.modeIdent
);
883 panel
.winSizeX
= mode
->xres
;
884 panel
.winSizeY
= mode
->yres
;
885 panel
.plnSizeX
= mode
->xres
;
886 panel
.plnSizeY
= mode
->yres
;
888 switch (bits_per_pixel
) {
890 panel
.gdfBytesPP
= 4;
891 panel
.gdfIndex
= GDF_32BIT_X888RGB
;
894 panel
.gdfBytesPP
= 2;
895 panel
.gdfIndex
= GDF_16BIT_565RGB
;
898 panel
.gdfBytesPP
= 1;
899 panel
.gdfIndex
= GDF__8BIT_INDEX
;
903 /* set up Hardware */
904 memsize
= calc_fbsize();
906 debug("%s() allocating %d bytes\n", __func__
, memsize
);
908 /* fill in missing Graphic device struct */
909 panel
.frameAdrs
= (u32
) malloc(memsize
);
910 if (panel
.frameAdrs
== 0) {
911 printf("%s() malloc(%d) failed\n", __func__
, memsize
);
914 panel
.memSize
= memsize
;
916 ll_disp3_enable((void *) panel
.frameAdrs
);
917 memset((void *) panel
.frameAdrs
, 0, memsize
);
919 debug("%s() done, framebuffer at 0x%x, size=%d cleared\n",
920 __func__
, panel
.frameAdrs
, memsize
);
922 return (void *) &panel
;
925 void video_set_lut(unsigned int index
, /* color number */
926 unsigned char r
, /* red */
927 unsigned char g
, /* green */
928 unsigned char b
/* blue */