270 lines
5.6 KiB
C
270 lines
5.6 KiB
C
/*++
|
||
|
||
Copyright (c) 1997-2000 Microsoft Corporation
|
||
|
||
Module Name:
|
||
|
||
topic.c
|
||
|
||
Abstract:
|
||
|
||
This module contains the code that contains
|
||
Toshiba topic cardbus controller specific initialization
|
||
and other dispatches
|
||
|
||
Author:
|
||
|
||
Ravisankar Pudipeddi (ravisp) 1-Nov-97
|
||
Neil Sandlin (neilsa) 1-Jun-1999
|
||
|
||
|
||
Environment:
|
||
|
||
Kernel mode
|
||
|
||
Revision History :
|
||
|
||
Neil Sandlin (neilsa) 3-Mar-99
|
||
new setpower routine interface
|
||
|
||
--*/
|
||
|
||
#include "pch.h"
|
||
|
||
|
||
|
||
VOID
|
||
TopicInitialize(
|
||
IN PFDO_EXTENSION FdoExtension
|
||
)
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
Initialize Toshiba Topic cardbus controllers
|
||
|
||
Arguments:
|
||
|
||
FdoExtension - Pointer to the device extension for the controller FDO
|
||
|
||
Return Value:
|
||
|
||
None
|
||
--*/
|
||
{
|
||
UCHAR byte;
|
||
USHORT word;
|
||
|
||
if (FdoExtension->ControllerType == PcmciaTopic95) {
|
||
//
|
||
// 480CDT in a dock needs this for socket registers to be visible.
|
||
// It should be on all the time anyway.
|
||
//
|
||
GetPciConfigSpace(FdoExtension, CFGSPACE_TO_CD_CTRL, &byte, 1);
|
||
byte |= CDCTRL_PCCARD_16_32;
|
||
SetPciConfigSpace(FdoExtension, CFGSPACE_TO_CD_CTRL, &byte, 1);
|
||
}
|
||
|
||
//enable 3.3V capable
|
||
|
||
byte = PcicReadSocket(FdoExtension->SocketList, PCIC_TO_FUNC_CTRL) | TO_FCTRL_CARDPWR_ENABLE;
|
||
PcicWriteSocket(FdoExtension->SocketList,
|
||
PCIC_TO_FUNC_CTRL,
|
||
byte);
|
||
|
||
//
|
||
// initialize IRQ routing to ISA
|
||
//
|
||
|
||
GetPciConfigSpace(FdoExtension, CFGSPACE_BRIDGE_CTRL, &word, 2);
|
||
word |= BCTRL_IRQROUTING_ENABLE;
|
||
SetPciConfigSpace(FdoExtension, CFGSPACE_BRIDGE_CTRL, &word, 2);
|
||
}
|
||
|
||
|
||
|
||
NTSTATUS
|
||
TopicSetPower(
|
||
IN PSOCKET Socket,
|
||
IN BOOLEAN Enable,
|
||
OUT PULONG pDelayTime
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
Set power to the specified socket.
|
||
|
||
Arguments:
|
||
|
||
Socket - the socket to set
|
||
Enable - TRUE means to set power - FALSE is to turn it off.
|
||
pDelayTime - specifies delay (msec) to occur after the current phase
|
||
|
||
Return Value:
|
||
|
||
STATUS_MORE_PROCESSING_REQUIRED - increment phase, perform delay, recall
|
||
other status values terminate sequence
|
||
|
||
--*/
|
||
|
||
{
|
||
NTSTATUS status;
|
||
UCHAR oldPower, newPower;
|
||
|
||
if (IsCardBusCardInSocket(Socket)) {
|
||
//
|
||
// Hand over to generic power setting routine
|
||
//
|
||
return(CBSetPower(Socket, Enable, pDelayTime));
|
||
}
|
||
|
||
switch(Socket->PowerPhase) {
|
||
case 1:
|
||
//
|
||
// R2 card - special handling
|
||
//
|
||
oldPower = PcicReadSocket(Socket, PCIC_PWR_RST);
|
||
|
||
//
|
||
// Set power values
|
||
//
|
||
if (Enable) {
|
||
//
|
||
// turn power on
|
||
//
|
||
newPower = PC_CARDPWR_ENABLE;
|
||
|
||
if (Socket->Vcc == 33) {
|
||
newPower |= PC_VCC_TOPIC_033V;
|
||
}
|
||
|
||
//
|
||
// set Vpp
|
||
//
|
||
if (Socket->Vcc == Socket->Vpp1) {
|
||
newPower |= PC_VPP_SETTO_VCC;
|
||
} else if (Socket->Vpp1 == 120) {
|
||
newPower |= PC_VPP_SETTO_VPP;
|
||
}
|
||
|
||
} else {
|
||
//
|
||
// turn power off
|
||
//
|
||
newPower = 0;
|
||
}
|
||
|
||
//
|
||
// Don't nuke the non-power related bits in the register..
|
||
//
|
||
newPower |= (oldPower & PC_PWRON_BITS);
|
||
//
|
||
// If Vcc is turned off, reset OUTPUT_ENABLE & AUTOPWR_ENABLE
|
||
//
|
||
if (!(newPower & PC_CARDPWR_ENABLE)) {
|
||
newPower &= ~PC_PWRON_BITS;
|
||
}
|
||
//
|
||
// Disable ResetDrv
|
||
//
|
||
newPower |= PC_RESETDRV_DISABLE;
|
||
|
||
status = STATUS_SUCCESS;
|
||
if (newPower != oldPower) {
|
||
PcicWriteSocket(Socket, PCIC_PWR_RST, newPower);
|
||
//
|
||
// Allow ramp up.. (actually we don't need to this if
|
||
// Enable was FALSE). Keep it for paranoia's sake
|
||
//
|
||
*pDelayTime = PcicStallPower;
|
||
Socket->PowerData = (ULONG) newPower;
|
||
status = STATUS_MORE_PROCESSING_REQUIRED;
|
||
}
|
||
break;
|
||
|
||
case 2:
|
||
|
||
newPower = (UCHAR) Socket->PowerData;
|
||
|
||
if ((newPower & PC_CARDPWR_ENABLE) &&
|
||
((newPower & PC_PWRON_BITS) != PC_PWRON_BITS)) {
|
||
//
|
||
// More paranoia?
|
||
//
|
||
newPower |= PC_PWRON_BITS;
|
||
PcicWriteSocket(Socket, PCIC_PWR_RST, newPower);
|
||
}
|
||
|
||
status = STATUS_SUCCESS;
|
||
*pDelayTime = PcicStallPower;
|
||
break;
|
||
|
||
default:
|
||
ASSERT(FALSE);
|
||
status = STATUS_UNSUCCESSFUL;
|
||
}
|
||
return status;
|
||
}
|
||
|
||
|
||
|
||
VOID
|
||
TopicSetAudio(
|
||
IN PSOCKET Socket,
|
||
IN BOOLEAN Enable
|
||
)
|
||
{
|
||
PFDO_EXTENSION FdoExtension = Socket->DeviceExtension;
|
||
ULONG data;
|
||
ULONG orig_data;
|
||
BOOLEAN setBit;
|
||
|
||
|
||
setBit = (IsCardBusCardInSocket(Socket) ^ Enable);
|
||
|
||
GetPciConfigSpace(FdoExtension, CFGSPACE_TO_CBREG_CTRL, &data, sizeof(data));
|
||
orig_data = data;
|
||
|
||
if (setBit) {
|
||
data |= CSRCR_TO_CAUDIO_OFF;
|
||
} else {
|
||
data &= ~CSRCR_TO_CAUDIO_OFF;
|
||
}
|
||
|
||
if (orig_data != data) {
|
||
SetPciConfigSpace(FdoExtension, CFGSPACE_TO_CBREG_CTRL, &data, sizeof(data));
|
||
}
|
||
|
||
}
|
||
|
||
|
||
|
||
BOOLEAN
|
||
TopicSetZV(
|
||
IN PSOCKET Socket,
|
||
IN BOOLEAN Enable
|
||
)
|
||
{
|
||
UCHAR bData;
|
||
|
||
if (Enable) {
|
||
|
||
PcicWriteSocket(Socket, PCIC_TO_MMI_CTRL, TO_MMI_VIDEO_CTRL | TO_MMI_AUDIO_CTRL);
|
||
bData = PcicReadSocket(Socket, PCIC_TO_ADDITIONAL_GENCTRL);
|
||
bData |= TO_GCTRL_CARDREMOVAL_RESET;
|
||
PcicWriteSocket(Socket, PCIC_TO_ADDITIONAL_GENCTRL, bData);
|
||
|
||
} else {
|
||
|
||
PcicWriteSocket(Socket, PCIC_TO_MMI_CTRL, 0);
|
||
bData = PcicReadSocket(Socket, PCIC_TO_ADDITIONAL_GENCTRL);
|
||
bData &= ~TO_GCTRL_CARDREMOVAL_RESET;
|
||
PcicWriteSocket(Socket, PCIC_TO_ADDITIONAL_GENCTRL, bData);
|
||
|
||
}
|
||
return TRUE;
|
||
}
|
||
|