Angel Pons | 182dbde | 2020-04-02 23:49:05 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 2 | |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 3 | #include <device/device.h> |
| 4 | #include <device/pci.h> |
Kyösti Mälkki | f1b58b7 | 2019-03-01 13:43:02 +0200 | [diff] [blame] | 5 | #include <device/pci_ops.h> |
Stefan Reinauer | 138be83 | 2010-02-27 01:50:21 +0000 | [diff] [blame] | 6 | #include "i82801dx.h" |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 7 | |
Elyes HAOUAS | 66faf0c | 2018-05-13 13:32:56 +0200 | [diff] [blame] | 8 | void i82801dx_enable(struct device *dev) |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 9 | { |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 10 | unsigned int index = 0; |
| 11 | uint8_t bHasDisableBit = 0; |
| 12 | uint16_t cur_disable_mask, new_disable_mask; |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 13 | |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 14 | // all 82801dbm devices are in bus 0 |
| 15 | unsigned int devfn = PCI_DEVFN(0x1f, 0); // lpc |
Kyösti Mälkki | e737755 | 2018-06-21 16:20:55 +0300 | [diff] [blame] | 16 | struct device *lpc_dev = pcidev_path_on_root(devfn); // 0 |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 17 | if (!lpc_dev) |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 18 | return; |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 19 | |
| 20 | // Calculate disable bit position for specified device:function |
| 21 | // NOTE: For ICH-4, only the following devices can be disabled: |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 22 | // D31: F0, F1, F3, F5, F6, |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 23 | // D29: F0, F1, F2, F7 |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 24 | |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 25 | if (PCI_SLOT(dev->path.pci.devfn) == 31) { |
| 26 | index = PCI_FUNC(dev->path.pci.devfn); |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 27 | |
| 28 | switch (index) { |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 29 | case 0: |
| 30 | case 1: |
| 31 | case 3: |
| 32 | case 5: |
| 33 | case 6: |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 34 | bHasDisableBit = 1; |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 35 | break; |
| 36 | |
| 37 | default: |
| 38 | break; |
| 39 | }; |
| 40 | |
| 41 | if (index == 0) |
| 42 | index = 14; // D31:F0 bit is an exception |
| 43 | |
| 44 | } else if (PCI_SLOT(dev->path.pci.devfn) == 29) { |
| 45 | index = 8 + PCI_FUNC(dev->path.pci.devfn); |
| 46 | |
| 47 | if ((PCI_FUNC(dev->path.pci.devfn) < 3) |
| 48 | || (PCI_FUNC(dev->path.pci.devfn) == 7)) |
| 49 | bHasDisableBit = 1; |
| 50 | } |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 51 | |
| 52 | if (bHasDisableBit) { |
| 53 | cur_disable_mask = pci_read_config16(lpc_dev, FUNC_DIS); |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 54 | new_disable_mask = cur_disable_mask & ~(1 << index); // enable it |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 55 | if (!dev->enabled) { |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 56 | new_disable_mask |= (1 << index); // disable it |
Steven J. Magnani | 7557331 | 2005-09-21 13:49:44 +0000 | [diff] [blame] | 57 | } |
| 58 | if (new_disable_mask != cur_disable_mask) { |
| 59 | pci_write_config16(lpc_dev, FUNC_DIS, new_disable_mask); |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 60 | } |
| 61 | } |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 62 | } |
| 63 | |
Stefan Reinauer | 138be83 | 2010-02-27 01:50:21 +0000 | [diff] [blame] | 64 | struct chip_operations southbridge_intel_i82801dx_ops = { |
| 65 | CHIP_NAME("Intel ICH4/ICH4-M (82801Dx) Series Southbridge") |
Stefan Reinauer | 8702ab5 | 2010-03-14 17:01:08 +0000 | [diff] [blame] | 66 | .enable_dev = i82801dx_enable, |
Ronald G. Minnich | 182615d | 2004-08-24 16:20:46 +0000 | [diff] [blame] | 67 | }; |