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