via_utility.c (5344B)
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 8#include <linux/via-core.h> 9#include "global.h" 10 11void viafb_get_device_support_state(u32 *support_state) 12{ 13 *support_state = CRT_Device; 14 15 if (viaparinfo->chip_info->tmds_chip_info.tmds_chip_name == VT1632_TMDS) 16 *support_state |= DVI_Device; 17 18 if (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name == VT1631_LVDS) 19 *support_state |= LCD_Device; 20} 21 22void viafb_get_device_connect_state(u32 *connect_state) 23{ 24 bool mobile = false; 25 26 *connect_state = CRT_Device; 27 28 if (viafb_dvi_sense()) 29 *connect_state |= DVI_Device; 30 31 viafb_lcd_get_mobile_state(&mobile); 32 if (mobile) 33 *connect_state |= LCD_Device; 34} 35 36bool viafb_lcd_get_support_expand_state(u32 xres, u32 yres) 37{ 38 unsigned int support_state = 0; 39 40 switch (viafb_lcd_panel_id) { 41 case LCD_PANEL_ID0_640X480: 42 if ((xres < 640) && (yres < 480)) 43 support_state = true; 44 break; 45 46 case LCD_PANEL_ID1_800X600: 47 if ((xres < 800) && (yres < 600)) 48 support_state = true; 49 break; 50 51 case LCD_PANEL_ID2_1024X768: 52 if ((xres < 1024) && (yres < 768)) 53 support_state = true; 54 break; 55 56 case LCD_PANEL_ID3_1280X768: 57 if ((xres < 1280) && (yres < 768)) 58 support_state = true; 59 break; 60 61 case LCD_PANEL_ID4_1280X1024: 62 if ((xres < 1280) && (yres < 1024)) 63 support_state = true; 64 break; 65 66 case LCD_PANEL_ID5_1400X1050: 67 if ((xres < 1400) && (yres < 1050)) 68 support_state = true; 69 break; 70 71 case LCD_PANEL_ID6_1600X1200: 72 if ((xres < 1600) && (yres < 1200)) 73 support_state = true; 74 break; 75 76 case LCD_PANEL_ID7_1366X768: 77 if ((xres < 1366) && (yres < 768)) 78 support_state = true; 79 break; 80 81 case LCD_PANEL_ID8_1024X600: 82 if ((xres < 1024) && (yres < 600)) 83 support_state = true; 84 break; 85 86 case LCD_PANEL_ID9_1280X800: 87 if ((xres < 1280) && (yres < 800)) 88 support_state = true; 89 break; 90 91 case LCD_PANEL_IDA_800X480: 92 if ((xres < 800) && (yres < 480)) 93 support_state = true; 94 break; 95 96 case LCD_PANEL_IDB_1360X768: 97 if ((xres < 1360) && (yres < 768)) 98 support_state = true; 99 break; 100 101 case LCD_PANEL_IDC_480X640: 102 if ((xres < 480) && (yres < 640)) 103 support_state = true; 104 break; 105 106 default: 107 support_state = false; 108 break; 109 } 110 111 return support_state; 112} 113 114/*====================================================================*/ 115/* Gamma Function Implementation*/ 116/*====================================================================*/ 117 118void viafb_set_gamma_table(int bpp, unsigned int *gamma_table) 119{ 120 int i, sr1a; 121 int active_device_amount = 0; 122 int device_status = viafb_DeviceStatus; 123 124 for (i = 0; i < sizeof(viafb_DeviceStatus) * 8; i++) { 125 if (device_status & 1) 126 active_device_amount++; 127 device_status >>= 1; 128 } 129 130 /* 8 bpp mode can't adjust gamma */ 131 if (bpp == 8) 132 return ; 133 134 /* Enable Gamma */ 135 switch (viaparinfo->chip_info->gfx_chip_name) { 136 case UNICHROME_CLE266: 137 case UNICHROME_K400: 138 viafb_write_reg_mask(SR16, VIASR, 0x80, BIT7); 139 break; 140 141 case UNICHROME_K800: 142 case UNICHROME_PM800: 143 case UNICHROME_CN700: 144 case UNICHROME_CX700: 145 case UNICHROME_K8M890: 146 case UNICHROME_P4M890: 147 case UNICHROME_P4M900: 148 viafb_write_reg_mask(CR33, VIACR, 0x80, BIT7); 149 break; 150 } 151 sr1a = (unsigned int)viafb_read_reg(VIASR, SR1A); 152 viafb_write_reg_mask(SR1A, VIASR, 0x0, BIT0); 153 154 /* Fill IGA1 Gamma Table */ 155 outb(0, LUT_INDEX_WRITE); 156 for (i = 0; i < 256; i++) { 157 outb(gamma_table[i] >> 16, LUT_DATA); 158 outb(gamma_table[i] >> 8 & 0xFF, LUT_DATA); 159 outb(gamma_table[i] & 0xFF, LUT_DATA); 160 } 161 162 /* If adjust Gamma value in SAMM, fill IGA1, 163 IGA2 Gamma table simultaneous. */ 164 /* Switch to IGA2 Gamma Table */ 165 if ((active_device_amount > 1) && 166 !((viaparinfo->chip_info->gfx_chip_name == 167 UNICHROME_CLE266) && 168 (viaparinfo->chip_info->gfx_chip_revision < 15))) { 169 viafb_write_reg_mask(SR1A, VIASR, 0x01, BIT0); 170 viafb_write_reg_mask(CR6A, VIACR, 0x02, BIT1); 171 172 /* Fill IGA2 Gamma Table */ 173 outb(0, LUT_INDEX_WRITE); 174 for (i = 0; i < 256; i++) { 175 outb(gamma_table[i] >> 16, LUT_DATA); 176 outb(gamma_table[i] >> 8 & 0xFF, LUT_DATA); 177 outb(gamma_table[i] & 0xFF, LUT_DATA); 178 } 179 } 180 viafb_write_reg(SR1A, VIASR, sr1a); 181} 182 183void viafb_get_gamma_table(unsigned int *gamma_table) 184{ 185 unsigned char color_r, color_g, color_b; 186 unsigned char sr1a = 0; 187 int i; 188 189 /* Enable Gamma */ 190 switch (viaparinfo->chip_info->gfx_chip_name) { 191 case UNICHROME_CLE266: 192 case UNICHROME_K400: 193 viafb_write_reg_mask(SR16, VIASR, 0x80, BIT7); 194 break; 195 196 case UNICHROME_K800: 197 case UNICHROME_PM800: 198 case UNICHROME_CN700: 199 case UNICHROME_CX700: 200 case UNICHROME_K8M890: 201 case UNICHROME_P4M890: 202 case UNICHROME_P4M900: 203 viafb_write_reg_mask(CR33, VIACR, 0x80, BIT7); 204 break; 205 } 206 sr1a = viafb_read_reg(VIASR, SR1A); 207 viafb_write_reg_mask(SR1A, VIASR, 0x0, BIT0); 208 209 /* Reading gamma table to get color value */ 210 outb(0, LUT_INDEX_READ); 211 for (i = 0; i < 256; i++) { 212 color_r = inb(LUT_DATA); 213 color_g = inb(LUT_DATA); 214 color_b = inb(LUT_DATA); 215 gamma_table[i] = 216 ((((u32) color_r) << 16) | 217 (((u16) color_g) << 8)) | color_b; 218 } 219 viafb_write_reg(SR1A, VIASR, sr1a); 220} 221 222void viafb_get_gamma_support_state(int bpp, unsigned int *support_state) 223{ 224 if (bpp == 8) 225 *support_state = None_Device; 226 else 227 *support_state = CRT_Device | DVI_Device | LCD_Device; 228}