1/* 2 * Geode GX video processor device. 3 * 4 * Copyright (C) 2006 Arcom Control Systems Ltd. 5 * 6 * Portions from AMD's original 2.4 driver: 7 * Copyright (C) 2004 Advanced Micro Devices, Inc. 8 * 9 * This program is free software; you can redistribute it and/or modify it 10 * under the terms of the GNU General Public License as published by the 11 * Free Software Foundation; either version 2 of the License, or (at your 12 * option) any later version. 13 */ 14#include <linux/fb.h> 15#include <linux/delay.h> 16#include <asm/io.h> 17#include <asm/delay.h> 18#include <asm/msr.h> 19 20#include "geodefb.h" 21#include "video_gx.h" 22 23 24/* 25 * Tables of register settings for various DOTCLKs. 26 */ 27struct gx_pll_entry { 28 long pixclock; /* ps */ 29 u32 sys_rstpll_bits; 30 u32 dotpll_value; 31}; 32 33#define POSTDIV3 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3) 34#define PREMULT2 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPREMULT2) 35#define PREDIV2 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3) 36 37static const struct gx_pll_entry gx_pll_table_48MHz[] = { 38 { 40123, POSTDIV3, 0x00000BF2 }, /* 24.9230 */ 39 { 39721, 0, 0x00000037 }, /* 25.1750 */ 40 { 35308, POSTDIV3|PREMULT2, 0x00000B1A }, /* 28.3220 */ 41 { 31746, POSTDIV3, 0x000002D2 }, /* 31.5000 */ 42 { 27777, POSTDIV3|PREMULT2, 0x00000FE2 }, /* 36.0000 */ 43 { 26666, POSTDIV3, 0x0000057A }, /* 37.5000 */ 44 { 25000, POSTDIV3, 0x0000030A }, /* 40.0000 */ 45 { 22271, 0, 0x00000063 }, /* 44.9000 */ 46 { 20202, 0, 0x0000054B }, /* 49.5000 */ 47 { 20000, 0, 0x0000026E }, /* 50.0000 */ 48 { 19860, PREMULT2, 0x00000037 }, /* 50.3500 */ 49 { 18518, POSTDIV3|PREMULT2, 0x00000B0D }, /* 54.0000 */ 50 { 17777, 0, 0x00000577 }, /* 56.2500 */ 51 { 17733, 0, 0x000007F7 }, /* 56.3916 */ 52 { 17653, 0, 0x0000057B }, /* 56.6444 */ 53 { 16949, PREMULT2, 0x00000707 }, /* 59.0000 */ 54 { 15873, POSTDIV3|PREMULT2, 0x00000B39 }, /* 63.0000 */ 55 { 15384, POSTDIV3|PREMULT2, 0x00000B45 }, /* 65.0000 */ 56 { 14814, POSTDIV3|PREMULT2, 0x00000FC1 }, /* 67.5000 */ 57 { 14124, POSTDIV3, 0x00000561 }, /* 70.8000 */ 58 { 13888, POSTDIV3, 0x000007E1 }, /* 72.0000 */ 59 { 13426, PREMULT2, 0x00000F4A }, /* 74.4810 */ 60 { 13333, 0, 0x00000052 }, /* 75.0000 */ 61 { 12698, 0, 0x00000056 }, /* 78.7500 */ 62 { 12500, POSTDIV3|PREMULT2, 0x00000709 }, /* 80.0000 */ 63 { 11135, PREMULT2, 0x00000262 }, /* 89.8000 */ 64 { 10582, 0, 0x000002D2 }, /* 94.5000 */ 65 { 10101, PREMULT2, 0x00000B4A }, /* 99.0000 */ 66 { 10000, PREMULT2, 0x00000036 }, /* 100.0000 */ 67 { 9259, 0, 0x000007E2 }, /* 108.0000 */ 68 { 8888, 0, 0x000007F6 }, /* 112.5000 */ 69 { 7692, POSTDIV3|PREMULT2, 0x00000FB0 }, /* 130.0000 */ 70 { 7407, POSTDIV3|PREMULT2, 0x00000B50 }, /* 135.0000 */ 71 { 6349, 0, 0x00000055 }, /* 157.5000 */ 72 { 6172, 0, 0x000009C1 }, /* 162.0000 */ 73 { 5787, PREMULT2, 0x0000002D }, /* 172.798 */ 74 { 5698, 0, 0x000002C1 }, /* 175.5000 */ 75 { 5291, 0, 0x000002D1 }, /* 189.0000 */ 76 { 4938, 0, 0x00000551 }, /* 202.5000 */ 77 { 4357, 0, 0x0000057D }, /* 229.5000 */ 78}; 79 80static const struct gx_pll_entry gx_pll_table_14MHz[] = { 81 { 39721, 0, 0x00000037 }, /* 25.1750 */ 82 { 35308, 0, 0x00000B7B }, /* 28.3220 */ 83 { 31746, 0, 0x000004D3 }, /* 31.5000 */ 84 { 27777, 0, 0x00000BE3 }, /* 36.0000 */ 85 { 26666, 0, 0x0000074F }, /* 37.5000 */ 86 { 25000, 0, 0x0000050B }, /* 40.0000 */ 87 { 22271, 0, 0x00000063 }, /* 44.9000 */ 88 { 20202, 0, 0x0000054B }, /* 49.5000 */ 89 { 20000, 0, 0x0000026E }, /* 50.0000 */ 90 { 19860, 0, 0x000007C3 }, /* 50.3500 */ 91 { 18518, 0, 0x000007E3 }, /* 54.0000 */ 92 { 17777, 0, 0x00000577 }, /* 56.2500 */ 93 { 17733, 0, 0x000002FB }, /* 56.3916 */ 94 { 17653, 0, 0x0000057B }, /* 56.6444 */ 95 { 16949, 0, 0x0000058B }, /* 59.0000 */ 96 { 15873, 0, 0x0000095E }, /* 63.0000 */ 97 { 15384, 0, 0x0000096A }, /* 65.0000 */ 98 { 14814, 0, 0x00000BC2 }, /* 67.5000 */ 99 { 14124, 0, 0x0000098A }, /* 70.8000 */ 100 { 13888, 0, 0x00000BE2 }, /* 72.0000 */ 101 { 13333, 0, 0x00000052 }, /* 75.0000 */ 102 { 12698, 0, 0x00000056 }, /* 78.7500 */ 103 { 12500, 0, 0x0000050A }, /* 80.0000 */ 104 { 11135, 0, 0x0000078E }, /* 89.8000 */ 105 { 10582, 0, 0x000002D2 }, /* 94.5000 */ 106 { 10101, 0, 0x000011F6 }, /* 99.0000 */ 107 { 10000, 0, 0x0000054E }, /* 100.0000 */ 108 { 9259, 0, 0x000007E2 }, /* 108.0000 */ 109 { 8888, 0, 0x000002FA }, /* 112.5000 */ 110 { 7692, 0, 0x00000BB1 }, /* 130.0000 */ 111 { 7407, 0, 0x00000975 }, /* 135.0000 */ 112 { 6349, 0, 0x00000055 }, /* 157.5000 */ 113 { 6172, 0, 0x000009C1 }, /* 162.0000 */ 114 { 5698, 0, 0x000002C1 }, /* 175.5000 */ 115 { 5291, 0, 0x00000539 }, /* 189.0000 */ 116 { 4938, 0, 0x00000551 }, /* 202.5000 */ 117 { 4357, 0, 0x0000057D }, /* 229.5000 */ 118}; 119 120static void gx_set_dclk_frequency(struct fb_info *info) 121{ 122 const struct gx_pll_entry *pll_table; 123 int pll_table_len; 124 int i, best_i; 125 long min, diff; 126 u64 dotpll, sys_rstpll; 127 int timeout = 1000; 128 129 /* Rev. 1 Geode GXs use a 14 MHz reference clock instead of 48 MHz. */ 130 if (cpu_data->x86_mask == 1) { 131 pll_table = gx_pll_table_14MHz; 132 pll_table_len = ARRAY_SIZE(gx_pll_table_14MHz); 133 } else { 134 pll_table = gx_pll_table_48MHz; 135 pll_table_len = ARRAY_SIZE(gx_pll_table_48MHz); 136 } 137 138 /* Search the table for the closest pixclock. */ 139 best_i = 0; 140 min = abs(pll_table[0].pixclock - info->var.pixclock); 141 for (i = 1; i < pll_table_len; i++) { 142 diff = abs(pll_table[i].pixclock - info->var.pixclock); 143 if (diff < min) { 144 min = diff; 145 best_i = i; 146 } 147 } 148 149 rdmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll); 150 rdmsrl(MSR_GLCP_DOTPLL, dotpll); 151 152 /* Program new M, N and P. */ 153 dotpll &= 0x00000000ffffffffull; 154 dotpll |= (u64)pll_table[best_i].dotpll_value << 32; 155 dotpll |= MSR_GLCP_DOTPLL_DOTRESET; 156 dotpll &= ~MSR_GLCP_DOTPLL_BYPASS; 157 158 wrmsrl(MSR_GLCP_DOTPLL, dotpll); 159 160 /* Program dividers. */ 161 sys_rstpll &= ~( MSR_GLCP_SYS_RSTPLL_DOTPREDIV2 162 | MSR_GLCP_SYS_RSTPLL_DOTPREMULT2 163 | MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3 ); 164 sys_rstpll |= pll_table[best_i].sys_rstpll_bits; 165 166 wrmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll); 167 168 /* Clear reset bit to start PLL. */ 169 dotpll &= ~(MSR_GLCP_DOTPLL_DOTRESET); 170 wrmsrl(MSR_GLCP_DOTPLL, dotpll); 171 172 /* Wait for LOCK bit. */ 173 do { 174 rdmsrl(MSR_GLCP_DOTPLL, dotpll); 175 } while (timeout-- && !(dotpll & MSR_GLCP_DOTPLL_LOCK)); 176} 177 178static void 179gx_configure_tft(struct fb_info *info) 180{ 181 struct geodefb_par *par = info->par; 182 unsigned long val; 183 unsigned long fp; 184 185 /* Set up the DF pad select MSR */ 186 187 rdmsrl(GX_VP_MSR_PAD_SELECT, val); 188 val &= ~GX_VP_PAD_SELECT_MASK; 189 val |= GX_VP_PAD_SELECT_TFT; 190 wrmsrl(GX_VP_MSR_PAD_SELECT, val); 191 192 /* Turn off the panel */ 193 194 fp = readl(par->vid_regs + GX_FP_PM); 195 fp &= ~GX_FP_PM_P; 196 writel(fp, par->vid_regs + GX_FP_PM); 197 198 /* Set timing 1 */ 199 200 fp = readl(par->vid_regs + GX_FP_PT1); 201 fp &= GX_FP_PT1_VSIZE_MASK; 202 fp |= info->var.yres << GX_FP_PT1_VSIZE_SHIFT; 203 writel(fp, par->vid_regs + GX_FP_PT1); 204 205 /* Timing 2 */ 206 /* Set bits that are always on for TFT */ 207 208 fp = 0x0F100000; 209 210 /* Add sync polarity */ 211 212 if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT)) 213 fp |= GX_FP_PT2_VSP; 214 215 if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT)) 216 fp |= GX_FP_PT2_HSP; 217 218 writel(fp, par->vid_regs + GX_FP_PT2); 219 220 /* Set the dither control */ 221 writel(0x70, par->vid_regs + GX_FP_DFC); 222 223 /* Enable the FP data and power (in case the BIOS didn't) */ 224 225 fp = readl(par->vid_regs + GX_DCFG); 226 fp |= GX_DCFG_FP_PWR_EN | GX_DCFG_FP_DATA_EN; 227 writel(fp, par->vid_regs + GX_DCFG); 228 229 /* Unblank the panel */ 230 231 fp = readl(par->vid_regs + GX_FP_PM); 232 fp |= GX_FP_PM_P; 233 writel(fp, par->vid_regs + GX_FP_PM); 234} 235 236static void gx_configure_display(struct fb_info *info) 237{ 238 struct geodefb_par *par = info->par; 239 u32 dcfg, misc; 240 241 /* Set up the MISC register */ 242 243 misc = readl(par->vid_regs + GX_MISC); 244 245 /* Power up the DAC */ 246 misc &= ~(GX_MISC_A_PWRDN | GX_MISC_DAC_PWRDN); 247 248 /* Disable gamma correction */ 249 misc |= GX_MISC_GAM_EN; 250 251 writel(misc, par->vid_regs + GX_MISC); 252 253 /* Write the display configuration */ 254 dcfg = readl(par->vid_regs + GX_DCFG); 255 256 /* Disable hsync and vsync */ 257 dcfg &= ~(GX_DCFG_VSYNC_EN | GX_DCFG_HSYNC_EN); 258 writel(dcfg, par->vid_regs + GX_DCFG); 259 260 /* Clear bits from existing mode. */ 261 dcfg &= ~(GX_DCFG_CRT_SYNC_SKW_MASK 262 | GX_DCFG_CRT_HSYNC_POL | GX_DCFG_CRT_VSYNC_POL 263 | GX_DCFG_VSYNC_EN | GX_DCFG_HSYNC_EN); 264 265 /* Set default sync skew. */ 266 dcfg |= GX_DCFG_CRT_SYNC_SKW_DFLT; 267 268 /* Enable hsync and vsync. */ 269 dcfg |= GX_DCFG_HSYNC_EN | GX_DCFG_VSYNC_EN; 270 271 /* Sync polarities. */ 272 if (info->var.sync & FB_SYNC_HOR_HIGH_ACT) 273 dcfg |= GX_DCFG_CRT_HSYNC_POL; 274 if (info->var.sync & FB_SYNC_VERT_HIGH_ACT) 275 dcfg |= GX_DCFG_CRT_VSYNC_POL; 276 277 /* Enable the display logic */ 278 /* Set up the DACS to blank normally */ 279 280 dcfg |= GX_DCFG_CRT_EN | GX_DCFG_DAC_BL_EN; 281 282 /* Enable the external DAC VREF? */ 283 284 writel(dcfg, par->vid_regs + GX_DCFG); 285 286 /* Set up the flat panel (if it is enabled) */ 287 288 if (par->enable_crt == 0) 289 gx_configure_tft(info); 290} 291 292static int gx_blank_display(struct fb_info *info, int blank_mode) 293{ 294 struct geodefb_par *par = info->par; 295 u32 dcfg, fp_pm; 296 int blank, hsync, vsync; 297 298 /* CRT power saving modes. */ 299 switch (blank_mode) { 300 case FB_BLANK_UNBLANK: 301 blank = 0; hsync = 1; vsync = 1; 302 break; 303 case FB_BLANK_NORMAL: 304 blank = 1; hsync = 1; vsync = 1; 305 break; 306 case FB_BLANK_VSYNC_SUSPEND: 307 blank = 1; hsync = 1; vsync = 0; 308 break; 309 case FB_BLANK_HSYNC_SUSPEND: 310 blank = 1; hsync = 0; vsync = 1; 311 break; 312 case FB_BLANK_POWERDOWN: 313 blank = 1; hsync = 0; vsync = 0; 314 break; 315 default: 316 return -EINVAL; 317 } 318 dcfg = readl(par->vid_regs + GX_DCFG); 319 dcfg &= ~(GX_DCFG_DAC_BL_EN 320 | GX_DCFG_HSYNC_EN | GX_DCFG_VSYNC_EN); 321 if (!blank) 322 dcfg |= GX_DCFG_DAC_BL_EN; 323 if (hsync) 324 dcfg |= GX_DCFG_HSYNC_EN; 325 if (vsync) 326 dcfg |= GX_DCFG_VSYNC_EN; 327 writel(dcfg, par->vid_regs + GX_DCFG); 328 329 /* Power on/off flat panel. */ 330 331 if (par->enable_crt == 0) { 332 fp_pm = readl(par->vid_regs + GX_FP_PM); 333 if (blank_mode == FB_BLANK_POWERDOWN) 334 fp_pm &= ~GX_FP_PM_P; 335 else 336 fp_pm |= GX_FP_PM_P; 337 writel(fp_pm, par->vid_regs + GX_FP_PM); 338 } 339 340 return 0; 341} 342 343struct geode_vid_ops gx_vid_ops = { 344 .set_dclk = gx_set_dclk_frequency, 345 .configure_display = gx_configure_display, 346 .blank_display = gx_blank_display, 347}; 348