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: &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(value: 0, LUT_INDEX_WRITE);
156 for (i = 0; i < 256; i++) {
157 outb(value: gamma_table[i] >> 16, LUT_DATA);
158 outb(value: gamma_table[i] >> 8 & 0xFF, LUT_DATA);
159 outb(value: 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(value: 0, LUT_INDEX_WRITE);
174 for (i = 0; i < 256; i++) {
175 outb(value: gamma_table[i] >> 16, LUT_DATA);
176 outb(value: gamma_table[i] >> 8 & 0xFF, LUT_DATA);
177 outb(value: 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(value: 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}
229

source code of linux/drivers/video/fbdev/via/via_utility.c