drivers/video/fbdev/via/via_utility.c

   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
  11 void 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
  22 void 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
  36 bool 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
 118 void 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
 183 void 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
 222 void 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 }