diff options
Diffstat (limited to 'src/nv50_dac.c')
| -rw-r--r-- | src/nv50_dac.c | 199 |
1 files changed, 199 insertions, 0 deletions
diff --git a/src/nv50_dac.c b/src/nv50_dac.c new file mode 100644 index 0000000..fcb4e97 --- /dev/null +++ b/src/nv50_dac.c @@ -0,0 +1,199 @@ +/* + * Copyright (c) 2007 NVIDIA, Corporation + * + * Permission is hereby granted, free of charge, to any person obtaining a + * copy of this software and associated documentation files (the + * "Software"), to deal in the Software without restriction, including + * without limitation the rights to use, copy, modify, merge, publish, + * distribute, sublicense, and/or sell copies of the Software, and to + * permit persons to whom the Software is furnished to do so, subject to + * the following conditions: + * + * The above copyright notice and this permission notice shall be included + * in all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS + * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. + * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY + * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, + * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE + * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <unistd.h> + +#define DPMS_SERVER +#include <X11/extensions/dpms.h> + +#include "nv_include.h" +#include "nv50_display.h" +#include "nv50_output.h" + +static void +NV50DacSetPClk(xf86OutputPtr output, int pclk) +{ + NVPtr pNv = NVPTR(output->scrn); + NV50OutputPrivPtr pPriv = output->driver_private; + const int orOff = 0x800 * pPriv->or; + + pNv->REGS[(0x00614280+orOff)/4] = 0; +} + +static void +NV50DacDPMSSet(xf86OutputPtr output, int mode) +{ + NVPtr pNv = NVPTR(output->scrn); + NV50OutputPrivPtr pPriv = output->driver_private; + const int off = 0x800 * pPriv->or; + CARD32 tmp; + + /* + * DPMSModeOn everything on + * DPMSModeStandby hsync disabled, vsync enabled + * DPMSModeSuspend hsync enabled, vsync disabled + * DPMSModeOff sync disabled + */ + while(pNv->REGS[(0x0061A004+off)/4] & 0x80000000); + + tmp = pNv->REGS[(0x0061A004+off)/4]; + tmp &= ~0x7f; + tmp |= 0x80000000; + + if(mode == DPMSModeStandby || mode == DPMSModeOff) + tmp |= 1; + if(mode == DPMSModeSuspend || mode == DPMSModeOff) + tmp |= 4; + if(mode != DPMSModeOn) + tmp |= 0x10; + if(mode == DPMSModeOff) + tmp |= 0x40; + + pNv->REGS[(0x0061A004+off)/4] = tmp; +} + +static void +NV50DacModeSet(xf86OutputPtr output, DisplayModePtr mode, + DisplayModePtr adjusted_mode) +{ + ScrnInfoPtr pScrn = output->scrn; + NV50OutputPrivPtr pPriv = output->driver_private; + const int dacOff = 0x80 * pPriv->or; + + if(!adjusted_mode) { + C(0x00000400 + dacOff, 0); + return; + } + + // This wouldn't be necessary, but the server is stupid and calls + // NV50DacDPMSSet after the output is disconnected, even though the hardware + // turns it off automatically. + NV50DacDPMSSet(output, DPMSModeOn); + + C(0x00000400 + dacOff, + (NV50CrtcGetHead(output->crtc) == HEAD0 ? 1 : 2) | 0x40); + C(0x00000404 + dacOff, + (adjusted_mode->Flags & V_NHSYNC) ? 1 : 0 | + (adjusted_mode->Flags & V_NVSYNC) ? 2 : 0); +} + +/* + * Perform DAC load detection to determine if there is a connected display. + */ +static xf86OutputStatus +NV50DacDetect(xf86OutputPtr output) +{ + NV50OutputPrivPtr pPriv = output->driver_private; + + /* Assume physical status isn't going to change before the BlockHandler */ + if(pPriv->cached_status != XF86OutputStatusUnknown) + return pPriv->cached_status; + + NV50OutputPartnersDetect(output, pPriv->partner, pPriv->i2c); + return pPriv->cached_status; +} + +Bool +NV50DacLoadDetect(xf86OutputPtr output) +{ + ScrnInfoPtr pScrn = output->scrn; + NVPtr pNv = NVPTR(pScrn); + NV50OutputPrivPtr pPriv = output->driver_private; + const int scrnIndex = pScrn->scrnIndex; + const int dacOff = 2048 * pPriv->or; + CARD32 load, tmp, tmp2; + + xf86DrvMsg(scrnIndex, X_PROBED, "Trying load detection on VGA%i ... ", + pPriv->or); + + pNv->REGS[(0x0061A010+dacOff)/4] = 0x00000001; + tmp2 = pNv->REGS[(0x0061A004+dacOff)/4]; + pNv->REGS[(0x0061A004+dacOff)/4] = 0x80150000; + while(pNv->REGS[(0x0061A004+dacOff)/4] & 0x80000000); + tmp = pNv->_Chipset == 0x50 ? 420 : 340; + pNv->REGS[(0x0061A00C+dacOff)/4] = tmp | 0x100000; + usleep(4500); + load = pNv->REGS[(0x0061A00C+dacOff)/4]; + pNv->REGS[(0x0061A00C+dacOff)/4] = 0; + pNv->REGS[(0x0061A004+dacOff)/4] = 0x80000000 | tmp2; + + // Use this DAC if all three channels show load. + if((load & 0x38000000) == 0x38000000) { + xf86ErrorF("found one!\n"); + return TRUE; + } + + xf86ErrorF("nothing.\n"); + return FALSE; +} + +static void +NV50DacDestroy(xf86OutputPtr output) +{ + NV50OutputDestroy(output); + + xfree(output->driver_private); + output->driver_private = NULL; +} + +static const xf86OutputFuncsRec NV50DacOutputFuncs = { + .dpms = NV50DacDPMSSet, + .save = NULL, + .restore = NULL, + .mode_valid = NV50OutputModeValid, + .mode_fixup = NV50OutputModeFixup, + .prepare = NV50OutputPrepare, + .commit = NV50OutputCommit, + .mode_set = NV50DacModeSet, + .detect = NV50DacDetect, + .get_modes = NV50OutputGetDDCModes, + .destroy = NV50DacDestroy, +}; + +xf86OutputPtr +NV50CreateDac(ScrnInfoPtr pScrn, ORNum or) +{ + NV50OutputPrivPtr pPriv = xnfcalloc(sizeof(*pPriv), 1); + xf86OutputPtr output; + char orName[5]; + + if(!pPriv) + return FALSE; + + snprintf(orName, 5, "VGA%i", or); + output = xf86OutputCreate(pScrn, &NV50DacOutputFuncs, orName); + + pPriv->type = DAC; + pPriv->or = or; + pPriv->cached_status = XF86OutputStatusUnknown; + pPriv->set_pclk = NV50DacSetPClk; + output->driver_private = pPriv; + output->interlaceAllowed = TRUE; + output->doubleScanAllowed = TRUE; + + return output; +} |