/* * Freescale i.MX23/i.MX28 LCDIF driver * * Copyright (C) 2011-2013 Marek Vasut * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, * MA 02111-1307 USA */ #include #include #include #include #include #include #include #include #include "videomodes.h" #define PS2KHZ(ps) (1000000000UL / (ps)) static GraphicDevice panel; void writexxx(uint32_t payload, int data) { struct mxs_lcdif_regs *regs = (struct mxs_lcdif_regs *)MXS_LCDIF_BASE; while (readl(®s->hw_lcdif_ctrl) & LCDIF_CTRL_RUN); writel(0x10001, ®s->hw_lcdif_transfer_count); writel(LCDIF_CTRL_DATA_SELECT | LCDIF_CTRL_RUN, ®s->hw_lcdif_ctrl_clr); if (data)//XXX writel(LCDIF_CTRL_DATA_SELECT, ®s->hw_lcdif_ctrl_set); writel(LCDIF_CTRL_RUN, ®s->hw_lcdif_ctrl_set); while (readl(®s->hw_lcdif_lcdif_stat) & (1 << 29)); writel(payload, ®s->hw_lcdif_data); while (readl(®s->hw_lcdif_ctrl) & LCDIF_CTRL_RUN); } void writereg(uint32_t reg, uint32_t data) { writexxx(reg, 0); writexxx(data, 1); } /* * DENX M28EVK: * setenv videomode * video=ctfb:x:800,y:480,depth:18,mode:0,pclk:30066, * le:0,ri:256,up:0,lo:45,hs:1,vs:1,sync:100663296,vmode:0 */ void mxs_lcd_init(GraphicDevice *panel, struct ctfb_res_modes *mode, int bpp) { struct mxs_lcdif_regs *regs = (struct mxs_lcdif_regs *)MXS_LCDIF_BASE; uint32_t word_len = 0, bus_width = 0; uint8_t valid_data = 0; /* Kick in the LCDIF clock */ #if 0 mxs_set_lcdclk(/*PS2KHZ(mode->pixclock)*/24000); #endif writeb(0x92, 0x800400f2);//PIX writel(0x1, 0x80040060);//PIX writel(0x2, 0x80040114);//BYPASS_PIX writeb(0x12, 0x800400f2);//PIX /* Restart the LCDIF block */ mxs_reset_block(®s->hw_lcdif_ctrl_reg); switch (bpp) { case 24: word_len = LCDIF_CTRL_WORD_LENGTH_24BIT; bus_width = LCDIF_CTRL_LCD_DATABUS_WIDTH_24BIT; valid_data = 0x7; break; case 18: word_len = LCDIF_CTRL_WORD_LENGTH_24BIT; bus_width = LCDIF_CTRL_LCD_DATABUS_WIDTH_18BIT; valid_data = 0x7; break; case 16: word_len = LCDIF_CTRL_WORD_LENGTH_16BIT; bus_width = LCDIF_CTRL_LCD_DATABUS_WIDTH_16BIT; valid_data = 0xf; break; case 8: word_len = LCDIF_CTRL_WORD_LENGTH_8BIT; bus_width = LCDIF_CTRL_LCD_DATABUS_WIDTH_8BIT; valid_data = 0xf; break; } writel(bus_width | word_len /*| LCDIF_CTRL_DOTCLK_MODE | LCDIF_CTRL_BYPASS_COUNT | LCDIF_CTRL_LCDIF_MASTER*/, ®s->hw_lcdif_ctrl); mdelay(50); writel(1, ®s->hw_lcdif_ctrl1_set); mdelay(50); writel(1, ®s->hw_lcdif_ctrl1_clr); mdelay(50); writel(1, ®s->hw_lcdif_ctrl1_set); mdelay(50); writel((valid_data << LCDIF_CTRL1_BYTE_PACKING_FORMAT_OFFSET) | 1, ®s->hw_lcdif_ctrl1); /* Program the junker */ writel(LCDIF_CTRL1_RECOVER_ON_UNDERFLOW, ®s->hw_lcdif_ctrl1_set); writel(0x03030202, ®s->hw_lcdif_timing); writereg(1, 0x01c); writereg(2, 0x100); writereg(3, 0x1038 /* 0x30 flips the LCD */); writereg(8, 0x808); writereg(0xc, 0x0/*x111*/); writereg(0xf, 0xc01); writereg(0x20, 0); writereg(0x21, 0); mdelay(30); writereg(0x10, 0xa00); writereg(0x11, 0x1038); mdelay(30); writereg(0x12, 0x1010); writereg(0x13, 0x50); writereg(0x14, 0x4f58); writereg(0x30, 0); writereg(0x31, 0xdb); writereg(0x32, 0); writereg(0x33, 0); writereg(0x34, 0xdb); writereg(0x35, 0); writereg(0x36, 0xaf); writereg(0x37, 0); writereg(0x38, 0xdb); writereg(0x39, 0); writereg(0x50, 0); writereg(0x51, 0x705); writereg(0x52, 0xe0a); writereg(0x53, 0x300); writereg(0x54, 0xa0e); writereg(0x55, 0x507); writereg(0x56, 0); writereg(0x57, 3); writereg(0x58, 0x90a); writereg(0x59, 0xa09); mdelay(30); writereg(7, 0x1017); mdelay(40); //-- writereg(0x36, 0xaf); writereg(0x37, 0); writereg(0x38, 0xdb); writereg(0x39, 0); writereg(0x20, 0); writereg(0x21, 0); // int i; // for (i = 0; i < 38720; i++) // writereg(0x22, ((uint16_t *)panel->frameAdrs)[i]); writexxx(0x22, 0); writel(LCDIF_CTRL_DATA_SELECT, ®s->hw_lcdif_ctrl_set); // writel((mode->yres << LCDIF_TRANSFER_COUNT_V_COUNT_OFFSET) | mode->xres, // ®s->hw_lcdif_transfer_count); /* writel(LCDIF_VDCTRL0_ENABLE_PRESENT | LCDIF_VDCTRL0_ENABLE_POL | LCDIF_VDCTRL0_VSYNC_PERIOD_UNIT | LCDIF_VDCTRL0_VSYNC_PULSE_WIDTH_UNIT | mode->vsync_len, ®s->hw_lcdif_vdctrl0); writel(mode->upper_margin + mode->lower_margin + mode->vsync_len + mode->yres, ®s->hw_lcdif_vdctrl1); writel((mode->hsync_len << LCDIF_VDCTRL2_HSYNC_PULSE_WIDTH_OFFSET) | (mode->left_margin + mode->right_margin + mode->hsync_len + mode->xres), ®s->hw_lcdif_vdctrl2); writel(((mode->left_margin + mode->hsync_len) << LCDIF_VDCTRL3_HORIZONTAL_WAIT_CNT_OFFSET) | (mode->upper_margin + mode->vsync_len), ®s->hw_lcdif_vdctrl3); writel((0 << LCDIF_VDCTRL4_DOTCLK_DLY_SEL_OFFSET) | mode->xres, ®s->hw_lcdif_vdctrl4); */ writel(panel->frameAdrs, ®s->hw_lcdif_cur_buf); writel(panel->frameAdrs, ®s->hw_lcdif_next_buf); /* Flush FIFO first */ writel(LCDIF_CTRL1_FIFO_CLEAR, ®s->hw_lcdif_ctrl1_set); /* Sync signals ON */ // setbits_le32(®s->hw_lcdif_vdctrl4, LCDIF_VDCTRL4_SYNC_SIGNALS_ON); /* FIFO cleared */ writel(LCDIF_CTRL1_FIFO_CLEAR, ®s->hw_lcdif_ctrl1_clr); // FIXME writel((mode->yres << LCDIF_TRANSFER_COUNT_V_COUNT_OFFSET) | mode->xres, ®s->hw_lcdif_transfer_count); writel(bus_width | word_len | /* LCDIF_CTRL_BYPASS_COUNT | */LCDIF_CTRL_LCDIF_MASTER, ®s->hw_lcdif_ctrl_set); /* flick_lcd(); flick_lcd(); */ /* RUN! */ writel(LCDIF_CTRL_RUN, ®s->hw_lcdif_ctrl_set); } void mxsfb_run(void) { struct mxs_lcdif_regs *regs = (struct mxs_lcdif_regs *)MXS_LCDIF_BASE; writel(LCDIF_CTRL_RUN, ®s->hw_lcdif_ctrl_set); } void *video_hw_init(void) { int bpp = -1; char *penv = "video=ctfb:x:176,y:220,depth:16,mode:0,pclk:30066,le:0,ri:256,up:0,lo:45,hs:1,vs:1,sync:100663296,vmode:0"; void *fb; struct ctfb_res_modes mode; puts("Video: "); /* Suck display configuration from "videomode" variable */ /* penv = getenv("videomode"); if (!penv) { printf("MXSFB: 'videomode' variable not set!"); return NULL; } */ bpp = video_get_params(&mode, penv); /* fill in Graphic device struct */ sprintf(panel.modeIdent, "%dx%dx%d", mode.xres, mode.yres, bpp); mode.xres = 220; mode.yres = 176; bpp = 16; panel.winSizeX = mode.xres; panel.winSizeY = mode.yres; panel.plnSizeX = mode.xres; panel.plnSizeY = mode.yres; switch (bpp) { case 24: case 18: panel.gdfBytesPP = 4; panel.gdfIndex = GDF_32BIT_X888RGB; break; case 16: panel.gdfBytesPP = 2; panel.gdfIndex = GDF_16BIT_565RGB; break; case 8: panel.gdfBytesPP = 1; panel.gdfIndex = GDF__8BIT_INDEX; break; default: printf("MXSFB: Invalid BPP specified! (bpp = %i)\n", bpp); return NULL; } panel.memSize = mode.xres * mode.yres * panel.gdfBytesPP; /* Allocate framebuffer */ fb = malloc(panel.memSize); if (!fb) { printf("MXSFB: Error allocating framebuffer!\n"); return NULL; } /* Wipe framebuffer */ memset(fb, 0, panel.memSize); panel.frameAdrs = (u32)fb; printf("%s\n", panel.modeIdent); /* Start framebuffer */ mxs_lcd_init(&panel, &mode, bpp); return (void *)&panel; }