cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

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}