1/* Copyright (c) 2009, Code Aurora Forum. All rights reserved. 2 * 3 * This program is free software; you can redistribute it and/or modify 4 * it under the terms of the GNU General Public License version 2 and 5 * only version 2 as published by the Free Software Foundation. 6 * 7 * This program is distributed in the hope that it will be useful, 8 * but WITHOUT ANY WARRANTY; without even the implied warranty of 9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 10 * GNU General Public License for more details. 11 * 12 * You should have received a copy of the GNU General Public License 13 * along with this program; if not, write to the Free Software 14 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 15 * 02110-1301, USA. 16 */ 17 18#include "msm_fb.h" 19#include "mddihost.h" 20#include "mddihosti.h" 21#include "mddi_toshiba.h" 22 23static uint32 read_client_reg(uint32 addr) 24{ 25 uint32 val; 26 mddi_queue_register_read(addr, &val, TRUE, 0); 27 return val; 28} 29 30static uint32 toshiba_lcd_gpio_read(void) 31{ 32 uint32 val; 33 34 write_client_reg(GPIODIR, 0x0000000C, TRUE); 35 write_client_reg(GPIOSEL, 0x00000000, TRUE); 36 write_client_reg(GPIOSEL, 0x00000000, TRUE); 37 write_client_reg(GPIOPC, 0x03CF00C0, TRUE); 38 val = read_client_reg(GPIODATA) & 0x2C0; 39 40 return val; 41} 42 43static u32 mddi_toshiba_panel_detect(void) 44{ 45 mddi_host_type host_idx = MDDI_HOST_PRIM; 46 uint32 lcd_gpio; 47 u32 mddi_toshiba_lcd = LCD_TOSHIBA_2P4_VGA; 48 49 /* Toshiba display requires larger drive_lo value */ 50 mddi_host_reg_out(DRIVE_LO, 0x0050); 51 52 lcd_gpio = toshiba_lcd_gpio_read(); 53 switch (lcd_gpio) { 54 case 0x0080: 55 mddi_toshiba_lcd = LCD_SHARP_2P4_VGA; 56 break; 57 58 case 0x00C0: 59 default: 60 mddi_toshiba_lcd = LCD_TOSHIBA_2P4_VGA; 61 break; 62 } 63 64 return mddi_toshiba_lcd; 65} 66 67static int __init mddi_toshiba_vga_init(void) 68{ 69 int ret; 70 struct msm_panel_info pinfo; 71 u32 panel; 72 73#ifdef CONFIG_FB_MSM_MDDI_AUTO_DETECT 74 u32 id; 75 76 ret = msm_fb_detect_client("mddi_toshiba_vga"); 77 if (ret == -ENODEV) 78 return 0; 79 80 if (ret) { 81 id = mddi_get_client_id(); 82 if ((id >> 16) != 0xD263) 83 return 0; 84 } 85#endif 86 87 panel = mddi_toshiba_panel_detect(); 88 89 pinfo.xres = 480; 90 pinfo.yres = 640; 91 pinfo.type = MDDI_PANEL; 92 pinfo.pdest = DISPLAY_1; 93 pinfo.mddi.vdopkt = MDDI_DEFAULT_PRIM_PIX_ATTR; 94 pinfo.wait_cycle = 0; 95 pinfo.bpp = 18; 96 pinfo.lcd.vsync_enable = TRUE; 97 pinfo.lcd.refx100 = 6118; 98 pinfo.lcd.v_back_porch = 6; 99 pinfo.lcd.v_front_porch = 0; 100 pinfo.lcd.v_pulse_width = 0; 101 pinfo.lcd.hw_vsync_mode = FALSE; 102 pinfo.lcd.vsync_notifier_period = (1 * HZ); 103 pinfo.bl_max = 99; 104 pinfo.bl_min = 1; 105 pinfo.clk_rate = 122880000; 106 pinfo.clk_min = 120000000; 107 pinfo.clk_max = 200000000; 108 pinfo.fb_num = 2; 109 110 ret = mddi_toshiba_device_register(&pinfo, TOSHIBA_VGA_PRIM, panel); 111 if (ret) { 112 printk(KERN_ERR "%s: failed to register device!\n", __func__); 113 return ret; 114 } 115 116 pinfo.xres = 176; 117 pinfo.yres = 220; 118 pinfo.type = MDDI_PANEL; 119 pinfo.pdest = DISPLAY_2; 120 pinfo.mddi.vdopkt = 0x400; 121 pinfo.wait_cycle = 0; 122 pinfo.bpp = 18; 123 pinfo.clk_rate = 122880000; 124 pinfo.clk_min = 120000000; 125 pinfo.clk_max = 200000000; 126 pinfo.fb_num = 2; 127 128 ret = mddi_toshiba_device_register(&pinfo, TOSHIBA_VGA_SECD, panel); 129 if (ret) 130 printk(KERN_WARNING 131 "%s: failed to register device!\n", __func__); 132 133 return ret; 134} 135 136module_init(mddi_toshiba_vga_init); 137