1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <common.h>
27#include <asm/processor.h>
28#include <command.h>
29
30#include "p3p440.h"
31
32DECLARE_GLOBAL_DATA_PTR;
33
34void set_led(int color)
35{
36 switch (color) {
37 case LED_OFF:
38 out32(GPIO0_OR, in32(GPIO0_OR) & ~CONFIG_SYS_LED_GREEN & ~CONFIG_SYS_LED_RED);
39 break;
40
41 case LED_GREEN:
42 out32(GPIO0_OR, (in32(GPIO0_OR) | CONFIG_SYS_LED_GREEN) & ~CONFIG_SYS_LED_RED);
43 break;
44
45 case LED_RED:
46 out32(GPIO0_OR, (in32(GPIO0_OR) | CONFIG_SYS_LED_RED) & ~CONFIG_SYS_LED_GREEN);
47 break;
48
49 case LED_ORANGE:
50 out32(GPIO0_OR, in32(GPIO0_OR) | CONFIG_SYS_LED_GREEN | CONFIG_SYS_LED_RED);
51 break;
52 }
53}
54
55static int is_monarch(void)
56{
57 out32(GPIO0_OR, in32(GPIO0_OR) & ~CONFIG_SYS_GPIO_RDY);
58 udelay(1000);
59
60 if (in32(GPIO0_IR) & CONFIG_SYS_MONARCH_IO)
61 return 0;
62 else
63 return 1;
64}
65
66static void wait_for_pci_ready(void)
67{
68
69
70
71 out32(GPIO0_TCR, in32(GPIO0_TCR) & ~CONFIG_SYS_EREADY_IO);
72 udelay(1000);
73
74 for (;;) {
75 if (in32(GPIO0_IR) & CONFIG_SYS_EREADY_IO)
76 return;
77 }
78
79}
80
81int board_early_init_f(void)
82{
83 uint reg;
84
85
86
87
88 mtdcr(EBC0_CFGADDR, EBC0_CFG);
89 reg = mfdcr(EBC0_CFGDATA);
90 mtdcr(EBC0_CFGDATA, reg | 0x04000000);
91
92
93
94
95 mtdcr(CPC0_GPIO, 0x03F01F80);
96
97 out32(GPIO0_ODR, 0x00000000);
98 out32(GPIO0_TCR, CONFIG_SYS_GPIO_RDY | CONFIG_SYS_EREADY_IO | CONFIG_SYS_LED_RED | CONFIG_SYS_LED_GREEN);
99 out32(GPIO0_OR, CONFIG_SYS_GPIO_RDY);
100
101
102
103
104 mtdcr(UIC0SR, 0xffffffff);
105 mtdcr(UIC0ER, 0x00000000);
106 mtdcr(UIC0CR, 0x00000001);
107 mtdcr(UIC0PR, 0xfffffe13);
108 mtdcr(UIC0TR, 0x01c00008);
109 mtdcr(UIC0VR, 0x00000001);
110 mtdcr(UIC0SR, 0xffffffff);
111
112 mtdcr(UIC1SR, 0xffffffff);
113 mtdcr(UIC1ER, 0x00000000);
114 mtdcr(UIC1CR, 0x00000000);
115 mtdcr(UIC1PR, 0xffffe0ff);
116 mtdcr(UIC1TR, 0x00ffc000);
117 mtdcr(UIC1VR, 0x00000001);
118 mtdcr(UIC1SR, 0xffffffff);
119
120 return 0;
121}
122
123int checkboard(void)
124{
125 char *s = getenv("serial#");
126
127 printf("Board: P3P440");
128 if (s != NULL) {
129 puts(", serial# ");
130 puts(s);
131 }
132
133 if (is_monarch()) {
134 puts(", Monarch");
135 } else {
136 puts(", None-Monarch");
137 }
138
139 putc('\n');
140
141 return (0);
142}
143
144int misc_init_r (void)
145{
146
147
148
149 gd->bd->bi_flashstart = 0 - gd->bd->bi_flashsize;
150 gd->bd->bi_flashoffset = 0;
151
152
153
154
155 if (gd->bd->bi_flashsize != CONFIG_SYS_MAX_FLASH_BANKS * (0 - CONFIG_SYS_FLASH0)) {
156 mtebc(PB1CR, 0);
157 mtebc(PB1AP, 0);
158 mtebc(PB2CR, 0);
159 mtebc(PB2AP, 0);
160 mtebc(PB3CR, 0);
161 mtebc(PB3AP, 0);
162 }
163
164 return 0;
165}
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182#if defined(CONFIG_PCI)
183int is_pci_host(struct pci_controller *hose)
184{
185 if (is_monarch()) {
186 wait_for_pci_ready();
187 return 1;
188 } else {
189 return 0;
190 }
191}
192#endif
193