[linux-2.6-block.git] / drivers / video / via / via_utility.c

/*
 * Copyright 1998-2008 VIA Technologies, Inc. All Rights Reserved.
 * Copyright 2001-2008 S3 Graphics, Inc. All Rights Reserved.

 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public
 * License as published by the Free Software Foundation;
 * either version 2, or (at your option) any later version.

 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTIES OR REPRESENTATIONS; without even
 * the implied warranty of MERCHANTABILITY or FITNESS FOR
 * A PARTICULAR PURPOSE.See the GNU General Public License
 * for more details.

 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc.,
 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

#include "global.h"

void viafb_get_device_support_state(u32 *support_state)
{
	*support_state = CRT_Device;

	if (viaparinfo->chip_info->tmds_chip_info.tmds_chip_name == VT1632_TMDS)
		*support_state |= DVI_Device;

	if (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name == VT1631_LVDS)
		*support_state |= LCD_Device;
}

void viafb_get_device_connect_state(u32 *connect_state)
{
	bool mobile = false;

	*connect_state = CRT_Device;

	if (viafb_dvi_sense())
		*connect_state |= DVI_Device;

	viafb_lcd_get_mobile_state(&mobile);
	if (mobile)
		*connect_state |= LCD_Device;
}

bool viafb_lcd_get_support_expand_state(u32 xres, u32 yres)
{
	unsigned int support_state = 0;

	switch (viafb_lcd_panel_id) {
	case LCD_PANEL_ID0_640X480:
		if ((xres < 640) && (yres < 480))
			support_state = true;
		break;

	case LCD_PANEL_ID1_800X600:
		if ((xres < 800) && (yres < 600))
			support_state = true;
		break;

	case LCD_PANEL_ID2_1024X768:
		if ((xres < 1024) && (yres < 768))
			support_state = true;
		break;

	case LCD_PANEL_ID3_1280X768:
		if ((xres < 1280) && (yres < 768))
			support_state = true;
		break;

	case LCD_PANEL_ID4_1280X1024:
		if ((xres < 1280) && (yres < 1024))
			support_state = true;
		break;

	case LCD_PANEL_ID5_1400X1050:
		if ((xres < 1400) && (yres < 1050))
			support_state = true;
		break;

	case LCD_PANEL_ID6_1600X1200:
		if ((xres < 1600) && (yres < 1200))
			support_state = true;
		break;

	case LCD_PANEL_ID7_1366X768:
		if ((xres < 1366) && (yres < 768))
			support_state = true;
		break;

	case LCD_PANEL_ID8_1024X600:
		if ((xres < 1024) && (yres < 600))
			support_state = true;
		break;

	case LCD_PANEL_ID9_1280X800:
		if ((xres < 1280) && (yres < 800))
			support_state = true;
		break;

	case LCD_PANEL_IDA_800X480:
		if ((xres < 800) && (yres < 480))
			support_state = true;
		break;

	case LCD_PANEL_IDB_1360X768:
		if ((xres < 1360) && (yres < 768))
			support_state = true;
		break;

	case LCD_PANEL_IDC_480X640:
		if ((xres < 480) && (yres < 640))
			support_state = true;
		break;

	default:
		support_state = false;
		break;
	}

	return support_state;
}

/*====================================================================*/
/*                      Gamma Function Implementation*/
/*====================================================================*/

void viafb_set_gamma_table(int bpp, unsigned int *gamma_table)
{
	int i, sr1a;
	int active_device_amount = 0;
	int device_status = viafb_DeviceStatus;

	for (i = 0; i < sizeof(viafb_DeviceStatus) * 8; i++) {
		if (device_status & 1)
			active_device_amount++;
		device_status >>= 1;
	}

	/* 8 bpp mode can't adjust gamma */
	if (bpp == 8)
		return ;

	/* Enable Gamma */
	switch (viaparinfo->chip_info->gfx_chip_name) {
	case UNICHROME_CLE266:
	case UNICHROME_K400:
		viafb_write_reg_mask(SR16, VIASR, 0x80, BIT7);
		break;

	case UNICHROME_K800:
	case UNICHROME_PM800:
	case UNICHROME_CN700:
	case UNICHROME_CX700:
	case UNICHROME_K8M890:
	case UNICHROME_P4M890:
	case UNICHROME_P4M900:
		viafb_write_reg_mask(CR33, VIACR, 0x80, BIT7);
		break;
	}
	sr1a = (unsigned int)viafb_read_reg(VIASR, SR1A);
	viafb_write_reg_mask(SR1A, VIASR, 0x0, BIT0);

	/* Fill IGA1 Gamma Table */
	outb(0, LUT_INDEX_WRITE);
	for (i = 0; i < 256; i++) {
		outb(gamma_table[i] >> 16, LUT_DATA);
		outb(gamma_table[i] >> 8 & 0xFF, LUT_DATA);
		outb(gamma_table[i] & 0xFF, LUT_DATA);
	}

	/* If adjust Gamma value in SAMM, fill IGA1,
	   IGA2 Gamma table simultanous. */
	/* Switch to IGA2 Gamma Table */
	if ((active_device_amount > 1) &&
		!((viaparinfo->chip_info->gfx_chip_name ==
		UNICHROME_CLE266) &&
		(viaparinfo->chip_info->gfx_chip_revision < 15))) {
		viafb_write_reg_mask(SR1A, VIASR, 0x01, BIT0);
		viafb_write_reg_mask(CR6A, VIACR, 0x02, BIT1);

		/* Fill IGA2 Gamma Table */
		outb(0, LUT_INDEX_WRITE);
		for (i = 0; i < 256; i++) {
			outb(gamma_table[i] >> 16, LUT_DATA);
			outb(gamma_table[i] >> 8 & 0xFF, LUT_DATA);
			outb(gamma_table[i] & 0xFF, LUT_DATA);
		}
	}
	viafb_write_reg(SR1A, VIASR, sr1a);
}

void viafb_get_gamma_table(unsigned int *gamma_table)
{
	unsigned char color_r, color_g, color_b;
	unsigned char sr1a = 0;
	int i;

	/* Enable Gamma */
	switch (viaparinfo->chip_info->gfx_chip_name) {
	case UNICHROME_CLE266:
	case UNICHROME_K400:
		viafb_write_reg_mask(SR16, VIASR, 0x80, BIT7);
		break;

	case UNICHROME_K800:
	case UNICHROME_PM800:
	case UNICHROME_CN700:
	case UNICHROME_CX700:
	case UNICHROME_K8M890:
	case UNICHROME_P4M890:
	case UNICHROME_P4M900:
		viafb_write_reg_mask(CR33, VIACR, 0x80, BIT7);
		break;
	}
	sr1a = viafb_read_reg(VIASR, SR1A);
	viafb_write_reg_mask(SR1A, VIASR, 0x0, BIT0);

	/* Reading gamma table to get color value */
	outb(0, LUT_INDEX_READ);
	for (i = 0; i < 256; i++) {
		color_r = inb(LUT_DATA);
		color_g = inb(LUT_DATA);
		color_b = inb(LUT_DATA);
		gamma_table[i] =
		    ((((u32) color_r) << 16) |
		     (((u16) color_g) << 8)) | color_b;
	}
	viafb_write_reg(SR1A, VIASR, sr1a);
}

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