18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * OMAP1 internal LCD controller 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2004 Nokia Corporation 68c2ecf20Sopenharmony_ci * Author: Imre Deak <imre.deak@nokia.com> 78c2ecf20Sopenharmony_ci */ 88c2ecf20Sopenharmony_ci#include <linux/module.h> 98c2ecf20Sopenharmony_ci#include <linux/device.h> 108c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 118c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 128c2ecf20Sopenharmony_ci#include <linux/err.h> 138c2ecf20Sopenharmony_ci#include <linux/mm.h> 148c2ecf20Sopenharmony_ci#include <linux/fb.h> 158c2ecf20Sopenharmony_ci#include <linux/dma-mapping.h> 168c2ecf20Sopenharmony_ci#include <linux/vmalloc.h> 178c2ecf20Sopenharmony_ci#include <linux/clk.h> 188c2ecf20Sopenharmony_ci#include <linux/gfp.h> 198c2ecf20Sopenharmony_ci 208c2ecf20Sopenharmony_ci#include <mach/lcdc.h> 218c2ecf20Sopenharmony_ci#include <linux/omap-dma.h> 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ci#include <asm/mach-types.h> 248c2ecf20Sopenharmony_ci 258c2ecf20Sopenharmony_ci#include "omapfb.h" 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci#include "lcdc.h" 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_ci#define MODULE_NAME "lcdc" 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci#define MAX_PALETTE_SIZE PAGE_SIZE 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_cienum lcdc_load_mode { 348c2ecf20Sopenharmony_ci OMAP_LCDC_LOAD_PALETTE, 358c2ecf20Sopenharmony_ci OMAP_LCDC_LOAD_FRAME, 368c2ecf20Sopenharmony_ci OMAP_LCDC_LOAD_PALETTE_AND_FRAME 378c2ecf20Sopenharmony_ci}; 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_cistatic struct omap_lcd_controller { 408c2ecf20Sopenharmony_ci enum omapfb_update_mode update_mode; 418c2ecf20Sopenharmony_ci int ext_mode; 428c2ecf20Sopenharmony_ci 438c2ecf20Sopenharmony_ci unsigned long frame_offset; 448c2ecf20Sopenharmony_ci int screen_width; 458c2ecf20Sopenharmony_ci int xres; 468c2ecf20Sopenharmony_ci int yres; 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci enum omapfb_color_format color_mode; 498c2ecf20Sopenharmony_ci int bpp; 508c2ecf20Sopenharmony_ci void *palette_virt; 518c2ecf20Sopenharmony_ci dma_addr_t palette_phys; 528c2ecf20Sopenharmony_ci int palette_code; 538c2ecf20Sopenharmony_ci int palette_size; 548c2ecf20Sopenharmony_ci 558c2ecf20Sopenharmony_ci unsigned int irq_mask; 568c2ecf20Sopenharmony_ci struct completion last_frame_complete; 578c2ecf20Sopenharmony_ci struct completion palette_load_complete; 588c2ecf20Sopenharmony_ci struct clk *lcd_ck; 598c2ecf20Sopenharmony_ci struct omapfb_device *fbdev; 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_ci void (*dma_callback)(void *data); 628c2ecf20Sopenharmony_ci void *dma_callback_data; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci dma_addr_t vram_phys; 658c2ecf20Sopenharmony_ci void *vram_virt; 668c2ecf20Sopenharmony_ci unsigned long vram_size; 678c2ecf20Sopenharmony_ci} lcdc; 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_cistatic inline void enable_irqs(int mask) 708c2ecf20Sopenharmony_ci{ 718c2ecf20Sopenharmony_ci lcdc.irq_mask |= mask; 728c2ecf20Sopenharmony_ci} 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_cistatic inline void disable_irqs(int mask) 758c2ecf20Sopenharmony_ci{ 768c2ecf20Sopenharmony_ci lcdc.irq_mask &= ~mask; 778c2ecf20Sopenharmony_ci} 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_cistatic void set_load_mode(enum lcdc_load_mode mode) 808c2ecf20Sopenharmony_ci{ 818c2ecf20Sopenharmony_ci u32 l; 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_CONTROL); 848c2ecf20Sopenharmony_ci l &= ~(3 << 20); 858c2ecf20Sopenharmony_ci switch (mode) { 868c2ecf20Sopenharmony_ci case OMAP_LCDC_LOAD_PALETTE: 878c2ecf20Sopenharmony_ci l |= 1 << 20; 888c2ecf20Sopenharmony_ci break; 898c2ecf20Sopenharmony_ci case OMAP_LCDC_LOAD_FRAME: 908c2ecf20Sopenharmony_ci l |= 2 << 20; 918c2ecf20Sopenharmony_ci break; 928c2ecf20Sopenharmony_ci case OMAP_LCDC_LOAD_PALETTE_AND_FRAME: 938c2ecf20Sopenharmony_ci break; 948c2ecf20Sopenharmony_ci default: 958c2ecf20Sopenharmony_ci BUG(); 968c2ecf20Sopenharmony_ci } 978c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 988c2ecf20Sopenharmony_ci} 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_cistatic void enable_controller(void) 1018c2ecf20Sopenharmony_ci{ 1028c2ecf20Sopenharmony_ci u32 l; 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_CONTROL); 1058c2ecf20Sopenharmony_ci l |= OMAP_LCDC_CTRL_LCD_EN; 1068c2ecf20Sopenharmony_ci l &= ~OMAP_LCDC_IRQ_MASK; 1078c2ecf20Sopenharmony_ci l |= lcdc.irq_mask | OMAP_LCDC_IRQ_DONE; /* enabled IRQs */ 1088c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 1098c2ecf20Sopenharmony_ci} 1108c2ecf20Sopenharmony_ci 1118c2ecf20Sopenharmony_cistatic void disable_controller_async(void) 1128c2ecf20Sopenharmony_ci{ 1138c2ecf20Sopenharmony_ci u32 l; 1148c2ecf20Sopenharmony_ci u32 mask; 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_CONTROL); 1178c2ecf20Sopenharmony_ci mask = OMAP_LCDC_CTRL_LCD_EN | OMAP_LCDC_IRQ_MASK; 1188c2ecf20Sopenharmony_ci /* 1198c2ecf20Sopenharmony_ci * Preserve the DONE mask, since we still want to get the 1208c2ecf20Sopenharmony_ci * final DONE irq. It will be disabled in the IRQ handler. 1218c2ecf20Sopenharmony_ci */ 1228c2ecf20Sopenharmony_ci mask &= ~OMAP_LCDC_IRQ_DONE; 1238c2ecf20Sopenharmony_ci l &= ~mask; 1248c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 1258c2ecf20Sopenharmony_ci} 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_cistatic void disable_controller(void) 1288c2ecf20Sopenharmony_ci{ 1298c2ecf20Sopenharmony_ci init_completion(&lcdc.last_frame_complete); 1308c2ecf20Sopenharmony_ci disable_controller_async(); 1318c2ecf20Sopenharmony_ci if (!wait_for_completion_timeout(&lcdc.last_frame_complete, 1328c2ecf20Sopenharmony_ci msecs_to_jiffies(500))) 1338c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "timeout waiting for FRAME DONE\n"); 1348c2ecf20Sopenharmony_ci} 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_cistatic void reset_controller(u32 status) 1378c2ecf20Sopenharmony_ci{ 1388c2ecf20Sopenharmony_ci static unsigned long reset_count; 1398c2ecf20Sopenharmony_ci static unsigned long last_jiffies; 1408c2ecf20Sopenharmony_ci 1418c2ecf20Sopenharmony_ci disable_controller_async(); 1428c2ecf20Sopenharmony_ci reset_count++; 1438c2ecf20Sopenharmony_ci if (reset_count == 1 || time_after(jiffies, last_jiffies + HZ)) { 1448c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, 1458c2ecf20Sopenharmony_ci "resetting (status %#010x,reset count %lu)\n", 1468c2ecf20Sopenharmony_ci status, reset_count); 1478c2ecf20Sopenharmony_ci last_jiffies = jiffies; 1488c2ecf20Sopenharmony_ci } 1498c2ecf20Sopenharmony_ci if (reset_count < 100) { 1508c2ecf20Sopenharmony_ci enable_controller(); 1518c2ecf20Sopenharmony_ci } else { 1528c2ecf20Sopenharmony_ci reset_count = 0; 1538c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, 1548c2ecf20Sopenharmony_ci "too many reset attempts, giving up.\n"); 1558c2ecf20Sopenharmony_ci } 1568c2ecf20Sopenharmony_ci} 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_ci/* 1598c2ecf20Sopenharmony_ci * Configure the LCD DMA according to the current mode specified by parameters 1608c2ecf20Sopenharmony_ci * in lcdc.fbdev and fbdev->var. 1618c2ecf20Sopenharmony_ci */ 1628c2ecf20Sopenharmony_cistatic void setup_lcd_dma(void) 1638c2ecf20Sopenharmony_ci{ 1648c2ecf20Sopenharmony_ci static const int dma_elem_type[] = { 1658c2ecf20Sopenharmony_ci 0, 1668c2ecf20Sopenharmony_ci OMAP_DMA_DATA_TYPE_S8, 1678c2ecf20Sopenharmony_ci OMAP_DMA_DATA_TYPE_S16, 1688c2ecf20Sopenharmony_ci 0, 1698c2ecf20Sopenharmony_ci OMAP_DMA_DATA_TYPE_S32, 1708c2ecf20Sopenharmony_ci }; 1718c2ecf20Sopenharmony_ci struct omapfb_plane_struct *plane = lcdc.fbdev->fb_info[0]->par; 1728c2ecf20Sopenharmony_ci struct fb_var_screeninfo *var = &lcdc.fbdev->fb_info[0]->var; 1738c2ecf20Sopenharmony_ci unsigned long src; 1748c2ecf20Sopenharmony_ci int esize, xelem, yelem; 1758c2ecf20Sopenharmony_ci 1768c2ecf20Sopenharmony_ci src = lcdc.vram_phys + lcdc.frame_offset; 1778c2ecf20Sopenharmony_ci 1788c2ecf20Sopenharmony_ci switch (var->rotate) { 1798c2ecf20Sopenharmony_ci case 0: 1808c2ecf20Sopenharmony_ci if (plane->info.mirror || (src & 3) || 1818c2ecf20Sopenharmony_ci lcdc.color_mode == OMAPFB_COLOR_YUV420 || 1828c2ecf20Sopenharmony_ci (lcdc.xres & 1)) 1838c2ecf20Sopenharmony_ci esize = 2; 1848c2ecf20Sopenharmony_ci else 1858c2ecf20Sopenharmony_ci esize = 4; 1868c2ecf20Sopenharmony_ci xelem = lcdc.xres * lcdc.bpp / 8 / esize; 1878c2ecf20Sopenharmony_ci yelem = lcdc.yres; 1888c2ecf20Sopenharmony_ci break; 1898c2ecf20Sopenharmony_ci case 90: 1908c2ecf20Sopenharmony_ci case 180: 1918c2ecf20Sopenharmony_ci case 270: 1928c2ecf20Sopenharmony_ci if (cpu_is_omap15xx()) { 1938c2ecf20Sopenharmony_ci BUG(); 1948c2ecf20Sopenharmony_ci } 1958c2ecf20Sopenharmony_ci esize = 2; 1968c2ecf20Sopenharmony_ci xelem = lcdc.yres * lcdc.bpp / 16; 1978c2ecf20Sopenharmony_ci yelem = lcdc.xres; 1988c2ecf20Sopenharmony_ci break; 1998c2ecf20Sopenharmony_ci default: 2008c2ecf20Sopenharmony_ci BUG(); 2018c2ecf20Sopenharmony_ci return; 2028c2ecf20Sopenharmony_ci } 2038c2ecf20Sopenharmony_ci#ifdef VERBOSE 2048c2ecf20Sopenharmony_ci dev_dbg(lcdc.fbdev->dev, 2058c2ecf20Sopenharmony_ci "setup_dma: src %#010lx esize %d xelem %d yelem %d\n", 2068c2ecf20Sopenharmony_ci src, esize, xelem, yelem); 2078c2ecf20Sopenharmony_ci#endif 2088c2ecf20Sopenharmony_ci omap_set_lcd_dma_b1(src, xelem, yelem, dma_elem_type[esize]); 2098c2ecf20Sopenharmony_ci if (!cpu_is_omap15xx()) { 2108c2ecf20Sopenharmony_ci int bpp = lcdc.bpp; 2118c2ecf20Sopenharmony_ci 2128c2ecf20Sopenharmony_ci /* 2138c2ecf20Sopenharmony_ci * YUV support is only for external mode when we have the 2148c2ecf20Sopenharmony_ci * YUV window embedded in a 16bpp frame buffer. 2158c2ecf20Sopenharmony_ci */ 2168c2ecf20Sopenharmony_ci if (lcdc.color_mode == OMAPFB_COLOR_YUV420) 2178c2ecf20Sopenharmony_ci bpp = 16; 2188c2ecf20Sopenharmony_ci /* Set virtual xres elem size */ 2198c2ecf20Sopenharmony_ci omap_set_lcd_dma_b1_vxres( 2208c2ecf20Sopenharmony_ci lcdc.screen_width * bpp / 8 / esize); 2218c2ecf20Sopenharmony_ci /* Setup transformations */ 2228c2ecf20Sopenharmony_ci omap_set_lcd_dma_b1_rotation(var->rotate); 2238c2ecf20Sopenharmony_ci omap_set_lcd_dma_b1_mirror(plane->info.mirror); 2248c2ecf20Sopenharmony_ci } 2258c2ecf20Sopenharmony_ci omap_setup_lcd_dma(); 2268c2ecf20Sopenharmony_ci} 2278c2ecf20Sopenharmony_ci 2288c2ecf20Sopenharmony_cistatic irqreturn_t lcdc_irq_handler(int irq, void *dev_id) 2298c2ecf20Sopenharmony_ci{ 2308c2ecf20Sopenharmony_ci u32 status; 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_ci status = omap_readl(OMAP_LCDC_STATUS); 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_ci if (status & (OMAP_LCDC_STAT_FUF | OMAP_LCDC_STAT_SYNC_LOST)) 2358c2ecf20Sopenharmony_ci reset_controller(status); 2368c2ecf20Sopenharmony_ci else { 2378c2ecf20Sopenharmony_ci if (status & OMAP_LCDC_STAT_DONE) { 2388c2ecf20Sopenharmony_ci u32 l; 2398c2ecf20Sopenharmony_ci 2408c2ecf20Sopenharmony_ci /* 2418c2ecf20Sopenharmony_ci * Disable IRQ_DONE. The status bit will be cleared 2428c2ecf20Sopenharmony_ci * only when the controller is reenabled and we don't 2438c2ecf20Sopenharmony_ci * want to get more interrupts. 2448c2ecf20Sopenharmony_ci */ 2458c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_CONTROL); 2468c2ecf20Sopenharmony_ci l &= ~OMAP_LCDC_IRQ_DONE; 2478c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 2488c2ecf20Sopenharmony_ci complete(&lcdc.last_frame_complete); 2498c2ecf20Sopenharmony_ci } 2508c2ecf20Sopenharmony_ci if (status & OMAP_LCDC_STAT_LOADED_PALETTE) { 2518c2ecf20Sopenharmony_ci disable_controller_async(); 2528c2ecf20Sopenharmony_ci complete(&lcdc.palette_load_complete); 2538c2ecf20Sopenharmony_ci } 2548c2ecf20Sopenharmony_ci } 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_ci /* 2578c2ecf20Sopenharmony_ci * Clear these interrupt status bits. 2588c2ecf20Sopenharmony_ci * Sync_lost, FUF bits were cleared by disabling the LCD controller 2598c2ecf20Sopenharmony_ci * LOADED_PALETTE can be cleared this way only in palette only 2608c2ecf20Sopenharmony_ci * load mode. In other load modes it's cleared by disabling the 2618c2ecf20Sopenharmony_ci * controller. 2628c2ecf20Sopenharmony_ci */ 2638c2ecf20Sopenharmony_ci status &= ~(OMAP_LCDC_STAT_VSYNC | 2648c2ecf20Sopenharmony_ci OMAP_LCDC_STAT_LOADED_PALETTE | 2658c2ecf20Sopenharmony_ci OMAP_LCDC_STAT_ABC | 2668c2ecf20Sopenharmony_ci OMAP_LCDC_STAT_LINE_INT); 2678c2ecf20Sopenharmony_ci omap_writel(status, OMAP_LCDC_STATUS); 2688c2ecf20Sopenharmony_ci return IRQ_HANDLED; 2698c2ecf20Sopenharmony_ci} 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ci/* 2728c2ecf20Sopenharmony_ci * Change to a new video mode. We defer this to a later time to avoid any 2738c2ecf20Sopenharmony_ci * flicker and not to mess up the current LCD DMA context. For this we disable 2748c2ecf20Sopenharmony_ci * the LCD controller, which will generate a DONE irq after the last frame has 2758c2ecf20Sopenharmony_ci * been transferred. Then it'll be safe to reconfigure both the LCD controller 2768c2ecf20Sopenharmony_ci * as well as the LCD DMA. 2778c2ecf20Sopenharmony_ci */ 2788c2ecf20Sopenharmony_cistatic int omap_lcdc_setup_plane(int plane, int channel_out, 2798c2ecf20Sopenharmony_ci unsigned long offset, int screen_width, 2808c2ecf20Sopenharmony_ci int pos_x, int pos_y, int width, int height, 2818c2ecf20Sopenharmony_ci int color_mode) 2828c2ecf20Sopenharmony_ci{ 2838c2ecf20Sopenharmony_ci struct fb_var_screeninfo *var = &lcdc.fbdev->fb_info[0]->var; 2848c2ecf20Sopenharmony_ci struct lcd_panel *panel = lcdc.fbdev->panel; 2858c2ecf20Sopenharmony_ci int rot_x, rot_y; 2868c2ecf20Sopenharmony_ci 2878c2ecf20Sopenharmony_ci if (var->rotate == 0) { 2888c2ecf20Sopenharmony_ci rot_x = panel->x_res; 2898c2ecf20Sopenharmony_ci rot_y = panel->y_res; 2908c2ecf20Sopenharmony_ci } else { 2918c2ecf20Sopenharmony_ci rot_x = panel->y_res; 2928c2ecf20Sopenharmony_ci rot_y = panel->x_res; 2938c2ecf20Sopenharmony_ci } 2948c2ecf20Sopenharmony_ci if (plane != 0 || channel_out != 0 || pos_x != 0 || pos_y != 0 || 2958c2ecf20Sopenharmony_ci width > rot_x || height > rot_y) { 2968c2ecf20Sopenharmony_ci#ifdef VERBOSE 2978c2ecf20Sopenharmony_ci dev_dbg(lcdc.fbdev->dev, 2988c2ecf20Sopenharmony_ci "invalid plane params plane %d pos_x %d pos_y %d " 2998c2ecf20Sopenharmony_ci "w %d h %d\n", plane, pos_x, pos_y, width, height); 3008c2ecf20Sopenharmony_ci#endif 3018c2ecf20Sopenharmony_ci return -EINVAL; 3028c2ecf20Sopenharmony_ci } 3038c2ecf20Sopenharmony_ci 3048c2ecf20Sopenharmony_ci lcdc.frame_offset = offset; 3058c2ecf20Sopenharmony_ci lcdc.xres = width; 3068c2ecf20Sopenharmony_ci lcdc.yres = height; 3078c2ecf20Sopenharmony_ci lcdc.screen_width = screen_width; 3088c2ecf20Sopenharmony_ci lcdc.color_mode = color_mode; 3098c2ecf20Sopenharmony_ci 3108c2ecf20Sopenharmony_ci switch (color_mode) { 3118c2ecf20Sopenharmony_ci case OMAPFB_COLOR_CLUT_8BPP: 3128c2ecf20Sopenharmony_ci lcdc.bpp = 8; 3138c2ecf20Sopenharmony_ci lcdc.palette_code = 0x3000; 3148c2ecf20Sopenharmony_ci lcdc.palette_size = 512; 3158c2ecf20Sopenharmony_ci break; 3168c2ecf20Sopenharmony_ci case OMAPFB_COLOR_RGB565: 3178c2ecf20Sopenharmony_ci lcdc.bpp = 16; 3188c2ecf20Sopenharmony_ci lcdc.palette_code = 0x4000; 3198c2ecf20Sopenharmony_ci lcdc.palette_size = 32; 3208c2ecf20Sopenharmony_ci break; 3218c2ecf20Sopenharmony_ci case OMAPFB_COLOR_RGB444: 3228c2ecf20Sopenharmony_ci lcdc.bpp = 16; 3238c2ecf20Sopenharmony_ci lcdc.palette_code = 0x4000; 3248c2ecf20Sopenharmony_ci lcdc.palette_size = 32; 3258c2ecf20Sopenharmony_ci break; 3268c2ecf20Sopenharmony_ci case OMAPFB_COLOR_YUV420: 3278c2ecf20Sopenharmony_ci if (lcdc.ext_mode) { 3288c2ecf20Sopenharmony_ci lcdc.bpp = 12; 3298c2ecf20Sopenharmony_ci break; 3308c2ecf20Sopenharmony_ci } 3318c2ecf20Sopenharmony_ci fallthrough; 3328c2ecf20Sopenharmony_ci case OMAPFB_COLOR_YUV422: 3338c2ecf20Sopenharmony_ci if (lcdc.ext_mode) { 3348c2ecf20Sopenharmony_ci lcdc.bpp = 16; 3358c2ecf20Sopenharmony_ci break; 3368c2ecf20Sopenharmony_ci } 3378c2ecf20Sopenharmony_ci fallthrough; 3388c2ecf20Sopenharmony_ci default: 3398c2ecf20Sopenharmony_ci /* FIXME: other BPPs. 3408c2ecf20Sopenharmony_ci * bpp1: code 0, size 256 3418c2ecf20Sopenharmony_ci * bpp2: code 0x1000 size 256 3428c2ecf20Sopenharmony_ci * bpp4: code 0x2000 size 256 3438c2ecf20Sopenharmony_ci * bpp12: code 0x4000 size 32 3448c2ecf20Sopenharmony_ci */ 3458c2ecf20Sopenharmony_ci dev_dbg(lcdc.fbdev->dev, "invalid color mode %d\n", color_mode); 3468c2ecf20Sopenharmony_ci BUG(); 3478c2ecf20Sopenharmony_ci return -1; 3488c2ecf20Sopenharmony_ci } 3498c2ecf20Sopenharmony_ci 3508c2ecf20Sopenharmony_ci if (lcdc.ext_mode) { 3518c2ecf20Sopenharmony_ci setup_lcd_dma(); 3528c2ecf20Sopenharmony_ci return 0; 3538c2ecf20Sopenharmony_ci } 3548c2ecf20Sopenharmony_ci 3558c2ecf20Sopenharmony_ci if (lcdc.update_mode == OMAPFB_AUTO_UPDATE) { 3568c2ecf20Sopenharmony_ci disable_controller(); 3578c2ecf20Sopenharmony_ci omap_stop_lcd_dma(); 3588c2ecf20Sopenharmony_ci setup_lcd_dma(); 3598c2ecf20Sopenharmony_ci enable_controller(); 3608c2ecf20Sopenharmony_ci } 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci return 0; 3638c2ecf20Sopenharmony_ci} 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_cistatic int omap_lcdc_enable_plane(int plane, int enable) 3668c2ecf20Sopenharmony_ci{ 3678c2ecf20Sopenharmony_ci dev_dbg(lcdc.fbdev->dev, 3688c2ecf20Sopenharmony_ci "plane %d enable %d update_mode %d ext_mode %d\n", 3698c2ecf20Sopenharmony_ci plane, enable, lcdc.update_mode, lcdc.ext_mode); 3708c2ecf20Sopenharmony_ci if (plane != OMAPFB_PLANE_GFX) 3718c2ecf20Sopenharmony_ci return -EINVAL; 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci return 0; 3748c2ecf20Sopenharmony_ci} 3758c2ecf20Sopenharmony_ci 3768c2ecf20Sopenharmony_ci/* 3778c2ecf20Sopenharmony_ci * Configure the LCD DMA for a palette load operation and do the palette 3788c2ecf20Sopenharmony_ci * downloading synchronously. We don't use the frame+palette load mode of 3798c2ecf20Sopenharmony_ci * the controller, since the palette can always be downloaded separately. 3808c2ecf20Sopenharmony_ci */ 3818c2ecf20Sopenharmony_cistatic void load_palette(void) 3828c2ecf20Sopenharmony_ci{ 3838c2ecf20Sopenharmony_ci u16 *palette; 3848c2ecf20Sopenharmony_ci 3858c2ecf20Sopenharmony_ci palette = (u16 *)lcdc.palette_virt; 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci *(u16 *)palette &= 0x0fff; 3888c2ecf20Sopenharmony_ci *(u16 *)palette |= lcdc.palette_code; 3898c2ecf20Sopenharmony_ci 3908c2ecf20Sopenharmony_ci omap_set_lcd_dma_b1(lcdc.palette_phys, 3918c2ecf20Sopenharmony_ci lcdc.palette_size / 4 + 1, 1, OMAP_DMA_DATA_TYPE_S32); 3928c2ecf20Sopenharmony_ci 3938c2ecf20Sopenharmony_ci omap_set_lcd_dma_single_transfer(1); 3948c2ecf20Sopenharmony_ci omap_setup_lcd_dma(); 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_ci init_completion(&lcdc.palette_load_complete); 3978c2ecf20Sopenharmony_ci enable_irqs(OMAP_LCDC_IRQ_LOADED_PALETTE); 3988c2ecf20Sopenharmony_ci set_load_mode(OMAP_LCDC_LOAD_PALETTE); 3998c2ecf20Sopenharmony_ci enable_controller(); 4008c2ecf20Sopenharmony_ci if (!wait_for_completion_timeout(&lcdc.palette_load_complete, 4018c2ecf20Sopenharmony_ci msecs_to_jiffies(500))) 4028c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "timeout waiting for FRAME DONE\n"); 4038c2ecf20Sopenharmony_ci /* The controller gets disabled in the irq handler */ 4048c2ecf20Sopenharmony_ci disable_irqs(OMAP_LCDC_IRQ_LOADED_PALETTE); 4058c2ecf20Sopenharmony_ci omap_stop_lcd_dma(); 4068c2ecf20Sopenharmony_ci 4078c2ecf20Sopenharmony_ci omap_set_lcd_dma_single_transfer(lcdc.ext_mode); 4088c2ecf20Sopenharmony_ci} 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_ci/* Used only in internal controller mode */ 4118c2ecf20Sopenharmony_cistatic int omap_lcdc_setcolreg(u_int regno, u16 red, u16 green, u16 blue, 4128c2ecf20Sopenharmony_ci u16 transp, int update_hw_pal) 4138c2ecf20Sopenharmony_ci{ 4148c2ecf20Sopenharmony_ci u16 *palette; 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_ci if (lcdc.color_mode != OMAPFB_COLOR_CLUT_8BPP || regno > 255) 4178c2ecf20Sopenharmony_ci return -EINVAL; 4188c2ecf20Sopenharmony_ci 4198c2ecf20Sopenharmony_ci palette = (u16 *)lcdc.palette_virt; 4208c2ecf20Sopenharmony_ci 4218c2ecf20Sopenharmony_ci palette[regno] &= ~0x0fff; 4228c2ecf20Sopenharmony_ci palette[regno] |= ((red >> 12) << 8) | ((green >> 12) << 4 ) | 4238c2ecf20Sopenharmony_ci (blue >> 12); 4248c2ecf20Sopenharmony_ci 4258c2ecf20Sopenharmony_ci if (update_hw_pal) { 4268c2ecf20Sopenharmony_ci disable_controller(); 4278c2ecf20Sopenharmony_ci omap_stop_lcd_dma(); 4288c2ecf20Sopenharmony_ci load_palette(); 4298c2ecf20Sopenharmony_ci setup_lcd_dma(); 4308c2ecf20Sopenharmony_ci set_load_mode(OMAP_LCDC_LOAD_FRAME); 4318c2ecf20Sopenharmony_ci enable_controller(); 4328c2ecf20Sopenharmony_ci } 4338c2ecf20Sopenharmony_ci 4348c2ecf20Sopenharmony_ci return 0; 4358c2ecf20Sopenharmony_ci} 4368c2ecf20Sopenharmony_ci 4378c2ecf20Sopenharmony_cistatic void calc_ck_div(int is_tft, int pck, int *pck_div) 4388c2ecf20Sopenharmony_ci{ 4398c2ecf20Sopenharmony_ci unsigned long lck; 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci pck = max(1, pck); 4428c2ecf20Sopenharmony_ci lck = clk_get_rate(lcdc.lcd_ck); 4438c2ecf20Sopenharmony_ci *pck_div = (lck + pck - 1) / pck; 4448c2ecf20Sopenharmony_ci if (is_tft) 4458c2ecf20Sopenharmony_ci *pck_div = max(2, *pck_div); 4468c2ecf20Sopenharmony_ci else 4478c2ecf20Sopenharmony_ci *pck_div = max(3, *pck_div); 4488c2ecf20Sopenharmony_ci if (*pck_div > 255) { 4498c2ecf20Sopenharmony_ci /* FIXME: try to adjust logic clock divider as well */ 4508c2ecf20Sopenharmony_ci *pck_div = 255; 4518c2ecf20Sopenharmony_ci dev_warn(lcdc.fbdev->dev, "pixclock %d kHz too low.\n", 4528c2ecf20Sopenharmony_ci pck / 1000); 4538c2ecf20Sopenharmony_ci } 4548c2ecf20Sopenharmony_ci} 4558c2ecf20Sopenharmony_ci 4568c2ecf20Sopenharmony_cistatic inline void setup_regs(void) 4578c2ecf20Sopenharmony_ci{ 4588c2ecf20Sopenharmony_ci u32 l; 4598c2ecf20Sopenharmony_ci struct lcd_panel *panel = lcdc.fbdev->panel; 4608c2ecf20Sopenharmony_ci int is_tft = panel->config & OMAP_LCDC_PANEL_TFT; 4618c2ecf20Sopenharmony_ci unsigned long lck; 4628c2ecf20Sopenharmony_ci int pcd; 4638c2ecf20Sopenharmony_ci 4648c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_CONTROL); 4658c2ecf20Sopenharmony_ci l &= ~OMAP_LCDC_CTRL_LCD_TFT; 4668c2ecf20Sopenharmony_ci l |= is_tft ? OMAP_LCDC_CTRL_LCD_TFT : 0; 4678c2ecf20Sopenharmony_ci#ifdef CONFIG_MACH_OMAP_PALMTE 4688c2ecf20Sopenharmony_ci/* FIXME:if (machine_is_omap_palmte()) { */ 4698c2ecf20Sopenharmony_ci /* PalmTE uses alternate TFT setting in 8BPP mode */ 4708c2ecf20Sopenharmony_ci l |= (is_tft && panel->bpp == 8) ? 0x810000 : 0; 4718c2ecf20Sopenharmony_ci/* } */ 4728c2ecf20Sopenharmony_ci#endif 4738c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 4748c2ecf20Sopenharmony_ci 4758c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_TIMING2); 4768c2ecf20Sopenharmony_ci l &= ~(((1 << 6) - 1) << 20); 4778c2ecf20Sopenharmony_ci l |= (panel->config & OMAP_LCDC_SIGNAL_MASK) << 20; 4788c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_TIMING2); 4798c2ecf20Sopenharmony_ci 4808c2ecf20Sopenharmony_ci l = panel->x_res - 1; 4818c2ecf20Sopenharmony_ci l |= (panel->hsw - 1) << 10; 4828c2ecf20Sopenharmony_ci l |= (panel->hfp - 1) << 16; 4838c2ecf20Sopenharmony_ci l |= (panel->hbp - 1) << 24; 4848c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_TIMING0); 4858c2ecf20Sopenharmony_ci 4868c2ecf20Sopenharmony_ci l = panel->y_res - 1; 4878c2ecf20Sopenharmony_ci l |= (panel->vsw - 1) << 10; 4888c2ecf20Sopenharmony_ci l |= panel->vfp << 16; 4898c2ecf20Sopenharmony_ci l |= panel->vbp << 24; 4908c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_TIMING1); 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci l = omap_readl(OMAP_LCDC_TIMING2); 4938c2ecf20Sopenharmony_ci l &= ~0xff; 4948c2ecf20Sopenharmony_ci 4958c2ecf20Sopenharmony_ci lck = clk_get_rate(lcdc.lcd_ck); 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci if (!panel->pcd) 4988c2ecf20Sopenharmony_ci calc_ck_div(is_tft, panel->pixel_clock * 1000, &pcd); 4998c2ecf20Sopenharmony_ci else { 5008c2ecf20Sopenharmony_ci dev_warn(lcdc.fbdev->dev, 5018c2ecf20Sopenharmony_ci "Pixel clock divider value is obsolete.\n" 5028c2ecf20Sopenharmony_ci "Try to set pixel_clock to %lu and pcd to 0 " 5038c2ecf20Sopenharmony_ci "in drivers/video/omap/lcd_%s.c and submit a patch.\n", 5048c2ecf20Sopenharmony_ci lck / panel->pcd / 1000, panel->name); 5058c2ecf20Sopenharmony_ci 5068c2ecf20Sopenharmony_ci pcd = panel->pcd; 5078c2ecf20Sopenharmony_ci } 5088c2ecf20Sopenharmony_ci l |= pcd & 0xff; 5098c2ecf20Sopenharmony_ci l |= panel->acb << 8; 5108c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_TIMING2); 5118c2ecf20Sopenharmony_ci 5128c2ecf20Sopenharmony_ci /* update panel info with the exact clock */ 5138c2ecf20Sopenharmony_ci panel->pixel_clock = lck / pcd / 1000; 5148c2ecf20Sopenharmony_ci} 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_ci/* 5178c2ecf20Sopenharmony_ci * Configure the LCD controller, download the color palette and start a looped 5188c2ecf20Sopenharmony_ci * DMA transfer of the frame image data. Called only in internal 5198c2ecf20Sopenharmony_ci * controller mode. 5208c2ecf20Sopenharmony_ci */ 5218c2ecf20Sopenharmony_cistatic int omap_lcdc_set_update_mode(enum omapfb_update_mode mode) 5228c2ecf20Sopenharmony_ci{ 5238c2ecf20Sopenharmony_ci int r = 0; 5248c2ecf20Sopenharmony_ci 5258c2ecf20Sopenharmony_ci if (mode != lcdc.update_mode) { 5268c2ecf20Sopenharmony_ci switch (mode) { 5278c2ecf20Sopenharmony_ci case OMAPFB_AUTO_UPDATE: 5288c2ecf20Sopenharmony_ci setup_regs(); 5298c2ecf20Sopenharmony_ci load_palette(); 5308c2ecf20Sopenharmony_ci 5318c2ecf20Sopenharmony_ci /* Setup and start LCD DMA */ 5328c2ecf20Sopenharmony_ci setup_lcd_dma(); 5338c2ecf20Sopenharmony_ci 5348c2ecf20Sopenharmony_ci set_load_mode(OMAP_LCDC_LOAD_FRAME); 5358c2ecf20Sopenharmony_ci enable_irqs(OMAP_LCDC_IRQ_DONE); 5368c2ecf20Sopenharmony_ci /* This will start the actual DMA transfer */ 5378c2ecf20Sopenharmony_ci enable_controller(); 5388c2ecf20Sopenharmony_ci lcdc.update_mode = mode; 5398c2ecf20Sopenharmony_ci break; 5408c2ecf20Sopenharmony_ci case OMAPFB_UPDATE_DISABLED: 5418c2ecf20Sopenharmony_ci disable_controller(); 5428c2ecf20Sopenharmony_ci omap_stop_lcd_dma(); 5438c2ecf20Sopenharmony_ci lcdc.update_mode = mode; 5448c2ecf20Sopenharmony_ci break; 5458c2ecf20Sopenharmony_ci default: 5468c2ecf20Sopenharmony_ci r = -EINVAL; 5478c2ecf20Sopenharmony_ci } 5488c2ecf20Sopenharmony_ci } 5498c2ecf20Sopenharmony_ci 5508c2ecf20Sopenharmony_ci return r; 5518c2ecf20Sopenharmony_ci} 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_cistatic enum omapfb_update_mode omap_lcdc_get_update_mode(void) 5548c2ecf20Sopenharmony_ci{ 5558c2ecf20Sopenharmony_ci return lcdc.update_mode; 5568c2ecf20Sopenharmony_ci} 5578c2ecf20Sopenharmony_ci 5588c2ecf20Sopenharmony_ci/* PM code called only in internal controller mode */ 5598c2ecf20Sopenharmony_cistatic void omap_lcdc_suspend(void) 5608c2ecf20Sopenharmony_ci{ 5618c2ecf20Sopenharmony_ci omap_lcdc_set_update_mode(OMAPFB_UPDATE_DISABLED); 5628c2ecf20Sopenharmony_ci} 5638c2ecf20Sopenharmony_ci 5648c2ecf20Sopenharmony_cistatic void omap_lcdc_resume(void) 5658c2ecf20Sopenharmony_ci{ 5668c2ecf20Sopenharmony_ci omap_lcdc_set_update_mode(OMAPFB_AUTO_UPDATE); 5678c2ecf20Sopenharmony_ci} 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_cistatic void omap_lcdc_get_caps(int plane, struct omapfb_caps *caps) 5708c2ecf20Sopenharmony_ci{ 5718c2ecf20Sopenharmony_ci return; 5728c2ecf20Sopenharmony_ci} 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ciint omap_lcdc_set_dma_callback(void (*callback)(void *data), void *data) 5758c2ecf20Sopenharmony_ci{ 5768c2ecf20Sopenharmony_ci BUG_ON(callback == NULL); 5778c2ecf20Sopenharmony_ci 5788c2ecf20Sopenharmony_ci if (lcdc.dma_callback) 5798c2ecf20Sopenharmony_ci return -EBUSY; 5808c2ecf20Sopenharmony_ci else { 5818c2ecf20Sopenharmony_ci lcdc.dma_callback = callback; 5828c2ecf20Sopenharmony_ci lcdc.dma_callback_data = data; 5838c2ecf20Sopenharmony_ci } 5848c2ecf20Sopenharmony_ci return 0; 5858c2ecf20Sopenharmony_ci} 5868c2ecf20Sopenharmony_ciEXPORT_SYMBOL(omap_lcdc_set_dma_callback); 5878c2ecf20Sopenharmony_ci 5888c2ecf20Sopenharmony_civoid omap_lcdc_free_dma_callback(void) 5898c2ecf20Sopenharmony_ci{ 5908c2ecf20Sopenharmony_ci lcdc.dma_callback = NULL; 5918c2ecf20Sopenharmony_ci} 5928c2ecf20Sopenharmony_ciEXPORT_SYMBOL(omap_lcdc_free_dma_callback); 5938c2ecf20Sopenharmony_ci 5948c2ecf20Sopenharmony_cistatic void lcdc_dma_handler(u16 status, void *data) 5958c2ecf20Sopenharmony_ci{ 5968c2ecf20Sopenharmony_ci if (lcdc.dma_callback) 5978c2ecf20Sopenharmony_ci lcdc.dma_callback(lcdc.dma_callback_data); 5988c2ecf20Sopenharmony_ci} 5998c2ecf20Sopenharmony_ci 6008c2ecf20Sopenharmony_cistatic int alloc_palette_ram(void) 6018c2ecf20Sopenharmony_ci{ 6028c2ecf20Sopenharmony_ci lcdc.palette_virt = dma_alloc_wc(lcdc.fbdev->dev, MAX_PALETTE_SIZE, 6038c2ecf20Sopenharmony_ci &lcdc.palette_phys, GFP_KERNEL); 6048c2ecf20Sopenharmony_ci if (lcdc.palette_virt == NULL) { 6058c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "failed to alloc palette memory\n"); 6068c2ecf20Sopenharmony_ci return -ENOMEM; 6078c2ecf20Sopenharmony_ci } 6088c2ecf20Sopenharmony_ci memset(lcdc.palette_virt, 0, MAX_PALETTE_SIZE); 6098c2ecf20Sopenharmony_ci 6108c2ecf20Sopenharmony_ci return 0; 6118c2ecf20Sopenharmony_ci} 6128c2ecf20Sopenharmony_ci 6138c2ecf20Sopenharmony_cistatic void free_palette_ram(void) 6148c2ecf20Sopenharmony_ci{ 6158c2ecf20Sopenharmony_ci dma_free_wc(lcdc.fbdev->dev, MAX_PALETTE_SIZE, lcdc.palette_virt, 6168c2ecf20Sopenharmony_ci lcdc.palette_phys); 6178c2ecf20Sopenharmony_ci} 6188c2ecf20Sopenharmony_ci 6198c2ecf20Sopenharmony_cistatic int alloc_fbmem(struct omapfb_mem_region *region) 6208c2ecf20Sopenharmony_ci{ 6218c2ecf20Sopenharmony_ci int bpp; 6228c2ecf20Sopenharmony_ci int frame_size; 6238c2ecf20Sopenharmony_ci struct lcd_panel *panel = lcdc.fbdev->panel; 6248c2ecf20Sopenharmony_ci 6258c2ecf20Sopenharmony_ci bpp = panel->bpp; 6268c2ecf20Sopenharmony_ci if (bpp == 12) 6278c2ecf20Sopenharmony_ci bpp = 16; 6288c2ecf20Sopenharmony_ci frame_size = PAGE_ALIGN(panel->x_res * bpp / 8 * panel->y_res); 6298c2ecf20Sopenharmony_ci if (region->size > frame_size) 6308c2ecf20Sopenharmony_ci frame_size = region->size; 6318c2ecf20Sopenharmony_ci lcdc.vram_size = frame_size; 6328c2ecf20Sopenharmony_ci lcdc.vram_virt = dma_alloc_wc(lcdc.fbdev->dev, lcdc.vram_size, 6338c2ecf20Sopenharmony_ci &lcdc.vram_phys, GFP_KERNEL); 6348c2ecf20Sopenharmony_ci if (lcdc.vram_virt == NULL) { 6358c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "unable to allocate FB DMA memory\n"); 6368c2ecf20Sopenharmony_ci return -ENOMEM; 6378c2ecf20Sopenharmony_ci } 6388c2ecf20Sopenharmony_ci region->size = frame_size; 6398c2ecf20Sopenharmony_ci region->paddr = lcdc.vram_phys; 6408c2ecf20Sopenharmony_ci region->vaddr = lcdc.vram_virt; 6418c2ecf20Sopenharmony_ci region->alloc = 1; 6428c2ecf20Sopenharmony_ci 6438c2ecf20Sopenharmony_ci memset(lcdc.vram_virt, 0, lcdc.vram_size); 6448c2ecf20Sopenharmony_ci 6458c2ecf20Sopenharmony_ci return 0; 6468c2ecf20Sopenharmony_ci} 6478c2ecf20Sopenharmony_ci 6488c2ecf20Sopenharmony_cistatic void free_fbmem(void) 6498c2ecf20Sopenharmony_ci{ 6508c2ecf20Sopenharmony_ci dma_free_wc(lcdc.fbdev->dev, lcdc.vram_size, lcdc.vram_virt, 6518c2ecf20Sopenharmony_ci lcdc.vram_phys); 6528c2ecf20Sopenharmony_ci} 6538c2ecf20Sopenharmony_ci 6548c2ecf20Sopenharmony_cistatic int setup_fbmem(struct omapfb_mem_desc *req_md) 6558c2ecf20Sopenharmony_ci{ 6568c2ecf20Sopenharmony_ci if (!req_md->region_cnt) { 6578c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "no memory regions defined\n"); 6588c2ecf20Sopenharmony_ci return -EINVAL; 6598c2ecf20Sopenharmony_ci } 6608c2ecf20Sopenharmony_ci 6618c2ecf20Sopenharmony_ci if (req_md->region_cnt > 1) { 6628c2ecf20Sopenharmony_ci dev_err(lcdc.fbdev->dev, "only one plane is supported\n"); 6638c2ecf20Sopenharmony_ci req_md->region_cnt = 1; 6648c2ecf20Sopenharmony_ci } 6658c2ecf20Sopenharmony_ci 6668c2ecf20Sopenharmony_ci return alloc_fbmem(&req_md->region[0]); 6678c2ecf20Sopenharmony_ci} 6688c2ecf20Sopenharmony_ci 6698c2ecf20Sopenharmony_cistatic int omap_lcdc_init(struct omapfb_device *fbdev, int ext_mode, 6708c2ecf20Sopenharmony_ci struct omapfb_mem_desc *req_vram) 6718c2ecf20Sopenharmony_ci{ 6728c2ecf20Sopenharmony_ci int r; 6738c2ecf20Sopenharmony_ci u32 l; 6748c2ecf20Sopenharmony_ci int rate; 6758c2ecf20Sopenharmony_ci struct clk *tc_ck; 6768c2ecf20Sopenharmony_ci 6778c2ecf20Sopenharmony_ci lcdc.irq_mask = 0; 6788c2ecf20Sopenharmony_ci 6798c2ecf20Sopenharmony_ci lcdc.fbdev = fbdev; 6808c2ecf20Sopenharmony_ci lcdc.ext_mode = ext_mode; 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci l = 0; 6838c2ecf20Sopenharmony_ci omap_writel(l, OMAP_LCDC_CONTROL); 6848c2ecf20Sopenharmony_ci 6858c2ecf20Sopenharmony_ci /* FIXME: 6868c2ecf20Sopenharmony_ci * According to errata some platforms have a clock rate limitiation 6878c2ecf20Sopenharmony_ci */ 6888c2ecf20Sopenharmony_ci lcdc.lcd_ck = clk_get(fbdev->dev, "lcd_ck"); 6898c2ecf20Sopenharmony_ci if (IS_ERR(lcdc.lcd_ck)) { 6908c2ecf20Sopenharmony_ci dev_err(fbdev->dev, "unable to access LCD clock\n"); 6918c2ecf20Sopenharmony_ci r = PTR_ERR(lcdc.lcd_ck); 6928c2ecf20Sopenharmony_ci goto fail0; 6938c2ecf20Sopenharmony_ci } 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_ci tc_ck = clk_get(fbdev->dev, "tc_ck"); 6968c2ecf20Sopenharmony_ci if (IS_ERR(tc_ck)) { 6978c2ecf20Sopenharmony_ci dev_err(fbdev->dev, "unable to access TC clock\n"); 6988c2ecf20Sopenharmony_ci r = PTR_ERR(tc_ck); 6998c2ecf20Sopenharmony_ci goto fail1; 7008c2ecf20Sopenharmony_ci } 7018c2ecf20Sopenharmony_ci 7028c2ecf20Sopenharmony_ci rate = clk_get_rate(tc_ck); 7038c2ecf20Sopenharmony_ci clk_put(tc_ck); 7048c2ecf20Sopenharmony_ci 7058c2ecf20Sopenharmony_ci if (machine_is_ams_delta()) 7068c2ecf20Sopenharmony_ci rate /= 4; 7078c2ecf20Sopenharmony_ci if (machine_is_omap_h3()) 7088c2ecf20Sopenharmony_ci rate /= 3; 7098c2ecf20Sopenharmony_ci r = clk_set_rate(lcdc.lcd_ck, rate); 7108c2ecf20Sopenharmony_ci if (r) { 7118c2ecf20Sopenharmony_ci dev_err(fbdev->dev, "failed to adjust LCD rate\n"); 7128c2ecf20Sopenharmony_ci goto fail1; 7138c2ecf20Sopenharmony_ci } 7148c2ecf20Sopenharmony_ci clk_enable(lcdc.lcd_ck); 7158c2ecf20Sopenharmony_ci 7168c2ecf20Sopenharmony_ci r = request_irq(OMAP_LCDC_IRQ, lcdc_irq_handler, 0, MODULE_NAME, fbdev); 7178c2ecf20Sopenharmony_ci if (r) { 7188c2ecf20Sopenharmony_ci dev_err(fbdev->dev, "unable to get IRQ\n"); 7198c2ecf20Sopenharmony_ci goto fail2; 7208c2ecf20Sopenharmony_ci } 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_ci r = omap_request_lcd_dma(lcdc_dma_handler, NULL); 7238c2ecf20Sopenharmony_ci if (r) { 7248c2ecf20Sopenharmony_ci dev_err(fbdev->dev, "unable to get LCD DMA\n"); 7258c2ecf20Sopenharmony_ci goto fail3; 7268c2ecf20Sopenharmony_ci } 7278c2ecf20Sopenharmony_ci 7288c2ecf20Sopenharmony_ci omap_set_lcd_dma_single_transfer(ext_mode); 7298c2ecf20Sopenharmony_ci omap_set_lcd_dma_ext_controller(ext_mode); 7308c2ecf20Sopenharmony_ci 7318c2ecf20Sopenharmony_ci if (!ext_mode) 7328c2ecf20Sopenharmony_ci if ((r = alloc_palette_ram()) < 0) 7338c2ecf20Sopenharmony_ci goto fail4; 7348c2ecf20Sopenharmony_ci 7358c2ecf20Sopenharmony_ci if ((r = setup_fbmem(req_vram)) < 0) 7368c2ecf20Sopenharmony_ci goto fail5; 7378c2ecf20Sopenharmony_ci 7388c2ecf20Sopenharmony_ci pr_info("omapfb: LCDC initialized\n"); 7398c2ecf20Sopenharmony_ci 7408c2ecf20Sopenharmony_ci return 0; 7418c2ecf20Sopenharmony_cifail5: 7428c2ecf20Sopenharmony_ci if (!ext_mode) 7438c2ecf20Sopenharmony_ci free_palette_ram(); 7448c2ecf20Sopenharmony_cifail4: 7458c2ecf20Sopenharmony_ci omap_free_lcd_dma(); 7468c2ecf20Sopenharmony_cifail3: 7478c2ecf20Sopenharmony_ci free_irq(OMAP_LCDC_IRQ, lcdc.fbdev); 7488c2ecf20Sopenharmony_cifail2: 7498c2ecf20Sopenharmony_ci clk_disable(lcdc.lcd_ck); 7508c2ecf20Sopenharmony_cifail1: 7518c2ecf20Sopenharmony_ci clk_put(lcdc.lcd_ck); 7528c2ecf20Sopenharmony_cifail0: 7538c2ecf20Sopenharmony_ci return r; 7548c2ecf20Sopenharmony_ci} 7558c2ecf20Sopenharmony_ci 7568c2ecf20Sopenharmony_cistatic void omap_lcdc_cleanup(void) 7578c2ecf20Sopenharmony_ci{ 7588c2ecf20Sopenharmony_ci if (!lcdc.ext_mode) 7598c2ecf20Sopenharmony_ci free_palette_ram(); 7608c2ecf20Sopenharmony_ci free_fbmem(); 7618c2ecf20Sopenharmony_ci omap_free_lcd_dma(); 7628c2ecf20Sopenharmony_ci free_irq(OMAP_LCDC_IRQ, lcdc.fbdev); 7638c2ecf20Sopenharmony_ci clk_disable(lcdc.lcd_ck); 7648c2ecf20Sopenharmony_ci clk_put(lcdc.lcd_ck); 7658c2ecf20Sopenharmony_ci} 7668c2ecf20Sopenharmony_ci 7678c2ecf20Sopenharmony_ciconst struct lcd_ctrl omap1_int_ctrl = { 7688c2ecf20Sopenharmony_ci .name = "internal", 7698c2ecf20Sopenharmony_ci .init = omap_lcdc_init, 7708c2ecf20Sopenharmony_ci .cleanup = omap_lcdc_cleanup, 7718c2ecf20Sopenharmony_ci .get_caps = omap_lcdc_get_caps, 7728c2ecf20Sopenharmony_ci .set_update_mode = omap_lcdc_set_update_mode, 7738c2ecf20Sopenharmony_ci .get_update_mode = omap_lcdc_get_update_mode, 7748c2ecf20Sopenharmony_ci .update_window = NULL, 7758c2ecf20Sopenharmony_ci .suspend = omap_lcdc_suspend, 7768c2ecf20Sopenharmony_ci .resume = omap_lcdc_resume, 7778c2ecf20Sopenharmony_ci .setup_plane = omap_lcdc_setup_plane, 7788c2ecf20Sopenharmony_ci .enable_plane = omap_lcdc_enable_plane, 7798c2ecf20Sopenharmony_ci .setcolreg = omap_lcdc_setcolreg, 7808c2ecf20Sopenharmony_ci}; 781