1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/stddef.h>
20#include <linux/kernel.h>
21#include <linux/pci.h>
22#include <linux/kdev_t.h>
23#include <linux/delay.h>
24#include <linux/seq_file.h>
25#include <linux/of_platform.h>
26
27#include <asm/time.h>
28#include <asm/machdep.h>
29#include <asm/pci-bridge.h>
30#include <asm/prom.h>
31#include <mm/mmu_decl.h>
32#include <asm/udbg.h>
33
34#include <asm/mpic.h>
35#include <asm/nvram.h>
36
37#include <sysdev/fsl_pci.h>
38#include <sysdev/fsl_soc.h>
39#include <sysdev/ge/ge_pic.h>
40
41#include "mpc86xx.h"
42
43#undef DEBUG
44
45#ifdef DEBUG
46#define DBG (fmt...) do { printk(KERN_ERR "SBC310: " fmt); } while (0)
47#else
48#define DBG (fmt...) do { } while (0)
49#endif
50
51void __iomem *sbc310_regs;
52
53static void __init gef_sbc310_init_irq(void)
54{
55 struct device_node *cascade_node = NULL;
56
57 mpc86xx_init_irq();
58
59
60
61
62
63 cascade_node = of_find_compatible_node(NULL, NULL, "gef,fpga-pic");
64 if (!cascade_node) {
65 printk(KERN_WARNING "SBC310: No FPGA PIC\n");
66 return;
67 }
68
69 gef_pic_init(cascade_node);
70 of_node_put(cascade_node);
71}
72
73static void __init gef_sbc310_setup_arch(void)
74{
75 struct device_node *regs;
76 printk(KERN_INFO "GE Intelligent Platforms SBC310 6U VPX SBC\n");
77
78#ifdef CONFIG_SMP
79 mpc86xx_smp_init();
80#endif
81
82 fsl_pci_assign_primary();
83
84
85 regs = of_find_compatible_node(NULL, NULL, "gef,fpga-regs");
86 if (regs) {
87 sbc310_regs = of_iomap(regs, 0);
88 if (sbc310_regs == NULL)
89 printk(KERN_WARNING "Unable to map board registers\n");
90 of_node_put(regs);
91 }
92
93#if defined(CONFIG_MMIO_NVRAM)
94 mmio_nvram_init();
95#endif
96}
97
98
99static unsigned int gef_sbc310_get_board_id(void)
100{
101 unsigned int reg;
102
103 reg = ioread32(sbc310_regs);
104 return reg & 0xff;
105}
106
107
108static unsigned int gef_sbc310_get_pcb_rev(void)
109{
110 unsigned int reg;
111
112 reg = ioread32(sbc310_regs);
113 return (reg >> 8) & 0xff;
114}
115
116
117static unsigned int gef_sbc310_get_board_rev(void)
118{
119 unsigned int reg;
120
121 reg = ioread32(sbc310_regs);
122 return (reg >> 16) & 0xff;
123}
124
125
126static unsigned int gef_sbc310_get_fpga_rev(void)
127{
128 unsigned int reg;
129
130 reg = ioread32(sbc310_regs);
131 return (reg >> 24) & 0xf;
132}
133
134static void gef_sbc310_show_cpuinfo(struct seq_file *m)
135{
136 uint svid = mfspr(SPRN_SVR);
137
138 seq_printf(m, "Vendor\t\t: GE Intelligent Platforms\n");
139
140 seq_printf(m, "Board ID\t: 0x%2.2x\n", gef_sbc310_get_board_id());
141 seq_printf(m, "Revision\t: %u%c\n", gef_sbc310_get_pcb_rev(),
142 ('A' + gef_sbc310_get_board_rev() - 1));
143 seq_printf(m, "FPGA Revision\t: %u\n", gef_sbc310_get_fpga_rev());
144
145 seq_printf(m, "SVR\t\t: 0x%x\n", svid);
146
147}
148
149static void gef_sbc310_nec_fixup(struct pci_dev *pdev)
150{
151 unsigned int val;
152
153
154 if (!machine_is(gef_sbc310))
155 return;
156
157 printk(KERN_INFO "Running NEC uPD720101 Fixup\n");
158
159
160 pci_read_config_dword(pdev, 0xe0, &val);
161 pci_write_config_dword(pdev, 0xe0, (val & ~7) | 0x2);
162
163
164 pci_write_config_dword(pdev, 0xe4, 1 << 5);
165}
166DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_NEC, PCI_DEVICE_ID_NEC_USB,
167 gef_sbc310_nec_fixup);
168
169
170
171
172
173
174
175
176
177static int __init gef_sbc310_probe(void)
178{
179 if (of_machine_is_compatible("gef,sbc310"))
180 return 1;
181
182 return 0;
183}
184
185machine_arch_initcall(gef_sbc310, mpc86xx_common_publish_devices);
186
187define_machine(gef_sbc310) {
188 .name = "GE SBC310",
189 .probe = gef_sbc310_probe,
190 .setup_arch = gef_sbc310_setup_arch,
191 .init_IRQ = gef_sbc310_init_irq,
192 .show_cpuinfo = gef_sbc310_show_cpuinfo,
193 .get_irq = mpic_get_irq,
194 .time_init = mpc86xx_time_init,
195 .calibrate_decr = generic_calibrate_decr,
196 .progress = udbg_progress,
197#ifdef CONFIG_PCI
198 .pcibios_fixup_bus = fsl_pcibios_fixup_bus,
199#endif
200};
201