g80_display.c revision bd2f6fc9
1fc5a983dSmrg/* 2fc5a983dSmrg * Copyright (c) 2007 NVIDIA, Corporation 3fc5a983dSmrg * 4fc5a983dSmrg * Permission is hereby granted, free of charge, to any person obtaining a 5fc5a983dSmrg * copy of this software and associated documentation files (the 6fc5a983dSmrg * "Software"), to deal in the Software without restriction, including 7fc5a983dSmrg * without limitation the rights to use, copy, modify, merge, publish, 8fc5a983dSmrg * distribute, sublicense, and/or sell copies of the Software, and to 9fc5a983dSmrg * permit persons to whom the Software is furnished to do so, subject to 10fc5a983dSmrg * the following conditions: 11fc5a983dSmrg * 12fc5a983dSmrg * The above copyright notice and this permission notice shall be included 13fc5a983dSmrg * in all copies or substantial portions of the Software. 14fc5a983dSmrg * 15fc5a983dSmrg * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS 16fc5a983dSmrg * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 17fc5a983dSmrg * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. 18fc5a983dSmrg * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY 19fc5a983dSmrg * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, 20fc5a983dSmrg * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE 21fc5a983dSmrg * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 22fc5a983dSmrg */ 23fc5a983dSmrg 24fc5a983dSmrg 25fc5a983dSmrg#ifdef HAVE_CONFIG_H 26fc5a983dSmrg#include "config.h" 27fc5a983dSmrg#endif 28fc5a983dSmrg 29fc5a983dSmrg#include <float.h> 30fc5a983dSmrg#include <math.h> 31fc5a983dSmrg#include <strings.h> 32fc5a983dSmrg#include <unistd.h> 33fc5a983dSmrg 34fc5a983dSmrg#include "g80_type.h" 35fc5a983dSmrg#include "g80_cursor.h" 36fc5a983dSmrg#include "g80_display.h" 37fc5a983dSmrg#include "g80_output.h" 38fc5a983dSmrg 39fc5a983dSmrgtypedef struct G80CrtcPrivRec { 40fc5a983dSmrg Head head; 41fc5a983dSmrg int pclk; /* Target pixel clock in kHz */ 42fc5a983dSmrg Bool cursorVisible; 43fc5a983dSmrg Bool skipModeFixup; 44fc5a983dSmrg Bool dither; 45fc5a983dSmrg} G80CrtcPrivRec, *G80CrtcPrivPtr; 46fc5a983dSmrg 47fc5a983dSmrgstatic void G80CrtcShowHideCursor(xf86CrtcPtr crtc, Bool show, Bool update); 48fc5a983dSmrg 49fc5a983dSmrg/* 50fc5a983dSmrg * PLL calculation. pclk is in kHz. 51fc5a983dSmrg */ 52fc5a983dSmrgstatic void 53fc5a983dSmrgG80CalcPLL(float pclk, int *pNA, int *pMA, int *pNB, int *pMB, int *pP) 54fc5a983dSmrg{ 55fc5a983dSmrg const float refclk = 27000.0f; 56fc5a983dSmrg const float minVcoA = 100000; 57fc5a983dSmrg const float maxVcoA = 400000; 58fc5a983dSmrg const float minVcoB = 600000; 59fc5a983dSmrg float maxVcoB = 1400000; 60fc5a983dSmrg const float minUA = 2000; 61fc5a983dSmrg const float maxUA = 400000; 62fc5a983dSmrg const float minUB = 50000; 63fc5a983dSmrg const float maxUB = 200000; 64fc5a983dSmrg const int minNA = 1, maxNA = 255; 65fc5a983dSmrg const int minNB = 1, maxNB = 31; 66fc5a983dSmrg const int minMA = 1, maxMA = 255; 67fc5a983dSmrg const int minMB = 1, maxMB = 31; 68fc5a983dSmrg const int minP = 0, maxP = 6; 69fc5a983dSmrg int lowP, highP; 70fc5a983dSmrg float vcoB; 71fc5a983dSmrg 72fc5a983dSmrg int na, ma, nb, mb, p; 73fc5a983dSmrg float bestError = FLT_MAX; 74fc5a983dSmrg 75fc5a983dSmrg *pNA = *pMA = *pNB = *pMB = *pP = 0; 76fc5a983dSmrg 77fc5a983dSmrg if(maxVcoB < pclk + pclk / 200) 78fc5a983dSmrg maxVcoB = pclk + pclk / 200; 79fc5a983dSmrg if(minVcoB / (1 << maxP) > pclk) 80fc5a983dSmrg pclk = minVcoB / (1 << maxP); 81fc5a983dSmrg 82fc5a983dSmrg vcoB = maxVcoB - maxVcoB / 200; 83fc5a983dSmrg lowP = minP; 84fc5a983dSmrg vcoB /= 1 << (lowP + 1); 85fc5a983dSmrg 86fc5a983dSmrg while(pclk <= vcoB && lowP < maxP) 87fc5a983dSmrg { 88fc5a983dSmrg vcoB /= 2; 89fc5a983dSmrg lowP++; 90fc5a983dSmrg } 91fc5a983dSmrg 92fc5a983dSmrg vcoB = maxVcoB + maxVcoB / 200; 93fc5a983dSmrg highP = lowP; 94fc5a983dSmrg vcoB /= 1 << (highP + 1); 95fc5a983dSmrg 96fc5a983dSmrg while(pclk <= vcoB && highP < maxP) 97fc5a983dSmrg { 98fc5a983dSmrg vcoB /= 2; 99fc5a983dSmrg highP++; 100fc5a983dSmrg } 101fc5a983dSmrg 102fc5a983dSmrg for(p = lowP; p <= highP; p++) 103fc5a983dSmrg { 104fc5a983dSmrg for(ma = minMA; ma <= maxMA; ma++) 105fc5a983dSmrg { 106fc5a983dSmrg if(refclk / ma < minUA) 107fc5a983dSmrg break; 108fc5a983dSmrg else if(refclk / ma > maxUA) 109fc5a983dSmrg continue; 110fc5a983dSmrg 111fc5a983dSmrg for(na = minNA; na <= maxNA; na++) 112fc5a983dSmrg { 113fc5a983dSmrg if(refclk * na / ma < minVcoA || refclk * na / ma > maxVcoA) 114fc5a983dSmrg continue; 115fc5a983dSmrg 116fc5a983dSmrg for(mb = minMB; mb <= maxMB; mb++) 117fc5a983dSmrg { 118fc5a983dSmrg if(refclk * na / ma / mb < minUB) 119fc5a983dSmrg break; 120fc5a983dSmrg else if(refclk * na / ma / mb > maxUB) 121fc5a983dSmrg continue; 122fc5a983dSmrg 123fc5a983dSmrg nb = rint(pclk * (1 << p) * (ma / (float)na) * mb / refclk); 124fc5a983dSmrg 125fc5a983dSmrg if(nb > maxNB) 126fc5a983dSmrg break; 127fc5a983dSmrg else if(nb < minNB) 128fc5a983dSmrg continue; 129fc5a983dSmrg else 130fc5a983dSmrg { 131fc5a983dSmrg float freq = refclk * (na / (float)ma) * (nb / (float)mb) / (1 << p); 132fc5a983dSmrg float error = fabsf(pclk - freq); 133fc5a983dSmrg if(error < bestError) { 134fc5a983dSmrg *pNA = na; 135fc5a983dSmrg *pMA = ma; 136fc5a983dSmrg *pNB = nb; 137fc5a983dSmrg *pMB = mb; 138fc5a983dSmrg *pP = p; 139fc5a983dSmrg bestError = error; 140fc5a983dSmrg } 141fc5a983dSmrg } 142fc5a983dSmrg } 143fc5a983dSmrg } 144fc5a983dSmrg } 145fc5a983dSmrg } 146fc5a983dSmrg} 147fc5a983dSmrg 148bd2f6fc9Smrgstatic void 149bd2f6fc9SmrgG80CalcPLL2(float pclk, int *pN, int *pM, int *pPL) 150bd2f6fc9Smrg{ 151bd2f6fc9Smrg const float refclk = 27000.0f; 152bd2f6fc9Smrg const int minN = 8, maxN = 255; 153bd2f6fc9Smrg const int minM = 1, maxM = 255; 154bd2f6fc9Smrg const int minPL = 1, maxPL = 63; 155bd2f6fc9Smrg const int minU = 25000, maxU = 50000; 156bd2f6fc9Smrg const int minVco = 500000; 157bd2f6fc9Smrg int maxVco = 1000000; 158bd2f6fc9Smrg int lowPL, highPL, pl; 159bd2f6fc9Smrg float vco, bestError = FLT_MAX; 160bd2f6fc9Smrg 161bd2f6fc9Smrg vco = pclk + pclk / 50; 162bd2f6fc9Smrg 163bd2f6fc9Smrg if(maxVco < vco) maxVco = vco; 164bd2f6fc9Smrg 165bd2f6fc9Smrg highPL = (maxVco + vco - 1) / pclk; 166bd2f6fc9Smrg if(highPL > maxPL) highPL = maxPL; 167bd2f6fc9Smrg if(highPL < minPL) highPL = minPL; 168bd2f6fc9Smrg 169bd2f6fc9Smrg lowPL = minVco / vco; 170bd2f6fc9Smrg if(lowPL > maxPL) lowPL = maxPL; 171bd2f6fc9Smrg if(lowPL < minPL) lowPL = minPL; 172bd2f6fc9Smrg 173bd2f6fc9Smrg for(pl = highPL; pl >= lowPL; pl--) { 174bd2f6fc9Smrg int m; 175bd2f6fc9Smrg 176bd2f6fc9Smrg for(m = minM; m <= maxM; m++) { 177bd2f6fc9Smrg int n; 178bd2f6fc9Smrg float freq, error; 179bd2f6fc9Smrg 180bd2f6fc9Smrg if(refclk / m < minU) break; 181bd2f6fc9Smrg if(refclk / m > maxU) continue; 182bd2f6fc9Smrg 183bd2f6fc9Smrg n = rint(pclk * pl * m / refclk); 184bd2f6fc9Smrg if(n > maxN) break; 185bd2f6fc9Smrg if(n < minN) continue; 186bd2f6fc9Smrg 187bd2f6fc9Smrg freq = refclk * (n / (float)m) / pl; 188bd2f6fc9Smrg error = fabsf(pclk - freq); 189bd2f6fc9Smrg if(error < bestError) { 190bd2f6fc9Smrg *pN = n; 191bd2f6fc9Smrg *pM = m; 192bd2f6fc9Smrg *pPL = pl; 193bd2f6fc9Smrg bestError = error; 194bd2f6fc9Smrg } 195bd2f6fc9Smrg } 196bd2f6fc9Smrg } 197bd2f6fc9Smrg} 198bd2f6fc9Smrg 199fc5a983dSmrgstatic void 200fc5a983dSmrgG80CrtcSetPClk(xf86CrtcPtr crtc) 201fc5a983dSmrg{ 202fc5a983dSmrg G80Ptr pNv = G80PTR(crtc->scrn); 203fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 204fc5a983dSmrg xf86CrtcConfigPtr xf86_config = XF86_CRTC_CONFIG_PTR(crtc->scrn); 205fc5a983dSmrg const int headOff = 0x800 * pPriv->head; 206bd2f6fc9Smrg int i; 207bd2f6fc9Smrg 208bd2f6fc9Smrg if(pPriv->pclk == 0) 209bd2f6fc9Smrg return; 210bd2f6fc9Smrg 211bd2f6fc9Smrg if(pNv->architecture <= 0xa0 || 212bd2f6fc9Smrg pNv->architecture == 0xaa || 213bd2f6fc9Smrg pNv->architecture == 0xac) { 214bd2f6fc9Smrg int lo_n, lo_m, hi_n, hi_m, p, i; 215bd2f6fc9Smrg CARD32 lo = pNv->reg[(0x00614104+headOff)/4]; 216bd2f6fc9Smrg CARD32 hi = pNv->reg[(0x00614108+headOff)/4]; 217bd2f6fc9Smrg 218bd2f6fc9Smrg pNv->reg[(0x00614100+headOff)/4] = 0x10000610; 219bd2f6fc9Smrg lo &= 0xff00ff00; 220bd2f6fc9Smrg hi &= 0x8000ff00; 221fc5a983dSmrg 222bd2f6fc9Smrg G80CalcPLL(pPriv->pclk, &lo_n, &lo_m, &hi_n, &hi_m, &p); 223fc5a983dSmrg 224bd2f6fc9Smrg lo |= (lo_m << 16) | lo_n; 225bd2f6fc9Smrg hi |= (p << 28) | (hi_m << 16) | hi_n; 226bd2f6fc9Smrg pNv->reg[(0x00614104+headOff)/4] = lo; 227bd2f6fc9Smrg pNv->reg[(0x00614108+headOff)/4] = hi; 228bd2f6fc9Smrg } else { 229bd2f6fc9Smrg int n, m, pl; 230bd2f6fc9Smrg CARD32 r = pNv->reg[(0x00614104+headOff)/4]; 231fc5a983dSmrg 232bd2f6fc9Smrg pNv->reg[(0x00614100+headOff)/4] = 0x50000610; 233bd2f6fc9Smrg r &= 0xffc00000; 234bd2f6fc9Smrg 235bd2f6fc9Smrg G80CalcPLL2(pPriv->pclk, &n, &m, &pl); 236bd2f6fc9Smrg r |= pl << 16 | m << 8 | n; 237bd2f6fc9Smrg 238bd2f6fc9Smrg pNv->reg[(0x00614104+headOff)/4] = r; 239bd2f6fc9Smrg } 240fc5a983dSmrg pNv->reg[(0x00614200+headOff)/4] = 0; 241fc5a983dSmrg 242fc5a983dSmrg for(i = 0; i < xf86_config->num_output; i++) { 243fc5a983dSmrg xf86OutputPtr output = xf86_config->output[i]; 244fc5a983dSmrg 245fc5a983dSmrg if(output->crtc != crtc) 246fc5a983dSmrg continue; 247fc5a983dSmrg G80OutputSetPClk(output, pPriv->pclk); 248fc5a983dSmrg } 249fc5a983dSmrg} 250fc5a983dSmrg 251fc5a983dSmrgvoid 252fc5a983dSmrgG80DispCommand(ScrnInfoPtr pScrn, CARD32 addr, CARD32 data) 253fc5a983dSmrg{ 254fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 255fc5a983dSmrg 256fc5a983dSmrg pNv->reg[0x00610304/4] = data; 257fc5a983dSmrg pNv->reg[0x00610300/4] = addr | 0x80010001; 258fc5a983dSmrg 259fc5a983dSmrg while(pNv->reg[0x00610300/4] & 0x80000000) { 260fc5a983dSmrg const int super = ffs((pNv->reg[0x00610024/4] >> 4) & 7); 261fc5a983dSmrg 262fc5a983dSmrg if(super) { 263fc5a983dSmrg if(super == 2) { 264fc5a983dSmrg xf86CrtcConfigPtr xf86_config = XF86_CRTC_CONFIG_PTR(pScrn); 265fc5a983dSmrg int i; 266fc5a983dSmrg 267fc5a983dSmrg for(i = 0; i < xf86_config->num_crtc; i++) 268fc5a983dSmrg { 269fc5a983dSmrg xf86CrtcPtr crtc = xf86_config->crtc[i]; 270f3561b8bSmrg const int headOff = 0x800 * G80CrtcGetHead(crtc); 271fc5a983dSmrg 272f3561b8bSmrg if((pNv->reg[(0x00614200+headOff)/4] & 0xc0) == 0x80) 273fc5a983dSmrg G80CrtcSetPClk(crtc); 274fc5a983dSmrg } 275fc5a983dSmrg } 276fc5a983dSmrg 277fc5a983dSmrg pNv->reg[0x00610024/4] = 8 << super; 278fc5a983dSmrg pNv->reg[0x00610030/4] = 0x80000000; 279fc5a983dSmrg } 280fc5a983dSmrg } 281fc5a983dSmrg} 282fc5a983dSmrg 283fc5a983dSmrgHead 284fc5a983dSmrgG80CrtcGetHead(xf86CrtcPtr crtc) 285fc5a983dSmrg{ 286fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 287fc5a983dSmrg return pPriv->head; 288fc5a983dSmrg} 289fc5a983dSmrg 290fc5a983dSmrgBool 291fc5a983dSmrgG80DispPreInit(ScrnInfoPtr pScrn) 292fc5a983dSmrg{ 293fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 294fc5a983dSmrg 295fc5a983dSmrg pNv->reg[0x00610184/4] = pNv->reg[0x00614004/4]; 296fc5a983dSmrg pNv->reg[0x00610190/4] = pNv->reg[0x00616100/4]; 297fc5a983dSmrg pNv->reg[0x006101a0/4] = pNv->reg[0x00616900/4]; 298fc5a983dSmrg pNv->reg[0x00610194/4] = pNv->reg[0x00616104/4]; 299fc5a983dSmrg pNv->reg[0x006101a4/4] = pNv->reg[0x00616904/4]; 300fc5a983dSmrg pNv->reg[0x00610198/4] = pNv->reg[0x00616108/4]; 301fc5a983dSmrg pNv->reg[0x006101a8/4] = pNv->reg[0x00616908/4]; 302fc5a983dSmrg pNv->reg[0x0061019C/4] = pNv->reg[0x0061610C/4]; 303fc5a983dSmrg pNv->reg[0x006101ac/4] = pNv->reg[0x0061690c/4]; 304fc5a983dSmrg pNv->reg[0x006101D0/4] = pNv->reg[0x0061A000/4]; 305fc5a983dSmrg pNv->reg[0x006101D4/4] = pNv->reg[0x0061A800/4]; 306fc5a983dSmrg pNv->reg[0x006101D8/4] = pNv->reg[0x0061B000/4]; 307fc5a983dSmrg pNv->reg[0x006101E0/4] = pNv->reg[0x0061C000/4]; 308fc5a983dSmrg pNv->reg[0x006101E4/4] = pNv->reg[0x0061C800/4]; 309bd2f6fc9Smrg pNv->reg[0x006101E8/4] = pNv->reg[0x0061D000/4]; 310bd2f6fc9Smrg pNv->reg[0x006101EC/4] = pNv->reg[0x0061D800/4]; 311fc5a983dSmrg pNv->reg[0x0061A004/4] = 0x80550000; 312fc5a983dSmrg pNv->reg[0x0061A010/4] = 0x00000001; 313fc5a983dSmrg pNv->reg[0x0061A804/4] = 0x80550000; 314fc5a983dSmrg pNv->reg[0x0061A810/4] = 0x00000001; 315fc5a983dSmrg pNv->reg[0x0061B004/4] = 0x80550000; 316fc5a983dSmrg pNv->reg[0x0061B010/4] = 0x00000001; 317fc5a983dSmrg 318fc5a983dSmrg return TRUE; 319fc5a983dSmrg} 320fc5a983dSmrg 321fc5a983dSmrgBool 322fc5a983dSmrgG80DispInit(ScrnInfoPtr pScrn) 323fc5a983dSmrg{ 324fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 325fc5a983dSmrg CARD32 val; 326fc5a983dSmrg 327fc5a983dSmrg if(pNv->reg[0x00610024/4] & 0x100) { 328fc5a983dSmrg pNv->reg[0x00610024/4] = 0x100; 329fc5a983dSmrg pNv->reg[0x006194E8/4] &= ~1; 330fc5a983dSmrg while(pNv->reg[0x006194E8/4] & 2); 331fc5a983dSmrg } 332fc5a983dSmrg 333fc5a983dSmrg pNv->reg[0x00610200/4] = 0x2b00; 334fc5a983dSmrg do { 335fc5a983dSmrg val = pNv->reg[0x00610200/4]; 336fc5a983dSmrg 337fc5a983dSmrg if ((val & 0x9f0000) == 0x20000) 338fc5a983dSmrg pNv->reg[0x00610200/4] = val | 0x800000; 339fc5a983dSmrg 340fc5a983dSmrg if ((val & 0x3f0000) == 0x30000) 341fc5a983dSmrg pNv->reg[0x00610200/4] = val | 0x200000; 342fc5a983dSmrg } while ((val & 0x1e0000) != 0); 343fc5a983dSmrg pNv->reg[0x00610300/4] = 1; 344fc5a983dSmrg pNv->reg[0x00610200/4] = 0x1000b03; 345fc5a983dSmrg while(!(pNv->reg[0x00610200/4] & 0x40000000)); 346fc5a983dSmrg 347fc5a983dSmrg C(0x00000084, 0); 348fc5a983dSmrg C(0x00000088, 0); 349fc5a983dSmrg C(0x00000874, 0); 350fc5a983dSmrg C(0x00000800, 0); 351fc5a983dSmrg C(0x00000810, 0); 352fc5a983dSmrg C(0x0000082C, 0); 353fc5a983dSmrg 354fc5a983dSmrg return TRUE; 355fc5a983dSmrg} 356fc5a983dSmrg 357fc5a983dSmrgvoid 358fc5a983dSmrgG80DispShutdown(ScrnInfoPtr pScrn) 359fc5a983dSmrg{ 360fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 361fc5a983dSmrg xf86CrtcConfigPtr xf86_config = XF86_CRTC_CONFIG_PTR(pScrn); 362fc5a983dSmrg int i; 363fc5a983dSmrg 364fc5a983dSmrg for(i = 0; i < xf86_config->num_crtc; i++) { 365fc5a983dSmrg xf86CrtcPtr crtc = xf86_config->crtc[i]; 366fc5a983dSmrg 367fc5a983dSmrg G80CrtcBlankScreen(crtc, TRUE); 368fc5a983dSmrg } 369fc5a983dSmrg 370fc5a983dSmrg C(0x00000080, 0); 371fc5a983dSmrg 372fc5a983dSmrg for(i = 0; i < xf86_config->num_crtc; i++) { 373fc5a983dSmrg xf86CrtcPtr crtc = xf86_config->crtc[i]; 374fc5a983dSmrg 375fc5a983dSmrg if(crtc->enabled) { 376fc5a983dSmrg const CARD32 mask = 4 << G80CrtcGetHead(crtc); 377fc5a983dSmrg 378fc5a983dSmrg pNv->reg[0x00610024/4] = mask; 379fc5a983dSmrg while(!(pNv->reg[0x00610024/4] & mask)); 380fc5a983dSmrg } 381fc5a983dSmrg } 382fc5a983dSmrg 383fc5a983dSmrg pNv->reg[0x00610200/4] = 0; 384fc5a983dSmrg pNv->reg[0x00610300/4] = 0; 385fc5a983dSmrg while((pNv->reg[0x00610200/4] & 0x1e0000) != 0); 386fc5a983dSmrg while((pNv->reg[0x61C030/4] & 0x10000000)); 387fc5a983dSmrg while((pNv->reg[0x61C830/4] & 0x10000000)); 388fc5a983dSmrg} 389fc5a983dSmrg 390fc5a983dSmrgvoid 391fc5a983dSmrgG80CrtcDoModeFixup(DisplayModePtr dst, const DisplayModePtr src) 392fc5a983dSmrg{ 393fc5a983dSmrg /* Magic mode timing fudge factor */ 394fc5a983dSmrg const int fudge = ((src->Flags & V_INTERLACE) && (src->Flags & V_DBLSCAN)) ? 2 : 1; 395fc5a983dSmrg const int interlaceDiv = (src->Flags & V_INTERLACE) ? 2 : 1; 396fc5a983dSmrg 397fc5a983dSmrg /* Stash the src timings in the Crtc fields in dst */ 398fc5a983dSmrg dst->CrtcHBlankStart = src->CrtcVTotal << 16 | src->CrtcHTotal; 399fc5a983dSmrg dst->CrtcHSyncEnd = ((src->CrtcVSyncEnd - src->CrtcVSyncStart) / interlaceDiv - 1) << 16 | 400fc5a983dSmrg (src->CrtcHSyncEnd - src->CrtcHSyncStart - 1); 401fc5a983dSmrg dst->CrtcHBlankEnd = ((src->CrtcVBlankEnd - src->CrtcVSyncStart) / interlaceDiv - fudge) << 16 | 402fc5a983dSmrg (src->CrtcHBlankEnd - src->CrtcHSyncStart - 1); 403fc5a983dSmrg dst->CrtcHTotal = ((src->CrtcVTotal - src->CrtcVSyncStart + src->CrtcVBlankStart) / interlaceDiv - fudge) << 16 | 404fc5a983dSmrg (src->CrtcHTotal - src->CrtcHSyncStart + src->CrtcHBlankStart - 1); 405fc5a983dSmrg dst->CrtcHSkew = ((src->CrtcVTotal + src->CrtcVBlankEnd - src->CrtcVSyncStart) / 2 - 2) << 16 | 406fc5a983dSmrg ((2*src->CrtcVTotal - src->CrtcVSyncStart + src->CrtcVBlankStart) / 2 - 2); 407fc5a983dSmrg} 408fc5a983dSmrg 409fc5a983dSmrgstatic Bool 410fc5a983dSmrgG80CrtcModeFixup(xf86CrtcPtr crtc, 411fc5a983dSmrg DisplayModePtr mode, DisplayModePtr adjusted_mode) 412fc5a983dSmrg{ 413fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 414fc5a983dSmrg 415fc5a983dSmrg if(pPriv->skipModeFixup) 416fc5a983dSmrg return TRUE; 417fc5a983dSmrg 418fc5a983dSmrg G80CrtcDoModeFixup(adjusted_mode, mode); 419fc5a983dSmrg return TRUE; 420fc5a983dSmrg} 421fc5a983dSmrg 422fc5a983dSmrgstatic void 423fc5a983dSmrgG80CrtcModeSet(xf86CrtcPtr crtc, DisplayModePtr mode, 424fc5a983dSmrg DisplayModePtr adjusted_mode, int x, int y) 425fc5a983dSmrg{ 426fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 427fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 428fc5a983dSmrg const int HDisplay = adjusted_mode->HDisplay, VDisplay = adjusted_mode->VDisplay; 429fc5a983dSmrg const int headOff = 0x400 * G80CrtcGetHead(crtc); 430fc5a983dSmrg 431fc5a983dSmrg pPriv->pclk = adjusted_mode->Clock; 432fc5a983dSmrg 433fc5a983dSmrg C(0x00000804 + headOff, adjusted_mode->Clock | 0x800000); 434fc5a983dSmrg C(0x00000808 + headOff, (adjusted_mode->Flags & V_INTERLACE) ? 2 : 0); 435fc5a983dSmrg C(0x00000810 + headOff, 0); 436fc5a983dSmrg C(0x0000082C + headOff, 0); 437fc5a983dSmrg C(0x00000814 + headOff, adjusted_mode->CrtcHBlankStart); 438fc5a983dSmrg C(0x00000818 + headOff, adjusted_mode->CrtcHSyncEnd); 439fc5a983dSmrg C(0x0000081C + headOff, adjusted_mode->CrtcHBlankEnd); 440fc5a983dSmrg C(0x00000820 + headOff, adjusted_mode->CrtcHTotal); 441fc5a983dSmrg if(adjusted_mode->Flags & V_INTERLACE) 442fc5a983dSmrg C(0x00000824 + headOff, adjusted_mode->CrtcHSkew); 443fc5a983dSmrg C(0x00000868 + headOff, pScrn->virtualY << 16 | pScrn->virtualX); 444fc5a983dSmrg C(0x0000086C + headOff, pScrn->displayWidth * (pScrn->bitsPerPixel / 8) | 0x100000); 445fc5a983dSmrg switch(pScrn->depth) { 446fc5a983dSmrg case 8: C(0x00000870 + headOff, 0x1E00); break; 447fc5a983dSmrg case 15: C(0x00000870 + headOff, 0xE900); break; 448fc5a983dSmrg case 16: C(0x00000870 + headOff, 0xE800); break; 449fc5a983dSmrg case 24: C(0x00000870 + headOff, 0xCF00); break; 450fc5a983dSmrg } 451fc5a983dSmrg G80CrtcSetDither(crtc, pPriv->dither, FALSE); 452fc5a983dSmrg C(0x000008A8 + headOff, 0x40000); 453fc5a983dSmrg C(0x000008C0 + headOff, y << 16 | x); 454fc5a983dSmrg C(0x000008C8 + headOff, VDisplay << 16 | HDisplay); 455fc5a983dSmrg C(0x000008D4 + headOff, 0); 456fc5a983dSmrg 457fc5a983dSmrg G80CrtcBlankScreen(crtc, FALSE); 458fc5a983dSmrg} 459fc5a983dSmrg 460fc5a983dSmrgvoid 461fc5a983dSmrgG80CrtcBlankScreen(xf86CrtcPtr crtc, Bool blank) 462fc5a983dSmrg{ 463fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 464fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 465fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 466fc5a983dSmrg const int headOff = 0x400 * pPriv->head; 467fc5a983dSmrg 468fc5a983dSmrg if(blank) { 469fc5a983dSmrg G80CrtcShowHideCursor(crtc, FALSE, FALSE); 470fc5a983dSmrg 471fc5a983dSmrg C(0x00000840 + headOff, 0); 472fc5a983dSmrg C(0x00000844 + headOff, 0); 473fc5a983dSmrg if(pNv->architecture != 0x50) 474fc5a983dSmrg C(0x0000085C + headOff, 0); 475fc5a983dSmrg C(0x00000874 + headOff, 0); 476fc5a983dSmrg if(pNv->architecture != 0x50) 477fc5a983dSmrg C(0x0000089C + headOff, 0); 478fc5a983dSmrg } else { 479fc5a983dSmrg C(0x00000860 + headOff, 0); 480fc5a983dSmrg C(0x00000864 + headOff, 0); 481fc5a983dSmrg pNv->reg[0x00610380/4] = 0; 482fc5a983dSmrg pNv->reg[0x00610384/4] = pNv->videoRam * 1024 - 1; 483fc5a983dSmrg pNv->reg[0x00610388/4] = 0x150000; 484fc5a983dSmrg pNv->reg[0x0061038C/4] = 0; 485fc5a983dSmrg C(0x00000884 + headOff, (pNv->videoRam << 2) - 0x40); 486fc5a983dSmrg if(pNv->architecture != 0x50) 487fc5a983dSmrg C(0x0000089C + headOff, 1); 488fc5a983dSmrg if(pPriv->cursorVisible) 489fc5a983dSmrg G80CrtcShowHideCursor(crtc, TRUE, FALSE); 490fc5a983dSmrg C(0x00000840 + headOff, pScrn->depth == 8 ? 0x80000000 : 0xc0000000); 491fc5a983dSmrg C(0x00000844 + headOff, (pNv->videoRam * 1024 - 0x5000) >> 8); 492fc5a983dSmrg if(pNv->architecture != 0x50) 493fc5a983dSmrg C(0x0000085C + headOff, 1); 494fc5a983dSmrg C(0x00000874 + headOff, 1); 495fc5a983dSmrg } 496fc5a983dSmrg} 497fc5a983dSmrg 498fc5a983dSmrgstatic void 499fc5a983dSmrgG80CrtcDPMSSet(xf86CrtcPtr crtc, int mode) 500fc5a983dSmrg{ 501fc5a983dSmrg} 502fc5a983dSmrg 503fc5a983dSmrg/******************************** Cursor stuff ********************************/ 504fc5a983dSmrgstatic void G80CrtcShowHideCursor(xf86CrtcPtr crtc, Bool show, Bool update) 505fc5a983dSmrg{ 506fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 507fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 508fc5a983dSmrg const int headOff = 0x400 * G80CrtcGetHead(crtc); 509fc5a983dSmrg 510fc5a983dSmrg C(0x00000880 + headOff, show ? 0x85000000 : 0x5000000); 511fc5a983dSmrg if(update) { 512fc5a983dSmrg pPriv->cursorVisible = show; 513fc5a983dSmrg C(0x00000080, 0); 514fc5a983dSmrg } 515fc5a983dSmrg} 516fc5a983dSmrg 517fc5a983dSmrgstatic void G80CrtcShowCursor(xf86CrtcPtr crtc) 518fc5a983dSmrg{ 519fc5a983dSmrg G80CrtcShowHideCursor(crtc, TRUE, TRUE); 520fc5a983dSmrg} 521fc5a983dSmrg 522fc5a983dSmrgstatic void G80CrtcHideCursor(xf86CrtcPtr crtc) 523fc5a983dSmrg{ 524fc5a983dSmrg G80CrtcShowHideCursor(crtc, FALSE, TRUE); 525fc5a983dSmrg} 526fc5a983dSmrg 527fc5a983dSmrg/******************************** CRTC stuff ********************************/ 528fc5a983dSmrg 529fc5a983dSmrgstatic Bool 530fc5a983dSmrgG80CrtcLock(xf86CrtcPtr crtc) 531fc5a983dSmrg{ 532fc5a983dSmrg return FALSE; 533fc5a983dSmrg} 534fc5a983dSmrg 535fc5a983dSmrgstatic void 536fc5a983dSmrgG80CrtcPrepare(xf86CrtcPtr crtc) 537fc5a983dSmrg{ 538fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 539fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 540fc5a983dSmrg xf86CrtcConfigPtr xf86_config = XF86_CRTC_CONFIG_PTR(pScrn); 541fc5a983dSmrg int i; 542fc5a983dSmrg 543fc5a983dSmrg for(i = 0; i < xf86_config->num_output; i++) { 544fc5a983dSmrg xf86OutputPtr output = xf86_config->output[i]; 545fc5a983dSmrg 546fc5a983dSmrg if(!output->crtc) 547fc5a983dSmrg output->funcs->mode_set(output, NULL, NULL); 548fc5a983dSmrg } 549fc5a983dSmrg 550fc5a983dSmrg pPriv->skipModeFixup = FALSE; 551fc5a983dSmrg} 552fc5a983dSmrg 553fc5a983dSmrgvoid 554fc5a983dSmrgG80CrtcSkipModeFixup(xf86CrtcPtr crtc) 555fc5a983dSmrg{ 556fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 557fc5a983dSmrg pPriv->skipModeFixup = TRUE; 558fc5a983dSmrg} 559fc5a983dSmrg 560fc5a983dSmrgvoid 561fc5a983dSmrgG80CrtcSetDither(xf86CrtcPtr crtc, Bool dither, Bool update) 562fc5a983dSmrg{ 563fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 564fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 565fc5a983dSmrg const int headOff = 0x400 * G80CrtcGetHead(crtc); 566fc5a983dSmrg 567fc5a983dSmrg pPriv->dither = dither; 568fc5a983dSmrg 569fc5a983dSmrg C(0x000008A0 + headOff, dither ? 0x11 : 0); 570fc5a983dSmrg if(update) C(0x00000080, 0); 571fc5a983dSmrg} 572fc5a983dSmrg 573fc5a983dSmrgstatic void ComputeAspectScale(DisplayModePtr mode, int *outX, int *outY) 574fc5a983dSmrg{ 575fc5a983dSmrg float scaleX, scaleY, scale; 576fc5a983dSmrg 577fc5a983dSmrg scaleX = mode->CrtcHDisplay / (float)mode->HDisplay; 578fc5a983dSmrg scaleY = mode->CrtcVDisplay / (float)mode->VDisplay; 579fc5a983dSmrg 580fc5a983dSmrg if(scaleX > scaleY) 581fc5a983dSmrg scale = scaleY; 582fc5a983dSmrg else 583fc5a983dSmrg scale = scaleX; 584fc5a983dSmrg 585fc5a983dSmrg *outX = mode->HDisplay * scale; 586fc5a983dSmrg *outY = mode->VDisplay * scale; 587fc5a983dSmrg} 588fc5a983dSmrg 589fc5a983dSmrgvoid G80CrtcSetScale(xf86CrtcPtr crtc, DisplayModePtr mode, 590fc5a983dSmrg enum G80ScaleMode scale) 591fc5a983dSmrg{ 592fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 593fc5a983dSmrg G80CrtcPrivPtr pPriv = crtc->driver_private; 594fc5a983dSmrg const int headOff = 0x400 * pPriv->head; 595fc5a983dSmrg int outX, outY; 596fc5a983dSmrg 597fc5a983dSmrg switch(scale) { 598fc5a983dSmrg default: 599fc5a983dSmrg case G80_SCALE_ASPECT: 600fc5a983dSmrg ComputeAspectScale(mode, &outX, &outY); 601fc5a983dSmrg break; 602fc5a983dSmrg 603fc5a983dSmrg case G80_SCALE_OFF: 604fc5a983dSmrg case G80_SCALE_FILL: 605fc5a983dSmrg outX = mode->CrtcHDisplay; 606fc5a983dSmrg outY = mode->CrtcVDisplay; 607fc5a983dSmrg break; 608fc5a983dSmrg 609fc5a983dSmrg case G80_SCALE_CENTER: 610fc5a983dSmrg outX = mode->HDisplay; 611fc5a983dSmrg outY = mode->VDisplay; 612fc5a983dSmrg break; 613fc5a983dSmrg } 614fc5a983dSmrg 615fc5a983dSmrg if((mode->Flags & V_DBLSCAN) || (mode->Flags & V_INTERLACE) || 616fc5a983dSmrg mode->HDisplay != outX || mode->VDisplay != outY) { 617fc5a983dSmrg C(0x000008A4 + headOff, 9); 618fc5a983dSmrg } else { 619fc5a983dSmrg C(0x000008A4 + headOff, 0); 620fc5a983dSmrg } 621fc5a983dSmrg C(0x000008D8 + headOff, outY << 16 | outX); 622fc5a983dSmrg C(0x000008DC + headOff, outY << 16 | outX); 623fc5a983dSmrg} 624fc5a983dSmrg 625fc5a983dSmrgstatic void 626fc5a983dSmrgG80CrtcCommit(xf86CrtcPtr crtc) 627fc5a983dSmrg{ 628fc5a983dSmrg ScrnInfoPtr pScrn = crtc->scrn; 629fc5a983dSmrg xf86CrtcConfigPtr xf86_config = XF86_CRTC_CONFIG_PTR(crtc->scrn); 630fc5a983dSmrg int i, crtc_mask = 0; 631fc5a983dSmrg 632fc5a983dSmrg /* If any heads are unused, blank them */ 633fc5a983dSmrg for(i = 0; i < xf86_config->num_output; i++) { 634fc5a983dSmrg xf86OutputPtr output = xf86_config->output[i]; 635fc5a983dSmrg 636fc5a983dSmrg if(output->crtc) 637fc5a983dSmrg /* XXXagp: This assumes that xf86_config->crtc[i] is HEADi */ 638fc5a983dSmrg crtc_mask |= 1 << G80CrtcGetHead(output->crtc); 639fc5a983dSmrg } 640fc5a983dSmrg 641fc5a983dSmrg for(i = 0; i < xf86_config->num_crtc; i++) 642fc5a983dSmrg if(!((1 << i) & crtc_mask)) 643fc5a983dSmrg G80CrtcBlankScreen(xf86_config->crtc[i], TRUE); 644fc5a983dSmrg 645fc5a983dSmrg C(0x00000080, 0); 646fc5a983dSmrg} 647fc5a983dSmrg 648fc5a983dSmrgstatic const xf86CrtcFuncsRec g80_crtc_funcs = { 649fc5a983dSmrg .dpms = G80CrtcDPMSSet, 650fc5a983dSmrg .save = NULL, 651fc5a983dSmrg .restore = NULL, 652fc5a983dSmrg .lock = G80CrtcLock, 653fc5a983dSmrg .unlock = NULL, 654fc5a983dSmrg .mode_fixup = G80CrtcModeFixup, 655fc5a983dSmrg .prepare = G80CrtcPrepare, 656fc5a983dSmrg .mode_set = G80CrtcModeSet, 657fc5a983dSmrg // .gamma_set = G80DispGammaSet, 658fc5a983dSmrg .commit = G80CrtcCommit, 659fc5a983dSmrg .shadow_create = NULL, 660fc5a983dSmrg .shadow_destroy = NULL, 661fc5a983dSmrg .set_cursor_position = G80SetCursorPosition, 662fc5a983dSmrg .show_cursor = G80CrtcShowCursor, 663fc5a983dSmrg .hide_cursor = G80CrtcHideCursor, 664fc5a983dSmrg .load_cursor_argb = G80LoadCursorARGB, 665fc5a983dSmrg .destroy = NULL, 666fc5a983dSmrg}; 667fc5a983dSmrg 668fc5a983dSmrgvoid 669fc5a983dSmrgG80DispCreateCrtcs(ScrnInfoPtr pScrn) 670fc5a983dSmrg{ 671fc5a983dSmrg G80Ptr pNv = G80PTR(pScrn); 672fc5a983dSmrg Head head; 673fc5a983dSmrg xf86CrtcPtr crtc; 674fc5a983dSmrg G80CrtcPrivPtr g80_crtc; 675fc5a983dSmrg 676fc5a983dSmrg /* Create a "crtc" object for each head */ 677fc5a983dSmrg for(head = HEAD0; head <= HEAD1; head++) { 678fc5a983dSmrg crtc = xf86CrtcCreate(pScrn, &g80_crtc_funcs); 679fc5a983dSmrg if(!crtc) return; 680fc5a983dSmrg 681fc5a983dSmrg g80_crtc = xnfcalloc(sizeof(*g80_crtc), 1); 682fc5a983dSmrg g80_crtc->head = head; 683fc5a983dSmrg g80_crtc->dither = pNv->Dither; 684fc5a983dSmrg crtc->driver_private = g80_crtc; 685fc5a983dSmrg } 686fc5a983dSmrg} 687