haiku.git

/*
	Haiku S3 Savage driver adapted from the X.org Savage driver.

	Copyright (C) 1994-2000 The XFree86 Project, Inc.  All Rights Reserved.
	Copyright (c) 2003-2006, X.Org Foundation

	Copyright 2007-2008 Haiku, Inc.  All rights reserved.
	Distributed under the terms of the MIT license.

	Authors:
	Gerald Zajac 2006-2008
*/


#include "accel.h"
#include "savage.h"



uint32 
Savage_DPMSCapabilities(void)
{
	// Return DPMS modes supported by this device.

	return B_DPMS_ON | B_DPMS_STAND_BY | B_DPMS_SUSPEND | B_DPMS_OFF;
}


uint32 
Savage_GetDPMSMode(void)
{
	// Return the current DPMS mode.

	// Note:  I do not know whether the following code is correctly reading
	// the current DPMS mode.  I'm assuming that reading back the bits that
	// were set by function SET_DPMS_MODE will give the current DPMS mode.

	SharedInfo& si = *gInfo.sharedInfo;
	uint32 mode = B_DPMS_ON;

	if (si.displayType == MT_CRT) {
		switch (ReadSeqReg(0x0d) & 0x70) {
			case 0:
				mode = B_DPMS_ON;
				break;
			case 0x10:
				mode = B_DPMS_STAND_BY;
				break;
			case 0x40:
				mode = B_DPMS_SUSPEND;
				break;
			case 0x50:
				mode = B_DPMS_OFF;
				break;
			default:
				TRACE("Unknown DPMS mode, reg sr0D: 0x%X\n", ReadSeqReg(0x0d));
		}
	} else if (si.displayType == MT_LCD || si.displayType == MT_DFP) {
		mode = ((ReadSeqReg(0x31) & 0x10) ? B_DPMS_ON : B_DPMS_OFF);
	}

	TRACE("Savage_GetDPMSMode() mode: %d\n", mode);
	return mode;
}


status_t 
Savage_SetDPMSMode(uint32 dpmsMode)
{
	// Set the display into one of the Display Power Management modes,
	// and return B_OK if successful, else return B_ERROR.

	SharedInfo& si = *gInfo.sharedInfo;

	TRACE("Savage_SetDPMSMode() mode: %d, display type: %d\n", dpmsMode, si.displayType);

	if (si.displayType == MT_CRT) {
		WriteSeqReg(0x08, 0x06);		// unlock extended sequencer regs

		uint8 sr0D = ReadSeqReg(0x0d) & 0x03;

		switch (dpmsMode) {
			case B_DPMS_ON:
				break;
			case B_DPMS_STAND_BY:
				sr0D |= 0x10;
				break;
			case B_DPMS_SUSPEND:
				sr0D |= 0x40;
				break;
			case B_DPMS_OFF:
				sr0D |= 0x50;
				break;
			default:
				TRACE("Invalid DPMS mode %d\n", dpmsMode);
				return B_ERROR;
		}

		WriteSeqReg(0x0d, sr0D);
	} else if (si.displayType == MT_LCD || si.displayType == MT_DFP) {
		switch (dpmsMode) {
			case B_DPMS_ON:
				WriteSeqReg(0x31, 0x10, 0x10);	// SR31 bit 4 - FP enable
				break;
			case B_DPMS_STAND_BY:
			case B_DPMS_SUSPEND:
			case B_DPMS_OFF:
				WriteSeqReg(0x31, 0x00, 0x10);	// SR31 bit 4 - FP enable
				break;
			default:
				TRACE("Invalid DPMS mode %d\n", dpmsMode);
				return B_ERROR;
		}
	}

	return B_OK;
}