1 /* 2 * Copyright 1998-2008 VIA Technologies, Inc. All Rights Reserved. 3 * Copyright 2001-2008 S3 Graphics, Inc. All Rights Reserved. 4 5 * This program is free software; you can redistribute it and/or 6 * modify it under the terms of the GNU General Public 7 * License as published by the Free Software Foundation; 8 * either version 2, or (at your option) any later version. 9 10 * This program is distributed in the hope that it will be useful, 11 * but WITHOUT ANY WARRANTIES OR REPRESENTATIONS; without even 12 * the implied warranty of MERCHANTABILITY or FITNESS FOR 13 * A PARTICULAR PURPOSE.See the GNU General Public License 14 * for more details. 15 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 19 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 20 */ 21 #include <linux/via-core.h> 22 #include <linux/via_i2c.h> 23 #include "global.h" 24 25 #define viafb_compact_res(x, y) (((x)<<16)|(y)) 26 27 /* CLE266 Software Power Sequence */ 28 /* {Mask}, {Data}, {Delay} */ 29 static const int PowerSequenceOn[3][3] = { 30 {0x10, 0x08, 0x06}, {0x10, 0x08, 0x06}, {0x19, 0x1FE, 0x01} 31 }; 32 static const int PowerSequenceOff[3][3] = { 33 {0x06, 0x08, 0x10}, {0x00, 0x00, 0x00}, {0xD2, 0x19, 0x01} 34 }; 35 36 static struct _lcd_scaling_factor lcd_scaling_factor = { 37 /* LCD Horizontal Scaling Factor Register */ 38 {LCD_HOR_SCALING_FACTOR_REG_NUM, 39 {{CR9F, 0, 1}, {CR77, 0, 7}, {CR79, 4, 5} } }, 40 /* LCD Vertical Scaling Factor Register */ 41 {LCD_VER_SCALING_FACTOR_REG_NUM, 42 {{CR79, 3, 3}, {CR78, 0, 7}, {CR79, 6, 7} } } 43 }; 44 static struct _lcd_scaling_factor lcd_scaling_factor_CLE = { 45 /* LCD Horizontal Scaling Factor Register */ 46 {LCD_HOR_SCALING_FACTOR_REG_NUM_CLE, {{CR77, 0, 7}, {CR79, 4, 5} } }, 47 /* LCD Vertical Scaling Factor Register */ 48 {LCD_VER_SCALING_FACTOR_REG_NUM_CLE, {{CR78, 0, 7}, {CR79, 6, 7} } } 49 }; 50 51 static bool lvds_identify_integratedlvds(void); 52 static void fp_id_to_vindex(int panel_id); 53 static int lvds_register_read(int index); 54 static void load_lcd_scaling(int set_hres, int set_vres, int panel_hres, 55 int panel_vres); 56 static void lcd_patch_skew_dvp0(struct lvds_setting_information 57 *plvds_setting_info, 58 struct lvds_chip_information *plvds_chip_info); 59 static void lcd_patch_skew_dvp1(struct lvds_setting_information 60 *plvds_setting_info, 61 struct lvds_chip_information *plvds_chip_info); 62 static void lcd_patch_skew(struct lvds_setting_information 63 *plvds_setting_info, struct lvds_chip_information *plvds_chip_info); 64 65 static void integrated_lvds_disable(struct lvds_setting_information 66 *plvds_setting_info, 67 struct lvds_chip_information *plvds_chip_info); 68 static void integrated_lvds_enable(struct lvds_setting_information 69 *plvds_setting_info, 70 struct lvds_chip_information *plvds_chip_info); 71 static void lcd_powersequence_off(void); 72 static void lcd_powersequence_on(void); 73 static void fill_lcd_format(void); 74 static void check_diport_of_integrated_lvds( 75 struct lvds_chip_information *plvds_chip_info, 76 struct lvds_setting_information 77 *plvds_setting_info); 78 79 static inline bool check_lvds_chip(int device_id_subaddr, int device_id) 80 { 81 return lvds_register_read(device_id_subaddr) == device_id; 82 } 83 84 void viafb_init_lcd_size(void) 85 { 86 DEBUG_MSG(KERN_INFO "viafb_init_lcd_size()\n"); 87 88 fp_id_to_vindex(viafb_lcd_panel_id); 89 viaparinfo->lvds_setting_info2->lcd_panel_hres = 90 viaparinfo->lvds_setting_info->lcd_panel_hres; 91 viaparinfo->lvds_setting_info2->lcd_panel_vres = 92 viaparinfo->lvds_setting_info->lcd_panel_vres; 93 viaparinfo->lvds_setting_info2->device_lcd_dualedge = 94 viaparinfo->lvds_setting_info->device_lcd_dualedge; 95 viaparinfo->lvds_setting_info2->LCDDithering = 96 viaparinfo->lvds_setting_info->LCDDithering; 97 } 98 99 static bool lvds_identify_integratedlvds(void) 100 { 101 if (viafb_display_hardware_layout == HW_LAYOUT_LCD_EXTERNAL_LCD2) { 102 /* Two dual channel LCD (Internal LVDS + External LVDS): */ 103 /* If we have an external LVDS, such as VT1636, we should 104 have its chip ID already. */ 105 if (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) { 106 viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name = 107 INTEGRATED_LVDS; 108 DEBUG_MSG(KERN_INFO "Support two dual channel LVDS! " 109 "(Internal LVDS + External LVDS)\n"); 110 } else { 111 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = 112 INTEGRATED_LVDS; 113 DEBUG_MSG(KERN_INFO "Not found external LVDS, " 114 "so can't support two dual channel LVDS!\n"); 115 } 116 } else if (viafb_display_hardware_layout == HW_LAYOUT_LCD1_LCD2) { 117 /* Two single channel LCD (Internal LVDS + Internal LVDS): */ 118 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = 119 INTEGRATED_LVDS; 120 viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name = 121 INTEGRATED_LVDS; 122 DEBUG_MSG(KERN_INFO "Support two single channel LVDS! " 123 "(Internal LVDS + Internal LVDS)\n"); 124 } else if (viafb_display_hardware_layout != HW_LAYOUT_DVI_ONLY) { 125 /* If we have found external LVDS, just use it, 126 otherwise, we will use internal LVDS as default. */ 127 if (!viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) { 128 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = 129 INTEGRATED_LVDS; 130 DEBUG_MSG(KERN_INFO "Found Integrated LVDS!\n"); 131 } 132 } else { 133 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = 134 NON_LVDS_TRANSMITTER; 135 DEBUG_MSG(KERN_INFO "Do not support LVDS!\n"); 136 return false; 137 } 138 139 return true; 140 } 141 142 bool viafb_lvds_trasmitter_identify(void) 143 { 144 if (viafb_lvds_identify_vt1636(VIA_PORT_31)) { 145 viaparinfo->chip_info->lvds_chip_info.i2c_port = VIA_PORT_31; 146 DEBUG_MSG(KERN_INFO 147 "Found VIA VT1636 LVDS on port i2c 0x31\n"); 148 } else { 149 if (viafb_lvds_identify_vt1636(VIA_PORT_2C)) { 150 viaparinfo->chip_info->lvds_chip_info.i2c_port = 151 VIA_PORT_2C; 152 DEBUG_MSG(KERN_INFO 153 "Found VIA VT1636 LVDS on port gpio 0x2c\n"); 154 } 155 } 156 157 if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CX700) 158 lvds_identify_integratedlvds(); 159 160 if (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) 161 return true; 162 /* Check for VT1631: */ 163 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = VT1631_LVDS; 164 viaparinfo->chip_info->lvds_chip_info.lvds_chip_slave_addr = 165 VT1631_LVDS_I2C_ADDR; 166 167 if (check_lvds_chip(VT1631_DEVICE_ID_REG, VT1631_DEVICE_ID)) { 168 DEBUG_MSG(KERN_INFO "\n VT1631 LVDS ! \n"); 169 DEBUG_MSG(KERN_INFO "\n %2d", 170 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name); 171 DEBUG_MSG(KERN_INFO "\n %2d", 172 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name); 173 return true; 174 } 175 176 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name = 177 NON_LVDS_TRANSMITTER; 178 viaparinfo->chip_info->lvds_chip_info.lvds_chip_slave_addr = 179 VT1631_LVDS_I2C_ADDR; 180 return false; 181 } 182 183 static void fp_id_to_vindex(int panel_id) 184 { 185 DEBUG_MSG(KERN_INFO "fp_get_panel_id()\n"); 186 187 if (panel_id > LCD_PANEL_ID_MAXIMUM) 188 viafb_lcd_panel_id = panel_id = 189 viafb_read_reg(VIACR, CR3F) & 0x0F; 190 191 switch (panel_id) { 192 case 0x0: 193 viaparinfo->lvds_setting_info->lcd_panel_hres = 640; 194 viaparinfo->lvds_setting_info->lcd_panel_vres = 480; 195 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 196 viaparinfo->lvds_setting_info->LCDDithering = 1; 197 break; 198 case 0x1: 199 viaparinfo->lvds_setting_info->lcd_panel_hres = 800; 200 viaparinfo->lvds_setting_info->lcd_panel_vres = 600; 201 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 202 viaparinfo->lvds_setting_info->LCDDithering = 1; 203 break; 204 case 0x2: 205 viaparinfo->lvds_setting_info->lcd_panel_hres = 1024; 206 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 207 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 208 viaparinfo->lvds_setting_info->LCDDithering = 1; 209 break; 210 case 0x3: 211 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 212 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 213 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 214 viaparinfo->lvds_setting_info->LCDDithering = 1; 215 break; 216 case 0x4: 217 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 218 viaparinfo->lvds_setting_info->lcd_panel_vres = 1024; 219 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 220 viaparinfo->lvds_setting_info->LCDDithering = 1; 221 break; 222 case 0x5: 223 viaparinfo->lvds_setting_info->lcd_panel_hres = 1400; 224 viaparinfo->lvds_setting_info->lcd_panel_vres = 1050; 225 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 226 viaparinfo->lvds_setting_info->LCDDithering = 1; 227 break; 228 case 0x6: 229 viaparinfo->lvds_setting_info->lcd_panel_hres = 1600; 230 viaparinfo->lvds_setting_info->lcd_panel_vres = 1200; 231 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 232 viaparinfo->lvds_setting_info->LCDDithering = 1; 233 break; 234 case 0x8: 235 viaparinfo->lvds_setting_info->lcd_panel_hres = 800; 236 viaparinfo->lvds_setting_info->lcd_panel_vres = 480; 237 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 238 viaparinfo->lvds_setting_info->LCDDithering = 1; 239 break; 240 case 0x9: 241 viaparinfo->lvds_setting_info->lcd_panel_hres = 1024; 242 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 243 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 244 viaparinfo->lvds_setting_info->LCDDithering = 1; 245 break; 246 case 0xA: 247 viaparinfo->lvds_setting_info->lcd_panel_hres = 1024; 248 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 249 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 250 viaparinfo->lvds_setting_info->LCDDithering = 0; 251 break; 252 case 0xB: 253 viaparinfo->lvds_setting_info->lcd_panel_hres = 1024; 254 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 255 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 256 viaparinfo->lvds_setting_info->LCDDithering = 0; 257 break; 258 case 0xC: 259 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 260 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 261 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 262 viaparinfo->lvds_setting_info->LCDDithering = 0; 263 break; 264 case 0xD: 265 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 266 viaparinfo->lvds_setting_info->lcd_panel_vres = 1024; 267 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 268 viaparinfo->lvds_setting_info->LCDDithering = 0; 269 break; 270 case 0xE: 271 viaparinfo->lvds_setting_info->lcd_panel_hres = 1400; 272 viaparinfo->lvds_setting_info->lcd_panel_vres = 1050; 273 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 274 viaparinfo->lvds_setting_info->LCDDithering = 0; 275 break; 276 case 0xF: 277 viaparinfo->lvds_setting_info->lcd_panel_hres = 1600; 278 viaparinfo->lvds_setting_info->lcd_panel_vres = 1200; 279 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 280 viaparinfo->lvds_setting_info->LCDDithering = 0; 281 break; 282 case 0x10: 283 viaparinfo->lvds_setting_info->lcd_panel_hres = 1366; 284 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 285 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 286 viaparinfo->lvds_setting_info->LCDDithering = 0; 287 break; 288 case 0x11: 289 viaparinfo->lvds_setting_info->lcd_panel_hres = 1024; 290 viaparinfo->lvds_setting_info->lcd_panel_vres = 600; 291 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 292 viaparinfo->lvds_setting_info->LCDDithering = 1; 293 break; 294 case 0x12: 295 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 296 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 297 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 298 viaparinfo->lvds_setting_info->LCDDithering = 1; 299 break; 300 case 0x13: 301 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 302 viaparinfo->lvds_setting_info->lcd_panel_vres = 800; 303 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 304 viaparinfo->lvds_setting_info->LCDDithering = 1; 305 break; 306 case 0x14: 307 viaparinfo->lvds_setting_info->lcd_panel_hres = 1360; 308 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 309 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 310 viaparinfo->lvds_setting_info->LCDDithering = 0; 311 break; 312 case 0x15: 313 viaparinfo->lvds_setting_info->lcd_panel_hres = 1280; 314 viaparinfo->lvds_setting_info->lcd_panel_vres = 768; 315 viaparinfo->lvds_setting_info->device_lcd_dualedge = 1; 316 viaparinfo->lvds_setting_info->LCDDithering = 0; 317 break; 318 case 0x16: 319 viaparinfo->lvds_setting_info->lcd_panel_hres = 480; 320 viaparinfo->lvds_setting_info->lcd_panel_vres = 640; 321 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 322 viaparinfo->lvds_setting_info->LCDDithering = 1; 323 break; 324 case 0x17: 325 /* OLPC XO-1.5 panel */ 326 viaparinfo->lvds_setting_info->lcd_panel_hres = 1200; 327 viaparinfo->lvds_setting_info->lcd_panel_vres = 900; 328 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 329 viaparinfo->lvds_setting_info->LCDDithering = 0; 330 break; 331 default: 332 viaparinfo->lvds_setting_info->lcd_panel_hres = 800; 333 viaparinfo->lvds_setting_info->lcd_panel_vres = 600; 334 viaparinfo->lvds_setting_info->device_lcd_dualedge = 0; 335 viaparinfo->lvds_setting_info->LCDDithering = 1; 336 } 337 } 338 339 static int lvds_register_read(int index) 340 { 341 u8 data; 342 343 viafb_i2c_readbyte(VIA_PORT_2C, 344 (u8) viaparinfo->chip_info->lvds_chip_info.lvds_chip_slave_addr, 345 (u8) index, &data); 346 return data; 347 } 348 349 static void load_lcd_scaling(int set_hres, int set_vres, int panel_hres, 350 int panel_vres) 351 { 352 int reg_value = 0; 353 int viafb_load_reg_num; 354 struct io_register *reg = NULL; 355 356 DEBUG_MSG(KERN_INFO "load_lcd_scaling()!!\n"); 357 358 /* LCD Scaling Enable */ 359 viafb_write_reg_mask(CR79, VIACR, 0x07, BIT0 + BIT1 + BIT2); 360 361 /* Check if expansion for horizontal */ 362 if (set_hres < panel_hres) { 363 /* Load Horizontal Scaling Factor */ 364 switch (viaparinfo->chip_info->gfx_chip_name) { 365 case UNICHROME_CLE266: 366 case UNICHROME_K400: 367 reg_value = 368 CLE266_LCD_HOR_SCF_FORMULA(set_hres, panel_hres); 369 viafb_load_reg_num = 370 lcd_scaling_factor_CLE.lcd_hor_scaling_factor. 371 reg_num; 372 reg = lcd_scaling_factor_CLE.lcd_hor_scaling_factor.reg; 373 viafb_load_reg(reg_value, 374 viafb_load_reg_num, reg, VIACR); 375 break; 376 case UNICHROME_K800: 377 case UNICHROME_PM800: 378 case UNICHROME_CN700: 379 case UNICHROME_CX700: 380 case UNICHROME_K8M890: 381 case UNICHROME_P4M890: 382 case UNICHROME_P4M900: 383 case UNICHROME_CN750: 384 case UNICHROME_VX800: 385 case UNICHROME_VX855: 386 case UNICHROME_VX900: 387 reg_value = 388 K800_LCD_HOR_SCF_FORMULA(set_hres, panel_hres); 389 /* Horizontal scaling enabled */ 390 viafb_write_reg_mask(CRA2, VIACR, 0xC0, BIT7 + BIT6); 391 viafb_load_reg_num = 392 lcd_scaling_factor.lcd_hor_scaling_factor.reg_num; 393 reg = lcd_scaling_factor.lcd_hor_scaling_factor.reg; 394 viafb_load_reg(reg_value, 395 viafb_load_reg_num, reg, VIACR); 396 break; 397 } 398 399 DEBUG_MSG(KERN_INFO "Horizontal Scaling value = %d", reg_value); 400 } else { 401 /* Horizontal scaling disabled */ 402 viafb_write_reg_mask(CRA2, VIACR, 0x00, BIT7); 403 } 404 405 /* Check if expansion for vertical */ 406 if (set_vres < panel_vres) { 407 /* Load Vertical Scaling Factor */ 408 switch (viaparinfo->chip_info->gfx_chip_name) { 409 case UNICHROME_CLE266: 410 case UNICHROME_K400: 411 reg_value = 412 CLE266_LCD_VER_SCF_FORMULA(set_vres, panel_vres); 413 viafb_load_reg_num = 414 lcd_scaling_factor_CLE.lcd_ver_scaling_factor. 415 reg_num; 416 reg = lcd_scaling_factor_CLE.lcd_ver_scaling_factor.reg; 417 viafb_load_reg(reg_value, 418 viafb_load_reg_num, reg, VIACR); 419 break; 420 case UNICHROME_K800: 421 case UNICHROME_PM800: 422 case UNICHROME_CN700: 423 case UNICHROME_CX700: 424 case UNICHROME_K8M890: 425 case UNICHROME_P4M890: 426 case UNICHROME_P4M900: 427 case UNICHROME_CN750: 428 case UNICHROME_VX800: 429 case UNICHROME_VX855: 430 case UNICHROME_VX900: 431 reg_value = 432 K800_LCD_VER_SCF_FORMULA(set_vres, panel_vres); 433 /* Vertical scaling enabled */ 434 viafb_write_reg_mask(CRA2, VIACR, 0x08, BIT3); 435 viafb_load_reg_num = 436 lcd_scaling_factor.lcd_ver_scaling_factor.reg_num; 437 reg = lcd_scaling_factor.lcd_ver_scaling_factor.reg; 438 viafb_load_reg(reg_value, 439 viafb_load_reg_num, reg, VIACR); 440 break; 441 } 442 443 DEBUG_MSG(KERN_INFO "Vertical Scaling value = %d", reg_value); 444 } else { 445 /* Vertical scaling disabled */ 446 viafb_write_reg_mask(CRA2, VIACR, 0x00, BIT3); 447 } 448 } 449 450 static void via_pitch_alignment_patch_lcd(int iga_path, int hres, int bpp) 451 { 452 unsigned char cr13, cr35, cr65, cr66, cr67; 453 unsigned long dwScreenPitch = 0; 454 unsigned long dwPitch; 455 456 dwPitch = hres * (bpp >> 3); 457 if (dwPitch & 0x1F) { 458 dwScreenPitch = ((dwPitch + 31) & ~31) >> 3; 459 if (iga_path == IGA2) { 460 if (bpp > 8) { 461 cr66 = (unsigned char)(dwScreenPitch & 0xFF); 462 viafb_write_reg(CR66, VIACR, cr66); 463 cr67 = viafb_read_reg(VIACR, CR67) & 0xFC; 464 cr67 |= 465 (unsigned 466 char)((dwScreenPitch & 0x300) >> 8); 467 viafb_write_reg(CR67, VIACR, cr67); 468 } 469 470 /* Fetch Count */ 471 cr67 = viafb_read_reg(VIACR, CR67) & 0xF3; 472 cr67 |= (unsigned char)((dwScreenPitch & 0x600) >> 7); 473 viafb_write_reg(CR67, VIACR, cr67); 474 cr65 = (unsigned char)((dwScreenPitch >> 1) & 0xFF); 475 cr65 += 2; 476 viafb_write_reg(CR65, VIACR, cr65); 477 } else { 478 if (bpp > 8) { 479 cr13 = (unsigned char)(dwScreenPitch & 0xFF); 480 viafb_write_reg(CR13, VIACR, cr13); 481 cr35 = viafb_read_reg(VIACR, CR35) & 0x1F; 482 cr35 |= 483 (unsigned 484 char)((dwScreenPitch & 0x700) >> 3); 485 viafb_write_reg(CR35, VIACR, cr35); 486 } 487 } 488 } 489 } 490 static void lcd_patch_skew_dvp0(struct lvds_setting_information 491 *plvds_setting_info, 492 struct lvds_chip_information *plvds_chip_info) 493 { 494 if (VT1636_LVDS == plvds_chip_info->lvds_chip_name) { 495 switch (viaparinfo->chip_info->gfx_chip_name) { 496 case UNICHROME_P4M900: 497 viafb_vt1636_patch_skew_on_vt3364(plvds_setting_info, 498 plvds_chip_info); 499 break; 500 case UNICHROME_P4M890: 501 viafb_vt1636_patch_skew_on_vt3327(plvds_setting_info, 502 plvds_chip_info); 503 break; 504 } 505 } 506 } 507 static void lcd_patch_skew_dvp1(struct lvds_setting_information 508 *plvds_setting_info, 509 struct lvds_chip_information *plvds_chip_info) 510 { 511 if (VT1636_LVDS == plvds_chip_info->lvds_chip_name) { 512 switch (viaparinfo->chip_info->gfx_chip_name) { 513 case UNICHROME_CX700: 514 viafb_vt1636_patch_skew_on_vt3324(plvds_setting_info, 515 plvds_chip_info); 516 break; 517 } 518 } 519 } 520 static void lcd_patch_skew(struct lvds_setting_information 521 *plvds_setting_info, struct lvds_chip_information *plvds_chip_info) 522 { 523 DEBUG_MSG(KERN_INFO "lcd_patch_skew\n"); 524 switch (plvds_chip_info->output_interface) { 525 case INTERFACE_DVP0: 526 lcd_patch_skew_dvp0(plvds_setting_info, plvds_chip_info); 527 break; 528 case INTERFACE_DVP1: 529 lcd_patch_skew_dvp1(plvds_setting_info, plvds_chip_info); 530 break; 531 case INTERFACE_DFP_LOW: 532 if (UNICHROME_P4M900 == viaparinfo->chip_info->gfx_chip_name) { 533 viafb_write_reg_mask(CR99, VIACR, 0x08, 534 BIT0 + BIT1 + BIT2 + BIT3); 535 } 536 break; 537 } 538 } 539 540 /* LCD Set Mode */ 541 void viafb_lcd_set_mode(const struct fb_var_screeninfo *var, u16 cxres, 542 u16 cyres, struct lvds_setting_information *plvds_setting_info, 543 struct lvds_chip_information *plvds_chip_info) 544 { 545 int set_iga = plvds_setting_info->iga_path; 546 int mode_bpp = var->bits_per_pixel; 547 int set_hres = cxres ? cxres : var->xres; 548 int set_vres = cyres ? cyres : var->yres; 549 int panel_hres = plvds_setting_info->lcd_panel_hres; 550 int panel_vres = plvds_setting_info->lcd_panel_vres; 551 u32 clock; 552 struct via_display_timing timing; 553 struct fb_var_screeninfo panel_var; 554 const struct fb_videomode *mode_crt_table, *panel_crt_table; 555 556 DEBUG_MSG(KERN_INFO "viafb_lcd_set_mode!!\n"); 557 /* Get mode table */ 558 mode_crt_table = viafb_get_best_mode(set_hres, set_vres, 60); 559 /* Get panel table Pointer */ 560 panel_crt_table = viafb_get_best_mode(panel_hres, panel_vres, 60); 561 viafb_fill_var_timing_info(&panel_var, panel_crt_table); 562 DEBUG_MSG(KERN_INFO "bellow viafb_lcd_set_mode!!\n"); 563 if (VT1636_LVDS == plvds_chip_info->lvds_chip_name) 564 viafb_init_lvds_vt1636(plvds_setting_info, plvds_chip_info); 565 clock = PICOS2KHZ(panel_crt_table->pixclock) * 1000; 566 plvds_setting_info->vclk = clock; 567 568 if (set_iga == IGA2 && (set_hres < panel_hres || set_vres < panel_vres) 569 && plvds_setting_info->display_method == LCD_EXPANDSION) { 570 timing = var_to_timing(&panel_var, panel_hres, panel_vres); 571 load_lcd_scaling(set_hres, set_vres, panel_hres, panel_vres); 572 } else { 573 timing = var_to_timing(&panel_var, set_hres, set_vres); 574 if (set_iga == IGA2) 575 /* disable scaling */ 576 via_write_reg_mask(VIACR, 0x79, 0x00, 577 BIT0 + BIT1 + BIT2); 578 } 579 580 if (set_iga == IGA1) 581 via_set_primary_timing(&timing); 582 else if (set_iga == IGA2) 583 via_set_secondary_timing(&timing); 584 585 /* Fetch count for IGA2 only */ 586 viafb_load_fetch_count_reg(set_hres, mode_bpp / 8, set_iga); 587 588 if ((viaparinfo->chip_info->gfx_chip_name != UNICHROME_CLE266) 589 && (viaparinfo->chip_info->gfx_chip_name != UNICHROME_K400)) 590 viafb_load_FIFO_reg(set_iga, set_hres, set_vres); 591 592 fill_lcd_format(); 593 viafb_set_vclock(clock, set_iga); 594 lcd_patch_skew(plvds_setting_info, plvds_chip_info); 595 596 /* If K8M800, enable LCD Prefetch Mode. */ 597 if ((viaparinfo->chip_info->gfx_chip_name == UNICHROME_K800) 598 || (UNICHROME_K8M890 == viaparinfo->chip_info->gfx_chip_name)) 599 viafb_write_reg_mask(CR6A, VIACR, 0x01, BIT0); 600 601 /* Patch for non 32bit alignment mode */ 602 via_pitch_alignment_patch_lcd(plvds_setting_info->iga_path, set_hres, 603 var->bits_per_pixel); 604 } 605 606 static void integrated_lvds_disable(struct lvds_setting_information 607 *plvds_setting_info, 608 struct lvds_chip_information *plvds_chip_info) 609 { 610 bool turn_off_first_powersequence = false; 611 bool turn_off_second_powersequence = false; 612 if (INTERFACE_LVDS0LVDS1 == plvds_chip_info->output_interface) 613 turn_off_first_powersequence = true; 614 if (INTERFACE_LVDS0 == plvds_chip_info->output_interface) 615 turn_off_first_powersequence = true; 616 if (INTERFACE_LVDS1 == plvds_chip_info->output_interface) 617 turn_off_second_powersequence = true; 618 if (turn_off_second_powersequence) { 619 /* Use second power sequence control: */ 620 621 /* Turn off power sequence. */ 622 viafb_write_reg_mask(CRD4, VIACR, 0, BIT1); 623 624 /* Turn off back light. */ 625 viafb_write_reg_mask(CRD3, VIACR, 0xC0, BIT6 + BIT7); 626 } 627 if (turn_off_first_powersequence) { 628 /* Use first power sequence control: */ 629 630 /* Turn off power sequence. */ 631 viafb_write_reg_mask(CR6A, VIACR, 0, BIT3); 632 633 /* Turn off back light. */ 634 viafb_write_reg_mask(CR91, VIACR, 0xC0, BIT6 + BIT7); 635 } 636 637 /* Power off LVDS channel. */ 638 switch (plvds_chip_info->output_interface) { 639 case INTERFACE_LVDS0: 640 { 641 viafb_write_reg_mask(CRD2, VIACR, 0x80, BIT7); 642 break; 643 } 644 645 case INTERFACE_LVDS1: 646 { 647 viafb_write_reg_mask(CRD2, VIACR, 0x40, BIT6); 648 break; 649 } 650 651 case INTERFACE_LVDS0LVDS1: 652 { 653 viafb_write_reg_mask(CRD2, VIACR, 0xC0, BIT6 + BIT7); 654 break; 655 } 656 } 657 } 658 659 static void integrated_lvds_enable(struct lvds_setting_information 660 *plvds_setting_info, 661 struct lvds_chip_information *plvds_chip_info) 662 { 663 DEBUG_MSG(KERN_INFO "integrated_lvds_enable, out_interface:%d\n", 664 plvds_chip_info->output_interface); 665 if (plvds_setting_info->lcd_mode == LCD_SPWG) 666 viafb_write_reg_mask(CRD2, VIACR, 0x00, BIT0 + BIT1); 667 else 668 viafb_write_reg_mask(CRD2, VIACR, 0x03, BIT0 + BIT1); 669 670 switch (plvds_chip_info->output_interface) { 671 case INTERFACE_LVDS0LVDS1: 672 case INTERFACE_LVDS0: 673 /* Use first power sequence control: */ 674 /* Use hardware control power sequence. */ 675 viafb_write_reg_mask(CR91, VIACR, 0, BIT0); 676 /* Turn on back light. */ 677 viafb_write_reg_mask(CR91, VIACR, 0, BIT6 + BIT7); 678 /* Turn on hardware power sequence. */ 679 viafb_write_reg_mask(CR6A, VIACR, 0x08, BIT3); 680 break; 681 case INTERFACE_LVDS1: 682 /* Use second power sequence control: */ 683 /* Use hardware control power sequence. */ 684 viafb_write_reg_mask(CRD3, VIACR, 0, BIT0); 685 /* Turn on back light. */ 686 viafb_write_reg_mask(CRD3, VIACR, 0, BIT6 + BIT7); 687 /* Turn on hardware power sequence. */ 688 viafb_write_reg_mask(CRD4, VIACR, 0x02, BIT1); 689 break; 690 } 691 692 /* Power on LVDS channel. */ 693 switch (plvds_chip_info->output_interface) { 694 case INTERFACE_LVDS0: 695 { 696 viafb_write_reg_mask(CRD2, VIACR, 0, BIT7); 697 break; 698 } 699 700 case INTERFACE_LVDS1: 701 { 702 viafb_write_reg_mask(CRD2, VIACR, 0, BIT6); 703 break; 704 } 705 706 case INTERFACE_LVDS0LVDS1: 707 { 708 viafb_write_reg_mask(CRD2, VIACR, 0, BIT6 + BIT7); 709 break; 710 } 711 } 712 } 713 714 void viafb_lcd_disable(void) 715 { 716 717 if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266) { 718 lcd_powersequence_off(); 719 /* DI1 pad off */ 720 viafb_write_reg_mask(SR1E, VIASR, 0x00, 0x30); 721 } else if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CX700) { 722 if (viafb_LCD2_ON 723 && (INTEGRATED_LVDS == 724 viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name)) 725 integrated_lvds_disable(viaparinfo->lvds_setting_info, 726 &viaparinfo->chip_info->lvds_chip_info2); 727 if (INTEGRATED_LVDS == 728 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) 729 integrated_lvds_disable(viaparinfo->lvds_setting_info, 730 &viaparinfo->chip_info->lvds_chip_info); 731 if (VT1636_LVDS == viaparinfo->chip_info-> 732 lvds_chip_info.lvds_chip_name) 733 viafb_disable_lvds_vt1636(viaparinfo->lvds_setting_info, 734 &viaparinfo->chip_info->lvds_chip_info); 735 } else if (VT1636_LVDS == 736 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) { 737 viafb_disable_lvds_vt1636(viaparinfo->lvds_setting_info, 738 &viaparinfo->chip_info->lvds_chip_info); 739 } else { 740 /* Backlight off */ 741 viafb_write_reg_mask(SR3D, VIASR, 0x00, 0x20); 742 /* 24 bit DI data paht off */ 743 viafb_write_reg_mask(CR91, VIACR, 0x80, 0x80); 744 } 745 746 /* Disable expansion bit */ 747 viafb_write_reg_mask(CR79, VIACR, 0x00, 0x01); 748 /* Simultaneout disabled */ 749 viafb_write_reg_mask(CR6B, VIACR, 0x00, 0x08); 750 } 751 752 static void set_lcd_output_path(int set_iga, int output_interface) 753 { 754 switch (output_interface) { 755 case INTERFACE_DFP: 756 if ((UNICHROME_K8M890 == viaparinfo->chip_info->gfx_chip_name) 757 || (UNICHROME_P4M890 == 758 viaparinfo->chip_info->gfx_chip_name)) 759 viafb_write_reg_mask(CR97, VIACR, 0x84, 760 BIT7 + BIT2 + BIT1 + BIT0); 761 case INTERFACE_DVP0: 762 case INTERFACE_DVP1: 763 case INTERFACE_DFP_HIGH: 764 case INTERFACE_DFP_LOW: 765 if (set_iga == IGA2) 766 viafb_write_reg(CR91, VIACR, 0x00); 767 break; 768 } 769 } 770 771 void viafb_lcd_enable(void) 772 { 773 viafb_write_reg_mask(CR6B, VIACR, 0x00, BIT3); 774 viafb_write_reg_mask(CR6A, VIACR, 0x08, BIT3); 775 set_lcd_output_path(viaparinfo->lvds_setting_info->iga_path, 776 viaparinfo->chip_info->lvds_chip_info.output_interface); 777 if (viafb_LCD2_ON) 778 set_lcd_output_path(viaparinfo->lvds_setting_info2->iga_path, 779 viaparinfo->chip_info-> 780 lvds_chip_info2.output_interface); 781 782 if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266) { 783 /* DI1 pad on */ 784 viafb_write_reg_mask(SR1E, VIASR, 0x30, 0x30); 785 lcd_powersequence_on(); 786 } else if (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CX700) { 787 if (viafb_LCD2_ON && (INTEGRATED_LVDS == 788 viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name)) 789 integrated_lvds_enable(viaparinfo->lvds_setting_info2, \ 790 &viaparinfo->chip_info->lvds_chip_info2); 791 if (INTEGRATED_LVDS == 792 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) 793 integrated_lvds_enable(viaparinfo->lvds_setting_info, 794 &viaparinfo->chip_info->lvds_chip_info); 795 if (VT1636_LVDS == viaparinfo->chip_info-> 796 lvds_chip_info.lvds_chip_name) 797 viafb_enable_lvds_vt1636(viaparinfo-> 798 lvds_setting_info, &viaparinfo->chip_info-> 799 lvds_chip_info); 800 } else if (VT1636_LVDS == 801 viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) { 802 viafb_enable_lvds_vt1636(viaparinfo->lvds_setting_info, 803 &viaparinfo->chip_info->lvds_chip_info); 804 } else { 805 /* Backlight on */ 806 viafb_write_reg_mask(SR3D, VIASR, 0x20, 0x20); 807 /* 24 bit DI data paht on */ 808 viafb_write_reg_mask(CR91, VIACR, 0x00, 0x80); 809 /* LCD enabled */ 810 viafb_write_reg_mask(CR6A, VIACR, 0x48, 0x48); 811 } 812 } 813 814 static void lcd_powersequence_off(void) 815 { 816 int i, mask, data; 817 818 /* Software control power sequence */ 819 viafb_write_reg_mask(CR91, VIACR, 0x11, 0x11); 820 821 for (i = 0; i < 3; i++) { 822 mask = PowerSequenceOff[0][i]; 823 data = PowerSequenceOff[1][i] & mask; 824 viafb_write_reg_mask(CR91, VIACR, (u8) data, (u8) mask); 825 udelay(PowerSequenceOff[2][i]); 826 } 827 828 /* Disable LCD */ 829 viafb_write_reg_mask(CR6A, VIACR, 0x00, 0x08); 830 } 831 832 static void lcd_powersequence_on(void) 833 { 834 int i, mask, data; 835 836 /* Software control power sequence */ 837 viafb_write_reg_mask(CR91, VIACR, 0x11, 0x11); 838 839 /* Enable LCD */ 840 viafb_write_reg_mask(CR6A, VIACR, 0x08, 0x08); 841 842 for (i = 0; i < 3; i++) { 843 mask = PowerSequenceOn[0][i]; 844 data = PowerSequenceOn[1][i] & mask; 845 viafb_write_reg_mask(CR91, VIACR, (u8) data, (u8) mask); 846 udelay(PowerSequenceOn[2][i]); 847 } 848 849 udelay(1); 850 } 851 852 static void fill_lcd_format(void) 853 { 854 u8 bdithering = 0, bdual = 0; 855 856 if (viaparinfo->lvds_setting_info->device_lcd_dualedge) 857 bdual = BIT4; 858 if (viaparinfo->lvds_setting_info->LCDDithering) 859 bdithering = BIT0; 860 /* Dual & Dithering */ 861 viafb_write_reg_mask(CR88, VIACR, (bdithering | bdual), BIT4 + BIT0); 862 } 863 864 static void check_diport_of_integrated_lvds( 865 struct lvds_chip_information *plvds_chip_info, 866 struct lvds_setting_information 867 *plvds_setting_info) 868 { 869 /* Determine LCD DI Port by hardware layout. */ 870 switch (viafb_display_hardware_layout) { 871 case HW_LAYOUT_LCD_ONLY: 872 { 873 if (plvds_setting_info->device_lcd_dualedge) { 874 plvds_chip_info->output_interface = 875 INTERFACE_LVDS0LVDS1; 876 } else { 877 plvds_chip_info->output_interface = 878 INTERFACE_LVDS0; 879 } 880 881 break; 882 } 883 884 case HW_LAYOUT_DVI_ONLY: 885 { 886 plvds_chip_info->output_interface = INTERFACE_NONE; 887 break; 888 } 889 890 case HW_LAYOUT_LCD1_LCD2: 891 case HW_LAYOUT_LCD_EXTERNAL_LCD2: 892 { 893 plvds_chip_info->output_interface = 894 INTERFACE_LVDS0LVDS1; 895 break; 896 } 897 898 case HW_LAYOUT_LCD_DVI: 899 { 900 plvds_chip_info->output_interface = INTERFACE_LVDS1; 901 break; 902 } 903 904 default: 905 { 906 plvds_chip_info->output_interface = INTERFACE_LVDS1; 907 break; 908 } 909 } 910 911 DEBUG_MSG(KERN_INFO 912 "Display Hardware Layout: 0x%x, LCD DI Port: 0x%x\n", 913 viafb_display_hardware_layout, 914 plvds_chip_info->output_interface); 915 } 916 917 void viafb_init_lvds_output_interface(struct lvds_chip_information 918 *plvds_chip_info, 919 struct lvds_setting_information 920 *plvds_setting_info) 921 { 922 if (INTERFACE_NONE != plvds_chip_info->output_interface) { 923 /*Do nothing, lcd port is specified by module parameter */ 924 return; 925 } 926 927 switch (plvds_chip_info->lvds_chip_name) { 928 929 case VT1636_LVDS: 930 switch (viaparinfo->chip_info->gfx_chip_name) { 931 case UNICHROME_CX700: 932 plvds_chip_info->output_interface = INTERFACE_DVP1; 933 break; 934 case UNICHROME_CN700: 935 plvds_chip_info->output_interface = INTERFACE_DFP_LOW; 936 break; 937 default: 938 plvds_chip_info->output_interface = INTERFACE_DVP0; 939 break; 940 } 941 break; 942 943 case INTEGRATED_LVDS: 944 check_diport_of_integrated_lvds(plvds_chip_info, 945 plvds_setting_info); 946 break; 947 948 default: 949 switch (viaparinfo->chip_info->gfx_chip_name) { 950 case UNICHROME_K8M890: 951 case UNICHROME_P4M900: 952 case UNICHROME_P4M890: 953 plvds_chip_info->output_interface = INTERFACE_DFP_LOW; 954 break; 955 default: 956 plvds_chip_info->output_interface = INTERFACE_DFP; 957 break; 958 } 959 break; 960 } 961 } 962 963 bool viafb_lcd_get_mobile_state(bool *mobile) 964 { 965 unsigned char __iomem *romptr, *tableptr, *biosptr; 966 u8 core_base; 967 /* Rom address */ 968 const u32 romaddr = 0x000C0000; 969 u16 start_pattern; 970 971 biosptr = ioremap(romaddr, 0x10000); 972 start_pattern = readw(biosptr); 973 974 /* Compare pattern */ 975 if (start_pattern == 0xAA55) { 976 /* Get the start of Table */ 977 /* 0x1B means BIOS offset position */ 978 romptr = biosptr + 0x1B; 979 tableptr = biosptr + readw(romptr); 980 981 /* Get the start of biosver structure */ 982 /* 18 means BIOS version position. */ 983 romptr = tableptr + 18; 984 romptr = biosptr + readw(romptr); 985 986 /* The offset should be 44, but the 987 actual image is less three char. */ 988 /* pRom += 44; */ 989 romptr += 41; 990 991 core_base = readb(romptr); 992 993 if (core_base & 0x8) 994 *mobile = false; 995 else 996 *mobile = true; 997 /* release memory */ 998 iounmap(biosptr); 999 1000 return true; 1001 } else { 1002 iounmap(biosptr); 1003 return false; 1004 } 1005 } 1006