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