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