Aren/haiku
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Implementing pci_{get|set}_powerstate. There are some wlan chips with the need

Browse Source 
to be switched to D0 first.


git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@34718 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Colin Günther 2009-12-20 13:10:20 +00:00
parent 97eaabdfb0
commit cc69ec0dd6
1 changed files with 96 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

96
src/libs/compat/freebsd_network/bus.c
View File

@ -689,3 +689,99 @@ pci_alloc_msix(device_t dev, int *count)
{
return ENODEV;
}
int
pci_get_powerstate(device_t dev)
{
int capabilityRegister;
uint16 status;
int powerState = PCI_POWERSTATE_D0;
if (pci_find_extcap(dev, PCIY_PMG, &capabilityRegister) != EOK)
return powerState;
status = pci_read_config(dev, capabilityRegister + PCIR_POWER_STATUS, 2);
switch (status & PCI_pm_mask) {
case PCI_pm_state_d0:
break;
case PCI_pm_state_d1:
powerState = PCI_POWERSTATE_D1;
break;
case PCI_pm_state_d2:
powerState = PCI_POWERSTATE_D2;
break;
case PCI_pm_state_d3:
powerState = PCI_POWERSTATE_D3;
break;
default:
powerState = PCI_POWERSTATE_UNKNOWN;
break;
}
TRACE_PCI(dev, "%s: D%i\n", __func__, powerState);
return powerState;
}
int
pci_set_powerstate(device_t dev, int newPowerState)
{
int capabilityRegister;
int oldPowerState;
uint8 currentPowerManagementStatus;
uint8 newPowerManagementStatus;
uint16 powerManagementCapabilities;
bigtime_t stateTransitionDelayInUs = 0;
if (pci_find_extcap(dev, PCIY_PMG, &capabilityRegister) != EOK)
return EOPNOTSUPP;
oldPowerState = pci_get_powerstate(dev);
if (oldPowerState == newPowerState)
return EOK;
switch (max(oldPowerState, newPowerState)) {
case PCI_POWERSTATE_D2:
stateTransitionDelayInUs = 200;
break;
case PCI_POWERSTATE_D3:
stateTransitionDelayInUs = 10000;
break;
}
currentPowerManagementStatus = pci_read_config(dev, capabilityRegister
+ PCIR_POWER_STATUS, 2);
newPowerManagementStatus = currentPowerManagementStatus & ~PCI_pm_mask;
powerManagementCapabilities = pci_read_config(dev, capabilityRegister
+ PCIR_POWER_CAP, 2);
switch (newPowerState) {
case PCI_POWERSTATE_D0:
newPowerManagementStatus |= PCIM_PSTAT_D0;
break;
case PCI_POWERSTATE_D1:
if ((powerManagementCapabilities & PCI_pm_d1supp) == 0)
return EOPNOTSUPP;
newPowerManagementStatus |= PCIM_PSTAT_D1;
break;
case PCI_POWERSTATE_D2:
if ((powerManagementCapabilities & PCI_pm_d2supp) == 0)
return EOPNOTSUPP;
newPowerManagementStatus |= PCIM_PSTAT_D2;
break;
case PCI_POWERSTATE_D3:
newPowerManagementStatus |= PCIM_PSTAT_D3;
break;
default:
return EINVAL;
}
TRACE_PCI(dev, "%s: D%i -> D%i\n", __func__, oldPowerState, newPowerState);
pci_write_config(dev, capabilityRegister + PCIR_POWER_STATUS, newPowerState,
2);
if (stateTransitionDelayInUs != 0)
snooze(stateTransitionDelayInUs);
return EOK;
}