static void
LUTxSave(struct rhdLUT *LUT)
{
CARD16 RegOff;
int i;
RHDFUNC(LUT);
if (LUT->Id == RHD_LUT_A)
RegOff = RHD_REGOFFSET_LUTA;
else
RegOff = RHD_REGOFFSET_LUTB;
LUT->StoreControl = RHDRegRead(LUT, RegOff + DC_LUTA_CONTROL);
LUT->StoreBlackBlue = RHDRegRead(LUT, RegOff + DC_LUTA_BLACK_OFFSET_BLUE);
LUT->StoreBlackGreen = RHDRegRead(LUT, RegOff + DC_LUTA_BLACK_OFFSET_GREEN);
LUT->StoreBlackRed = RHDRegRead(LUT, RegOff + DC_LUTA_BLACK_OFFSET_RED);
LUT->StoreWhiteBlue = RHDRegRead(LUT, RegOff + DC_LUTA_WHITE_OFFSET_BLUE);
LUT->StoreWhiteGreen = RHDRegRead(LUT, RegOff + DC_LUTA_WHITE_OFFSET_GREEN);
LUT->StoreWhiteRed = RHDRegRead(LUT, RegOff + DC_LUTA_WHITE_OFFSET_RED);
RHDRegWrite(LUT, DC_LUT_RW_MODE, 0); /* Table */
if (LUT->Id == RHD_LUT_A)
RHDRegWrite(LUT, DC_LUT_READ_PIPE_SELECT, 0);
else
RHDRegWrite(LUT, DC_LUT_READ_PIPE_SELECT, 1);
RHDRegWrite(LUT, DC_LUT_RW_INDEX, 0);
for (i = 0; i < 0x300; i++)
LUT->StoreEntry[i] = RHDRegRead(LUT, DC_LUT_SEQ_COLOR);
LUT->Stored = TRUE;
}
void
RHDVGASave(RHDPtr rhdPtr)
{
struct rhdVGA *VGA = rhdPtr->VGA;
RHDFUNC(rhdPtr);
if (!VGA)
return; /* We don't need to warn , this is intended use */
VGA->Render_Control = RHDRegRead(rhdPtr, VGA_RENDER_CONTROL);
VGA->Mode_Control = RHDRegRead(rhdPtr, VGA_MODE_CONTROL);
VGA->HDP_Control = RHDRegRead(rhdPtr, VGA_HDP_CONTROL);
VGA->D1_Control = RHDRegRead(rhdPtr, D1VGA_CONTROL);
VGA->D2_Control = RHDRegRead(rhdPtr, D2VGA_CONTROL);
rhdVGASaveFB(rhdPtr);
VGA->Stored = TRUE;
}
static CARD32
rhdVGAFBOffsetGet(RHDPtr rhdPtr)
{
CARD32 FBSize, VGAFBOffset, VGAFBSize = 256 * 1024;
CARD64 FBAddress = RHDMCGetFBLocation(rhdPtr, &FBSize);
CARD64 VGAFBAddress = RHDRegRead(rhdPtr, VGA_MEMORY_BASE_ADDRESS);
if (VGAFBAddress < FBAddress)
return 0xFFFFFFFF;
if ((VGAFBAddress + VGAFBSize) > (FBAddress + FBSize))
return 0xFFFFFFFF;
VGAFBOffset = VGAFBAddress - FBAddress; /* < FBSize, so 32bit */
if ((VGAFBOffset + VGAFBSize) >= rhdPtr->FbMapSize)
return 0xFFFFFFFF;
return VGAFBOffset;
}
/*
* This is (usually) ok, as VGASave is called after the memory has been mapped,
* but before the MC is set up. So the use of RHDMCGetFBLocation is correct in
* rhdVGAFBOffsetGet.
*/
static void
rhdVGASaveFB(RHDPtr rhdPtr)
{
struct rhdVGA *VGA = rhdPtr->VGA;
ASSERT(rhdPtr->FbBase);
RHDFUNC(rhdPtr);
VGA->FBOffset = rhdVGAFBOffsetGet(rhdPtr);
if (VGA->FBOffset == 0xFFFFFFFF) {
xf86DrvMsg(rhdPtr->scrnIndex, X_WARNING, "%s: Unable to access the VGA "
"framebuffer (0x%08X)\n", __func__,
(unsigned int) RHDRegRead(rhdPtr, VGA_MEMORY_BASE_ADDRESS));
if (VGA->FB)
xfree(VGA->FB);
VGA->FB = NULL;
VGA->FBSize = 0;
return;
}
VGA->FBSize = 256 * 1024;
RHDDebug(rhdPtr->scrnIndex, "%s: VGA FB Offset 0x%08X [0x%08X]\n",
__func__, VGA->FBOffset, VGA->FBSize);
if (!VGA->FB)
VGA->FB = xcalloc(VGA->FBSize, 1);
if (VGA->FB)
memcpy(VGA->FB, ((CARD8 *) rhdPtr->FbBase) + VGA->FBOffset,
VGA->FBSize);
else {
xf86DrvMsg(rhdPtr->scrnIndex, X_WARNING, "%s: Failed to allocate"
" space for storing the VGA framebuffer.\n", __func__);
VGA->FBOffset = 0xFFFFFFFF;
VGA->FBSize = 0;
}
}
/*
* current number of channels
*/
static int
AudioChannels(struct rhdAudio* Audio)
{
return (RHDRegRead(Audio, AUDIO_RATE_BPS_CHANNEL) & 0x7) + 1;
}
/*
* current number of channels
*/
static int
AudioChannels(struct rhdAudio* Audio)
{
return (RHDRegRead(Audio, AUDIO_RATE_BPS_CHANNEL) & 0x7) + 1;
}
/*
* current bits per sample
*/
static int
AudioBitsPerSample(struct rhdAudio* Audio)
{
CARD32 value = (RHDRegRead(Audio, AUDIO_RATE_BPS_CHANNEL) & 0xF0) >> 4;
switch(value)
{
case 0x0: return 8;
case 0x1: return 16;
case 0x2: return 20;
case 0x3: return 24;
case 0x4: return 32;
}
xf86DrvMsg(Audio->scrnIndex, X_WARNING, "%s: unknown bits per sample 0x%x "
"using 16 instead.\n", __func__, (int) value);
return 16;
}
