1
2
3
4
5
6
7
8
9
10#include <asm/delay.h>
11#include <linux/pci.h>
12#include <linux/interrupt.h>
13#include <asm/reboot_fixups.h>
14#include <asm/msr.h>
15#include <asm/geode.h>
16
17static void cs5530a_warm_reset(struct pci_dev *dev)
18{
19
20
21 pci_write_config_byte(dev, 0x44, 0x1);
22 udelay(50);
23 return;
24}
25
26static void cs5536_warm_reset(struct pci_dev *dev)
27{
28
29 wrmsrl(MSR_DIVIL_SOFT_RESET, 1ULL);
30 udelay(50);
31}
32
33static void rdc321x_reset(struct pci_dev *dev)
34{
35 unsigned i;
36
37 outl(0x80003840, 0xCF8);
38
39 i = inl(0xCFC);
40
41 i |= 0x1600;
42 outl(i, 0xCFC);
43 outb(1, 0x92);
44}
45
46struct device_fixup {
47 unsigned int vendor;
48 unsigned int device;
49 void (*reboot_fixup)(struct pci_dev *);
50};
51
52static const struct device_fixup fixups_table[] = {
53{ PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5530_LEGACY, cs5530a_warm_reset },
54{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_ISA, cs5536_warm_reset },
55{ PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SC1100_BRIDGE, cs5530a_warm_reset },
56{ PCI_VENDOR_ID_RDC, PCI_DEVICE_ID_RDC_R6030, rdc321x_reset },
57};
58
59
60
61
62
63
64
65void mach_reboot_fixups(void)
66{
67 const struct device_fixup *cur;
68 struct pci_dev *dev;
69 int i;
70
71
72
73 if (in_interrupt())
74 return;
75
76 for (i=0; i < ARRAY_SIZE(fixups_table); i++) {
77 cur = &(fixups_table[i]);
78 dev = pci_get_device(cur->vendor, cur->device, NULL);
79 if (!dev)
80 continue;
81
82 cur->reboot_fixup(dev);
83 }
84}
85
86