1b258c62ce67efc0e28d57d618977a9ed4aa1d6c
[coreboot.git] / src / northbridge / amd / amdk8 / raminit.c
1 #include <cpu/k8/mtrr.h>
2 #include "raminit.h"
3
4 /* Function 2 */
5 #define DRAM_CSBASE        0x40
6 #define DRAM_CSMASK        0x60
7 #define DRAM_BANK_ADDR_MAP 0x80
8 #define DRAM_TIMING_LOW    0x88
9 #define  DTL_TCL_SHIFT     0
10 #define  DTL_TCL_MASK      0x7
11 #define   DTL_CL_2         1
12 #define   DTL_CL_3         2
13 #define   DTL_CL_2_5       5
14 #define  DTL_TRC_SHIFT     4
15 #define  DTL_TRC_MASK      0xf
16 #define   DTL_TRC_BASE     7
17 #define   DTL_TRC_MIN      7
18 #define   DTL_TRC_MAX      22
19 #define  DTL_TRFC_SHIFT    8
20 #define  DTL_TRFC_MASK     0xf
21 #define   DTL_TRFC_BASE    9
22 #define   DTL_TRFC_MIN     9
23 #define   DTL_TRFC_MAX     24
24 #define  DTL_TRCD_SHIFT    12
25 #define  DTL_TRCD_MASK     0x7
26 #define   DTL_TRCD_BASE    0
27 #define   DTL_TRCD_MIN     2
28 #define   DTL_TRCD_MAX     6
29 #define  DTL_TRRD_SHIFT    16
30 #define  DTL_TRRD_MASK     0x7
31 #define   DTL_TRRD_BASE    0
32 #define   DTL_TRRD_MIN     2
33 #define   DTL_TRRD_MAX     4
34 #define  DTL_TRAS_SHIFT    20
35 #define  DTL_TRAS_MASK     0xf
36 #define   DTL_TRAS_BASE    0
37 #define   DTL_TRAS_MIN     5
38 #define   DTL_TRAS_MAX     15
39 #define  DTL_TRP_SHIFT     24
40 #define  DTL_TRP_MASK      0x7
41 #define   DTL_TRP_BASE     0
42 #define   DTL_TRP_MIN      2
43 #define   DTL_TRP_MAX      6
44 #define  DTL_TWR_SHIFT     28
45 #define  DTL_TWR_MASK      0x1
46 #define   DTL_TWR_BASE     2
47 #define   DTL_TWR_MIN      2
48 #define   DTL_TWR_MAX      3
49 #define DRAM_TIMING_HIGH   0x8c
50 #define  DTH_TWTR_SHIFT    0
51 #define  DTH_TWTR_MASK     0x1
52 #define   DTH_TWTR_BASE    1
53 #define   DTH_TWTR_MIN     1
54 #define   DTH_TWTR_MAX     2
55 #define  DTH_TRWT_SHIFT    4
56 #define  DTH_TRWT_MASK     0x7
57 #define   DTH_TRWT_BASE    1
58 #define   DTH_TRWT_MIN     1
59 #define   DTH_TRWT_MAX     6
60 #define  DTH_TREF_SHIFT    8
61 #define  DTH_TREF_MASK     0x1f
62 #define   DTH_TREF_100MHZ_4K 0x00
63 #define   DTH_TREF_133MHZ_4K 0x01
64 #define   DTH_TREF_166MHZ_4K 0x02
65 #define   DTH_TREF_200MHZ_4K 0x03
66 #define   DTH_TREF_100MHZ_8K 0x08
67 #define   DTH_TREF_133MHZ_8K 0x09
68 #define   DTH_TREF_166MHZ_8K 0x0A
69 #define   DTH_TREF_200MHZ_8K 0x0B
70 #define  DTH_TWCL_SHIFT     20
71 #define  DTH_TWCL_MASK      0x7
72 #define   DTH_TWCL_BASE     1
73 #define   DTH_TWCL_MIN      1
74 #define   DTH_TWCL_MAX      2
75 #define DRAM_CONFIG_LOW    0x90
76 #define  DCL_DLL_Disable   (1<<0)
77 #define  DCL_D_DRV         (1<<1)
78 #define  DCL_QFC_EN        (1<<2)
79 #define  DCL_DisDqsHys     (1<<3)
80 #define  DCL_DramInit      (1<<8)
81 #define  DCL_DramEnable    (1<<10)
82 #define  DCL_MemClrStatus  (1<<11)
83 #define  DCL_ESR           (1<<12)
84 #define  DCL_SRS           (1<<13)
85 #define  DCL_128BitEn      (1<<16)
86 #define  DCL_DimmEccEn     (1<<17)
87 #define  DCL_UnBufDimm     (1<<18)
88 #define  DCL_32ByteEn      (1<<19)
89 #define  DCL_x4DIMM_SHIFT  20
90 #define DRAM_CONFIG_HIGH   0x94
91 #define  DCH_ASYNC_LAT_SHIFT  0
92 #define  DCH_ASYNC_LAT_MASK   0xf
93 #define   DCH_ASYNC_LAT_BASE  0
94 #define   DCH_ASYNC_LAT_MIN   0
95 #define   DCH_ASYNC_LAT_MAX   15
96 #define  DCH_RDPREAMBLE_SHIFT 8
97 #define  DCH_RDPREAMBLE_MASK  0xf
98 #define   DCH_RDPREAMBLE_BASE ((2<<1)+0) /* 2.0 ns */
99 #define   DCH_RDPREAMBLE_MIN  ((2<<1)+0) /* 2.0 ns */
100 #define   DCH_RDPREAMBLE_MAX  ((9<<1)+1) /* 9.5 ns */
101 #define  DCH_IDLE_LIMIT_SHIFT 16
102 #define  DCH_IDLE_LIMIT_MASK  0x7
103 #define   DCH_IDLE_LIMIT_0    0
104 #define   DCH_IDLE_LIMIT_4    1
105 #define   DCH_IDLE_LIMIT_8    2
106 #define   DCH_IDLE_LIMIT_16   3
107 #define   DCH_IDLE_LIMIT_32   4
108 #define   DCH_IDLE_LIMIT_64   5
109 #define   DCH_IDLE_LIMIT_128  6
110 #define   DCH_IDLE_LIMIT_256  7
111 #define  DCH_DYN_IDLE_CTR_EN (1 << 19)
112 #define  DCH_MEMCLK_SHIFT     20
113 #define  DCH_MEMCLK_MASK      0x7
114 #define   DCH_MEMCLK_100MHZ   0
115 #define   DCH_MEMCLK_133MHZ   2
116 #define   DCH_MEMCLK_166MHZ   5
117 #define   DCH_MEMCLK_200MHZ   7
118 #define  DCH_MEMCLK_VALID     (1 << 25)
119 #define  DCH_MEMCLK_EN0       (1 << 26) 
120 #define  DCH_MEMCLK_EN1       (1 << 27) 
121 #define  DCH_MEMCLK_EN2       (1 << 28) 
122 #define  DCH_MEMCLK_EN3       (1 << 29) 
123
124 /* Function 3 */
125 #define SCRUB_CONTROL      0x58
126 #define   SCRUB_NONE        0
127 #define   SCRUB_40ns        1
128 #define   SCRUB_80ns        2
129 #define   SCRUB_160ns       3
130 #define   SCRUB_320ns       4
131 #define   SCRUB_640ns       5
132 #define   SCRUB_1_28us      6
133 #define   SCRUB_2_56us      7
134 #define   SCRUB_5_12us      8
135 #define   SCRUB_10_2us      9
136 #define   SCRUB_20_5us     10
137 #define   SCRUB_41_0us     11
138 #define   SCRUB_81_9us     12
139 #define   SCRUB_163_8us    13
140 #define   SCRUB_327_7us    14
141 #define   SCRUB_655_4us    15
142 #define   SCRUB_1_31ms     16
143 #define   SCRUB_2_62ms     17
144 #define   SCRUB_5_24ms     18 
145 #define   SCRUB_10_49ms    19
146 #define   SCRUB_20_97ms    20
147 #define   SCRUB_42ms       21
148 #define   SCRUB_84ms       22
149 #define  SC_DRAM_SCRUB_RATE_SHFIT  0
150 #define  SC_DRAM_SCRUB_RATE_MASK   0x1f
151 #define  SC_L2_SCRUB_RATE_SHIFT    8
152 #define  SC_L2_SCRUB_RATE_MASK     0x1f
153 #define  SC_L1D_SCRUB_RATE_SHIFT   16
154 #define  SC_L1D_SCRUB_RATE_MASK    0x1f
155 #define SCRUB_ADDR_LOW     0x5C
156 #define SCRUB_ADDR_HIGH    0x60
157 #define NORTHBRIDGE_CAP    0xE8
158 #define  NBCAP_128Bit         0x0001
159 #define  NBCAP_MP             0x0002
160 #define  NBCAP_BIG_MP         0x0004
161 #define  NBCAP_ECC            0x0004
162 #define  NBCAP_CHIPKILL_ECC   0x0010
163 #define  NBCAP_MEMCLK_SHIFT   5
164 #define  NBCAP_MEMCLK_MASK    3
165 #define  NBCAP_MEMCLK_100MHZ  3
166 #define  NBCAP_MEMCLK_133MHZ  2
167 #define  NBCAP_MEMCLK_166MHZ  1
168 #define  NBCAP_MEMCLK_200MHZ  0
169 #define  NBCAP_MEMCTRL        0x0100
170
171
172 static void setup_resource_map(const unsigned int *register_values, int max)
173 {
174         int i;
175         print_debug("setting up resource map....\r\n");
176         for(i = 0; i < max; i += 3) {
177                 device_t dev;
178                 unsigned where;
179                 unsigned long reg;
180 #if 0
181                 print_debug_hex32(register_values[i]);
182                 print_debug(" <-");
183                 print_debug_hex32(register_values[i+2]);
184                 print_debug("\r\n");
185 #endif
186                 dev = register_values[i] & ~0xff;
187                 where = register_values[i] & 0xff;
188                 reg = pci_read_config32(dev, where);
189                 reg &= register_values[i+1];
190                 reg |= register_values[i+2];
191                 pci_write_config32(dev, where, reg);
192 #if 0
193                 reg = pci_read_config32(register_values[i]);
194                 reg &= register_values[i+1];
195                 reg |= register_values[i+2] & ~register_values[i+1];
196                 pci_write_config32(register_values[i], reg);
197 #endif
198         }
199         print_debug("done.\r\n");
200 }
201
202 static void setup_default_resource_map(void)
203 {
204         static const unsigned int register_values[] = {
205         /* Careful set limit registers before base registers which contain the enables */
206         /* DRAM Limit i Registers
207          * F1:0x44 i = 0
208          * F1:0x4C i = 1
209          * F1:0x54 i = 2
210          * F1:0x5C i = 3
211          * F1:0x64 i = 4
212          * F1:0x6C i = 5
213          * F1:0x74 i = 6
214          * F1:0x7C i = 7
215          * [ 2: 0] Destination Node ID
216          *         000 = Node 0
217          *         001 = Node 1
218          *         010 = Node 2
219          *         011 = Node 3
220          *         100 = Node 4
221          *         101 = Node 5
222          *         110 = Node 6
223          *         111 = Node 7
224          * [ 7: 3] Reserved
225          * [10: 8] Interleave select
226          *         specifies the values of A[14:12] to use with interleave enable.
227          * [15:11] Reserved
228          * [31:16] DRAM Limit Address i Bits 39-24
229          *         This field defines the upper address bits of a 40 bit  address
230          *         that define the end of the DRAM region.
231          */
232         PCI_ADDR(0, 0x18, 1, 0x44), 0x0000f8f8, 0x00000000,
233         PCI_ADDR(0, 0x18, 1, 0x4C), 0x0000f8f8, 0x00000001,
234         PCI_ADDR(0, 0x18, 1, 0x54), 0x0000f8f8, 0x00000002,
235         PCI_ADDR(0, 0x18, 1, 0x5C), 0x0000f8f8, 0x00000003,
236         PCI_ADDR(0, 0x18, 1, 0x64), 0x0000f8f8, 0x00000004,
237         PCI_ADDR(0, 0x18, 1, 0x6C), 0x0000f8f8, 0x00000005,
238         PCI_ADDR(0, 0x18, 1, 0x74), 0x0000f8f8, 0x00000006,
239         PCI_ADDR(0, 0x18, 1, 0x7C), 0x0000f8f8, 0x00000007,
240         /* DRAM Base i Registers
241          * F1:0x40 i = 0
242          * F1:0x48 i = 1
243          * F1:0x50 i = 2
244          * F1:0x58 i = 3
245          * F1:0x60 i = 4
246          * F1:0x68 i = 5
247          * F1:0x70 i = 6
248          * F1:0x78 i = 7
249          * [ 0: 0] Read Enable
250          *         0 = Reads Disabled
251          *         1 = Reads Enabled
252          * [ 1: 1] Write Enable
253          *         0 = Writes Disabled
254          *         1 = Writes Enabled
255          * [ 7: 2] Reserved
256          * [10: 8] Interleave Enable
257          *         000 = No interleave
258          *         001 = Interleave on A[12] (2 nodes)
259          *         010 = reserved
260          *         011 = Interleave on A[12] and A[14] (4 nodes)
261          *         100 = reserved
262          *         101 = reserved
263          *         110 = reserved
264          *         111 = Interleve on A[12] and A[13] and A[14] (8 nodes)
265          * [15:11] Reserved
266          * [13:16] DRAM Base Address i Bits 39-24
267          *         This field defines the upper address bits of a 40-bit address
268          *         that define the start of the DRAM region.
269          */
270         PCI_ADDR(0, 0x18, 1, 0x40), 0x0000f8fc, 0x00000000,
271         PCI_ADDR(0, 0x18, 1, 0x48), 0x0000f8fc, 0x00000000,
272         PCI_ADDR(0, 0x18, 1, 0x50), 0x0000f8fc, 0x00000000,
273         PCI_ADDR(0, 0x18, 1, 0x58), 0x0000f8fc, 0x00000000,
274         PCI_ADDR(0, 0x18, 1, 0x60), 0x0000f8fc, 0x00000000,
275         PCI_ADDR(0, 0x18, 1, 0x68), 0x0000f8fc, 0x00000000,
276         PCI_ADDR(0, 0x18, 1, 0x70), 0x0000f8fc, 0x00000000,
277         PCI_ADDR(0, 0x18, 1, 0x78), 0x0000f8fc, 0x00000000,
278
279         /* Memory-Mapped I/O Limit i Registers
280          * F1:0x84 i = 0
281          * F1:0x8C i = 1
282          * F1:0x94 i = 2
283          * F1:0x9C i = 3
284          * F1:0xA4 i = 4
285          * F1:0xAC i = 5
286          * F1:0xB4 i = 6
287          * F1:0xBC i = 7
288          * [ 2: 0] Destination Node ID
289          *         000 = Node 0
290          *         001 = Node 1
291          *         010 = Node 2
292          *         011 = Node 3
293          *         100 = Node 4
294          *         101 = Node 5
295          *         110 = Node 6
296          *         111 = Node 7
297          * [ 3: 3] Reserved
298          * [ 5: 4] Destination Link ID
299          *         00 = Link 0
300          *         01 = Link 1
301          *         10 = Link 2
302          *         11 = Reserved
303          * [ 6: 6] Reserved
304          * [ 7: 7] Non-Posted
305          *         0 = CPU writes may be posted
306          *         1 = CPU writes must be non-posted
307          * [31: 8] Memory-Mapped I/O Limit Address i (39-16)
308          *         This field defines the upp adddress bits of a 40-bit address that
309          *         defines the end of a memory-mapped I/O region n
310          */
311         PCI_ADDR(0, 0x18, 1, 0x84), 0x00000048, 0x00000000,
312         PCI_ADDR(0, 0x18, 1, 0x8C), 0x00000048, 0x00000000,
313         PCI_ADDR(0, 0x18, 1, 0x94), 0x00000048, 0x00000000,
314         PCI_ADDR(0, 0x18, 1, 0x9C), 0x00000048, 0x00000000,
315         PCI_ADDR(0, 0x18, 1, 0xA4), 0x00000048, 0x00000000,
316         PCI_ADDR(0, 0x18, 1, 0xAC), 0x00000048, 0x00000000,
317         PCI_ADDR(0, 0x18, 1, 0xB4), 0x00000048, 0x00000000,
318         PCI_ADDR(0, 0x18, 1, 0xBC), 0x00000048, 0x00ffff00,
319
320         /* Memory-Mapped I/O Base i Registers
321          * F1:0x80 i = 0
322          * F1:0x88 i = 1
323          * F1:0x90 i = 2
324          * F1:0x98 i = 3
325          * F1:0xA0 i = 4
326          * F1:0xA8 i = 5
327          * F1:0xB0 i = 6
328          * F1:0xB8 i = 7
329          * [ 0: 0] Read Enable
330          *         0 = Reads disabled
331          *         1 = Reads Enabled
332          * [ 1: 1] Write Enable
333          *         0 = Writes disabled
334          *         1 = Writes Enabled
335          * [ 2: 2] Cpu Disable
336          *         0 = Cpu can use this I/O range
337          *         1 = Cpu requests do not use this I/O range
338          * [ 3: 3] Lock
339          *         0 = base/limit registers i are read/write
340          *         1 = base/limit registers i are read-only
341          * [ 7: 4] Reserved
342          * [31: 8] Memory-Mapped I/O Base Address i (39-16)
343          *         This field defines the upper address bits of a 40bit address 
344          *         that defines the start of memory-mapped I/O region i
345          */
346         PCI_ADDR(0, 0x18, 1, 0x80), 0x000000f0, 0x00000000,
347         PCI_ADDR(0, 0x18, 1, 0x88), 0x000000f0, 0x00000000,
348         PCI_ADDR(0, 0x18, 1, 0x90), 0x000000f0, 0x00000000,
349         PCI_ADDR(0, 0x18, 1, 0x98), 0x000000f0, 0x00000000,
350         PCI_ADDR(0, 0x18, 1, 0xA0), 0x000000f0, 0x00000000,
351         PCI_ADDR(0, 0x18, 1, 0xA8), 0x000000f0, 0x00000000,
352         PCI_ADDR(0, 0x18, 1, 0xB0), 0x000000f0, 0x00000000,
353         PCI_ADDR(0, 0x18, 1, 0xB8), 0x000000f0, 0x00fc0003,
354
355         /* PCI I/O Limit i Registers
356          * F1:0xC4 i = 0
357          * F1:0xCC i = 1
358          * F1:0xD4 i = 2
359          * F1:0xDC i = 3
360          * [ 2: 0] Destination Node ID
361          *         000 = Node 0
362          *         001 = Node 1
363          *         010 = Node 2
364          *         011 = Node 3
365          *         100 = Node 4
366          *         101 = Node 5
367          *         110 = Node 6
368          *         111 = Node 7
369          * [ 3: 3] Reserved
370          * [ 5: 4] Destination Link ID
371          *         00 = Link 0
372          *         01 = Link 1
373          *         10 = Link 2
374          *         11 = reserved
375          * [11: 6] Reserved
376          * [24:12] PCI I/O Limit Address i
377          *         This field defines the end of PCI I/O region n
378          * [31:25] Reserved
379          */
380         PCI_ADDR(0, 0x18, 1, 0xC4), 0xFE000FC8, 0x01fff000,
381         PCI_ADDR(0, 0x18, 1, 0xCC), 0xFE000FC8, 0x00000000,
382         PCI_ADDR(0, 0x18, 1, 0xD4), 0xFE000FC8, 0x00000000,
383         PCI_ADDR(0, 0x18, 1, 0xDC), 0xFE000FC8, 0x00000000,
384
385         /* PCI I/O Base i Registers
386          * F1:0xC0 i = 0
387          * F1:0xC8 i = 1
388          * F1:0xD0 i = 2
389          * F1:0xD8 i = 3
390          * [ 0: 0] Read Enable
391          *         0 = Reads Disabled
392          *         1 = Reads Enabled
393          * [ 1: 1] Write Enable
394          *         0 = Writes Disabled
395          *         1 = Writes Enabled
396          * [ 3: 2] Reserved
397          * [ 4: 4] VGA Enable
398          *         0 = VGA matches Disabled
399          *         1 = matches all address < 64K and where A[9:0] is in the 
400          *             range 3B0-3BB or 3C0-3DF independen of the base & limit registers
401          * [ 5: 5] ISA Enable
402          *         0 = ISA matches Disabled
403          *         1 = Blocks address < 64K and in the last 768 bytes of eack 1K block
404          *             from matching agains this base/limit pair
405          * [11: 6] Reserved
406          * [24:12] PCI I/O Base i
407          *         This field defines the start of PCI I/O region n 
408          * [31:25] Reserved
409          */
410         PCI_ADDR(0, 0x18, 1, 0xC0), 0xFE000FCC, 0x00000003,
411         PCI_ADDR(0, 0x18, 1, 0xC8), 0xFE000FCC, 0x00000000,
412         PCI_ADDR(0, 0x18, 1, 0xD0), 0xFE000FCC, 0x00000000,
413         PCI_ADDR(0, 0x18, 1, 0xD8), 0xFE000FCC, 0x00000000,
414
415         /* Config Base and Limit i Registers
416          * F1:0xE0 i = 0
417          * F1:0xE4 i = 1
418          * F1:0xE8 i = 2
419          * F1:0xEC i = 3
420          * [ 0: 0] Read Enable
421          *         0 = Reads Disabled
422          *         1 = Reads Enabled
423          * [ 1: 1] Write Enable
424          *         0 = Writes Disabled
425          *         1 = Writes Enabled
426          * [ 2: 2] Device Number Compare Enable
427          *         0 = The ranges are based on bus number
428          *         1 = The ranges are ranges of devices on bus 0
429          * [ 3: 3] Reserved
430          * [ 6: 4] Destination Node
431          *         000 = Node 0
432          *         001 = Node 1
433          *         010 = Node 2
434          *         011 = Node 3
435          *         100 = Node 4
436          *         101 = Node 5
437          *         110 = Node 6
438          *         111 = Node 7
439          * [ 7: 7] Reserved
440          * [ 9: 8] Destination Link
441          *         00 = Link 0
442          *         01 = Link 1
443          *         10 = Link 2
444          *         11 - Reserved
445          * [15:10] Reserved
446          * [23:16] Bus Number Base i
447          *         This field defines the lowest bus number in configuration region i
448          * [31:24] Bus Number Limit i
449          *         This field defines the highest bus number in configuration regin i
450          */
451         PCI_ADDR(0, 0x18, 1, 0xE0), 0x0000FC88, 0xff000003,
452         PCI_ADDR(0, 0x18, 1, 0xE4), 0x0000FC88, 0x00000000,
453         PCI_ADDR(0, 0x18, 1, 0xE8), 0x0000FC88, 0x00000000,
454         PCI_ADDR(0, 0x18, 1, 0xEC), 0x0000FC88, 0x00000000,
455         };
456         int max;
457         max = sizeof(register_values)/sizeof(register_values[0]);
458         setup_resource_map(register_values, max);
459 }
460
461 static void sdram_set_registers(const struct mem_controller *ctrl)
462 {
463         static const unsigned int register_values[] = {
464
465         /* Careful set limit registers before base registers which contain the enables */
466         /* DRAM Limit i Registers
467          * F1:0x44 i = 0
468          * F1:0x4C i = 1
469          * F1:0x54 i = 2
470          * F1:0x5C i = 3
471          * F1:0x64 i = 4
472          * F1:0x6C i = 5
473          * F1:0x74 i = 6
474          * F1:0x7C i = 7
475          * [ 2: 0] Destination Node ID
476          *         000 = Node 0
477          *         001 = Node 1
478          *         010 = Node 2
479          *         011 = Node 3
480          *         100 = Node 4
481          *         101 = Node 5
482          *         110 = Node 6
483          *         111 = Node 7
484          * [ 7: 3] Reserved
485          * [10: 8] Interleave select
486          *         specifies the values of A[14:12] to use with interleave enable.
487          * [15:11] Reserved
488          * [31:16] DRAM Limit Address i Bits 39-24
489          *         This field defines the upper address bits of a 40 bit  address
490          *         that define the end of the DRAM region.
491          */
492         PCI_ADDR(0, 0x18, 1, 0x44), 0x0000f8f8, 0x00000000,
493         PCI_ADDR(0, 0x18, 1, 0x4C), 0x0000f8f8, 0x00000001,
494         PCI_ADDR(0, 0x18, 1, 0x54), 0x0000f8f8, 0x00000002,
495         PCI_ADDR(0, 0x18, 1, 0x5C), 0x0000f8f8, 0x00000003,
496         PCI_ADDR(0, 0x18, 1, 0x64), 0x0000f8f8, 0x00000004,
497         PCI_ADDR(0, 0x18, 1, 0x6C), 0x0000f8f8, 0x00000005,
498         PCI_ADDR(0, 0x18, 1, 0x74), 0x0000f8f8, 0x00000006,
499         PCI_ADDR(0, 0x18, 1, 0x7C), 0x0000f8f8, 0x00000007,
500         /* DRAM Base i Registers
501          * F1:0x40 i = 0
502          * F1:0x48 i = 1
503          * F1:0x50 i = 2
504          * F1:0x58 i = 3
505          * F1:0x60 i = 4
506          * F1:0x68 i = 5
507          * F1:0x70 i = 6
508          * F1:0x78 i = 7
509          * [ 0: 0] Read Enable
510          *         0 = Reads Disabled
511          *         1 = Reads Enabled
512          * [ 1: 1] Write Enable
513          *         0 = Writes Disabled
514          *         1 = Writes Enabled
515          * [ 7: 2] Reserved
516          * [10: 8] Interleave Enable
517          *         000 = No interleave
518          *         001 = Interleave on A[12] (2 nodes)
519          *         010 = reserved
520          *         011 = Interleave on A[12] and A[14] (4 nodes)
521          *         100 = reserved
522          *         101 = reserved
523          *         110 = reserved
524          *         111 = Interleve on A[12] and A[13] and A[14] (8 nodes)
525          * [15:11] Reserved
526          * [13:16] DRAM Base Address i Bits 39-24
527          *         This field defines the upper address bits of a 40-bit address
528          *         that define the start of the DRAM region.
529          */
530         PCI_ADDR(0, 0x18, 1, 0x40), 0x0000f8fc, 0x00000000,
531         PCI_ADDR(0, 0x18, 1, 0x48), 0x0000f8fc, 0x00000000,
532         PCI_ADDR(0, 0x18, 1, 0x50), 0x0000f8fc, 0x00000000,
533         PCI_ADDR(0, 0x18, 1, 0x58), 0x0000f8fc, 0x00000000,
534         PCI_ADDR(0, 0x18, 1, 0x60), 0x0000f8fc, 0x00000000,
535         PCI_ADDR(0, 0x18, 1, 0x68), 0x0000f8fc, 0x00000000,
536         PCI_ADDR(0, 0x18, 1, 0x70), 0x0000f8fc, 0x00000000,
537         PCI_ADDR(0, 0x18, 1, 0x78), 0x0000f8fc, 0x00000000,
538
539         /* DRAM CS Base Address i Registers
540          * F2:0x40 i = 0
541          * F2:0x44 i = 1
542          * F2:0x48 i = 2
543          * F2:0x4C i = 3
544          * F2:0x50 i = 4
545          * F2:0x54 i = 5
546          * F2:0x58 i = 6
547          * F2:0x5C i = 7
548          * [ 0: 0] Chip-Select Bank Enable
549          *         0 = Bank Disabled
550          *         1 = Bank Enabled
551          * [ 8: 1] Reserved
552          * [15: 9] Base Address (19-13)
553          *         An optimization used when all DIMM are the same size...
554          * [20:16] Reserved
555          * [31:21] Base Address (35-25)
556          *         This field defines the top 11 addresses bit of a 40-bit
557          *         address that define the memory address space.  These
558          *         bits decode 32-MByte blocks of memory.
559          */
560         PCI_ADDR(0, 0x18, 2, 0x40), 0x001f01fe, 0x00000000,
561         PCI_ADDR(0, 0x18, 2, 0x44), 0x001f01fe, 0x00000000,
562         PCI_ADDR(0, 0x18, 2, 0x48), 0x001f01fe, 0x00000000,
563         PCI_ADDR(0, 0x18, 2, 0x4C), 0x001f01fe, 0x00000000,
564         PCI_ADDR(0, 0x18, 2, 0x50), 0x001f01fe, 0x00000000,
565         PCI_ADDR(0, 0x18, 2, 0x54), 0x001f01fe, 0x00000000,
566         PCI_ADDR(0, 0x18, 2, 0x58), 0x001f01fe, 0x00000000,
567         PCI_ADDR(0, 0x18, 2, 0x5C), 0x001f01fe, 0x00000000,
568         /* DRAM CS Mask Address i Registers
569          * F2:0x60 i = 0
570          * F2:0x64 i = 1
571          * F2:0x68 i = 2
572          * F2:0x6C i = 3
573          * F2:0x70 i = 4
574          * F2:0x74 i = 5
575          * F2:0x78 i = 6
576          * F2:0x7C i = 7
577          * Select bits to exclude from comparison with the DRAM Base address register.
578          * [ 8: 0] Reserved
579          * [15: 9] Address Mask (19-13)
580          *         Address to be excluded from the optimized case
581          * [20:16] Reserved
582          * [29:21] Address Mask (33-25)
583          *         The bits with an address mask of 1 are excluded from address comparison
584          * [31:30] Reserved
585          * 
586          */
587         PCI_ADDR(0, 0x18, 2, 0x60), 0xC01f01ff, 0x00000000,
588         PCI_ADDR(0, 0x18, 2, 0x64), 0xC01f01ff, 0x00000000,
589         PCI_ADDR(0, 0x18, 2, 0x68), 0xC01f01ff, 0x00000000,
590         PCI_ADDR(0, 0x18, 2, 0x6C), 0xC01f01ff, 0x00000000,
591         PCI_ADDR(0, 0x18, 2, 0x70), 0xC01f01ff, 0x00000000,
592         PCI_ADDR(0, 0x18, 2, 0x74), 0xC01f01ff, 0x00000000,
593         PCI_ADDR(0, 0x18, 2, 0x78), 0xC01f01ff, 0x00000000,
594         PCI_ADDR(0, 0x18, 2, 0x7C), 0xC01f01ff, 0x00000000,
595         /* DRAM Bank Address Mapping Register
596          * F2:0x80
597          * Specify the memory module size
598          * [ 2: 0] CS1/0 
599          * [ 6: 4] CS3/2
600          * [10: 8] CS5/4
601          * [14:12] CS7/6
602          *         000 = 32Mbyte  (Rows = 12 & Col =  8)
603          *         001 = 64Mbyte  (Rows = 12 & Col =  9)
604          *         010 = 128Mbyte (Rows = 13 & Col =  9)|(Rows = 12 & Col = 10)
605          *         011 = 256Mbyte (Rows = 13 & Col = 10)|(Rows = 12 & Col = 11)
606          *         100 = 512Mbyte (Rows = 13 & Col = 11)|(Rows = 14 & Col = 10)
607          *         101 = 1Gbyte   (Rows = 14 & Col = 11)|(Rows = 13 & Col = 12)
608          *         110 = 2Gbyte   (Rows = 14 & Col = 12)
609          *         111 = reserved 
610          * [ 3: 3] Reserved
611          * [ 7: 7] Reserved
612          * [11:11] Reserved
613          * [31:15]
614          */
615         PCI_ADDR(0, 0x18, 2, 0x80), 0xffff8888, 0x00000000,
616         /* DRAM Timing Low Register
617          * F2:0x88
618          * [ 2: 0] Tcl (Cas# Latency, Cas# to read-data-valid)
619          *         000 = reserved
620          *         001 = CL 2
621          *         010 = CL 3
622          *         011 = reserved
623          *         100 = reserved
624          *         101 = CL 2.5
625          *         110 = reserved
626          *         111 = reserved
627          * [ 3: 3] Reserved
628          * [ 7: 4] Trc (Row Cycle Time, Ras#-active to Ras#-active/bank auto refresh)
629          *         0000 =  7 bus clocks
630          *         0001 =  8 bus clocks
631          *         ...
632          *         1110 = 21 bus clocks
633          *         1111 = 22 bus clocks
634          * [11: 8] Trfc (Row refresh Cycle time, Auto-refresh-active to RAS#-active or RAS#auto-refresh)
635          *         0000 = 9 bus clocks
636          *         0010 = 10 bus clocks
637          *         ....
638          *         1110 = 23 bus clocks
639          *         1111 = 24 bus clocks
640          * [14:12] Trcd (Ras#-active to Case#-read/write Delay)
641          *         000 = reserved
642          *         001 = reserved
643          *         010 = 2 bus clocks
644          *         011 = 3 bus clocks
645          *         100 = 4 bus clocks
646          *         101 = 5 bus clocks
647          *         110 = 6 bus clocks
648          *         111 = reserved
649          * [15:15] Reserved
650          * [18:16] Trrd (Ras# to Ras# Delay)
651          *         000 = reserved
652          *         001 = reserved
653          *         010 = 2 bus clocks
654          *         011 = 3 bus clocks
655          *         100 = 4 bus clocks
656          *         101 = reserved
657          *         110 = reserved
658          *         111 = reserved
659          * [19:19] Reserved
660          * [23:20] Tras (Minmum Ras# Active Time)
661          *         0000 to 0100 = reserved
662          *         0101 = 5 bus clocks
663          *         ...
664          *         1111 = 15 bus clocks
665          * [26:24] Trp (Row Precharge Time)
666          *         000 = reserved
667          *         001 = reserved
668          *         010 = 2 bus clocks
669          *         011 = 3 bus clocks
670          *         100 = 4 bus clocks
671          *         101 = 5 bus clocks
672          *         110 = 6 bus clocks
673          *         111 = reserved
674          * [27:27] Reserved
675          * [28:28] Twr (Write Recovery Time)
676          *         0 = 2 bus clocks
677          *         1 = 3 bus clocks
678          * [31:29] Reserved
679          */
680         PCI_ADDR(0, 0x18, 2, 0x88), 0xe8088008, 0x02522001 /* 0x03623125 */ ,
681         /* DRAM Timing High Register
682          * F2:0x8C
683          * [ 0: 0] Twtr (Write to Read Delay)
684          *         0 = 1 bus Clocks
685          *         1 = 2 bus Clocks
686          * [ 3: 1] Reserved
687          * [ 6: 4] Trwt (Read to Write Delay)
688          *         000 = 1 bus clocks
689          *         001 = 2 bus clocks
690          *         010 = 3 bus clocks
691          *         011 = 4 bus clocks
692          *         100 = 5 bus clocks
693          *         101 = 6 bus clocks
694          *         110 = reserved
695          *         111 = reserved
696          * [ 7: 7] Reserved
697          * [12: 8] Tref (Refresh Rate)
698          *         00000 = 100Mhz 4K rows
699          *         00001 = 133Mhz 4K rows
700          *         00010 = 166Mhz 4K rows
701          *         00011 = 200Mhz 4K rows
702          *         01000 = 100Mhz 8K/16K rows
703          *         01001 = 133Mhz 8K/16K rows
704          *         01010 = 166Mhz 8K/16K rows
705          *         01011 = 200Mhz 8K/16K rows
706          * [19:13] Reserved
707          * [22:20] Twcl (Write CAS Latency)
708          *         000 = 1 Mem clock after CAS# (Unbuffered Dimms)
709          *         001 = 2 Mem clocks after CAS# (Registered Dimms)
710          * [31:23] Reserved
711          */
712         PCI_ADDR(0, 0x18, 2, 0x8c), 0xff8fe08e, (0 << 20)|(0 << 8)|(0 << 4)|(0 << 0),
713         /* DRAM Config Low Register
714          * F2:0x90
715          * [ 0: 0] DLL Disable
716          *         0 = Enabled
717          *         1 = Disabled
718          * [ 1: 1] D_DRV
719          *         0 = Normal Drive
720          *         1 = Weak Drive
721          * [ 2: 2] QFC_EN
722          *         0 = Disabled
723          *         1 = Enabled
724          * [ 3: 3] Disable DQS Hystersis  (FIXME handle this one carefully)
725          *         0 = Enable DQS input filter 
726          *         1 = Disable DQS input filtering 
727          * [ 7: 4] Reserved
728          * [ 8: 8] DRAM_Init
729          *         0 = Initialization done or not yet started.
730          *         1 = Initiate DRAM intialization sequence
731          * [ 9: 9] SO-Dimm Enable
732          *         0 = Do nothing
733          *         1 = SO-Dimms present
734          * [10:10] DramEnable
735          *         0 = DRAM not enabled
736          *         1 = DRAM initialized and enabled
737          * [11:11] Memory Clear Status
738          *         0 = Memory Clear function has not completed
739          *         1 = Memory Clear function has completed
740          * [12:12] Exit Self-Refresh
741          *         0 = Exit from self-refresh done or not yet started
742          *         1 = DRAM exiting from self refresh
743          * [13:13] Self-Refresh Status
744          *         0 = Normal Operation
745          *         1 = Self-refresh mode active
746          * [15:14] Read/Write Queue Bypass Count
747          *         00 = 2
748          *         01 = 4
749          *         10 = 8
750          *         11 = 16
751          * [16:16] 128-bit/64-Bit
752          *         0 = 64bit Interface to DRAM
753          *         1 = 128bit Interface to DRAM
754          * [17:17] DIMM ECC Enable
755          *         0 = Some DIMMs do not have ECC
756          *         1 = ALL DIMMS have ECC bits
757          * [18:18] UnBuffered DIMMs
758          *         0 = Buffered DIMMS
759          *         1 = Unbuffered DIMMS
760          * [19:19] Enable 32-Byte Granularity
761          *         0 = Optimize for 64byte bursts
762          *         1 = Optimize for 32byte bursts
763          * [20:20] DIMM 0 is x4
764          * [21:21] DIMM 1 is x4
765          * [22:22] DIMM 2 is x4
766          * [23:23] DIMM 3 is x4
767          *         0 = DIMM is not x4
768          *         1 = x4 DIMM present
769          * [24:24] Disable DRAM Receivers
770          *         0 = Receivers enabled
771          *         1 = Receivers disabled
772          * [27:25] Bypass Max
773          *         000 = Arbiters chois is always respected
774          *         001 = Oldest entry in DCQ can be bypassed 1 time
775          *         010 = Oldest entry in DCQ can be bypassed 2 times
776          *         011 = Oldest entry in DCQ can be bypassed 3 times
777          *         100 = Oldest entry in DCQ can be bypassed 4 times
778          *         101 = Oldest entry in DCQ can be bypassed 5 times
779          *         110 = Oldest entry in DCQ can be bypassed 6 times
780          *         111 = Oldest entry in DCQ can be bypassed 7 times
781          * [31:28] Reserved
782          */
783         PCI_ADDR(0, 0x18, 2, 0x90), 0xf0000000, 
784         (4 << 25)|(0 << 24)| 
785         (0 << 23)|(0 << 22)|(0 << 21)|(0 << 20)| 
786         (1 << 19)|(0 << 18)|(1 << 17)|(0 << 16)| 
787         (2 << 14)|(0 << 13)|(0 << 12)| 
788         (0 << 11)|(0 << 10)|(0 << 9)|(0 << 8)| 
789         (0 << 3) |(0 << 1) |(0 << 0),
790         /* DRAM Config High Register
791          * F2:0x94
792          * [ 0: 3] Maximum Asynchronous Latency
793          *         0000 = 0 ns
794          *         ...
795          *         1111 = 15 ns
796          * [ 7: 4] Reserved
797          * [11: 8] Read Preamble
798          *         0000 = 2.0 ns
799          *         0001 = 2.5 ns
800          *         0010 = 3.0 ns
801          *         0011 = 3.5 ns
802          *         0100 = 4.0 ns
803          *         0101 = 4.5 ns
804          *         0110 = 5.0 ns
805          *         0111 = 5.5 ns
806          *         1000 = 6.0 ns
807          *         1001 = 6.5 ns
808          *         1010 = 7.0 ns
809          *         1011 = 7.5 ns
810          *         1100 = 8.0 ns
811          *         1101 = 8.5 ns
812          *         1110 = 9.0 ns
813          *         1111 = 9.5 ns
814          * [15:12] Reserved
815          * [18:16] Idle Cycle Limit
816          *         000 = 0 cycles
817          *         001 = 4 cycles
818          *         010 = 8 cycles
819          *         011 = 16 cycles
820          *         100 = 32 cycles
821          *         101 = 64 cycles
822          *         110 = 128 cycles
823          *         111 = 256 cycles
824          * [19:19] Dynamic Idle Cycle Center Enable
825          *         0 = Use Idle Cycle Limit
826          *         1 = Generate a dynamic Idle cycle limit
827          * [22:20] DRAM MEMCLK Frequency
828          *         000 = 100Mhz
829          *         001 = reserved
830          *         010 = 133Mhz
831          *         011 = reserved
832          *         100 = reserved
833          *         101 = 166Mhz
834          *         110 = reserved
835          *         111 = reserved
836          * [24:23] Reserved
837          * [25:25] Memory Clock Ratio Valid (FIXME carefully enable memclk)
838          *         0 = Disable MemClks
839          *         1 = Enable MemClks
840          * [26:26] Memory Clock 0 Enable
841          *         0 = Disabled
842          *         1 = Enabled
843          * [27:27] Memory Clock 1 Enable
844          *         0 = Disabled
845          *         1 = Enabled
846          * [28:28] Memory Clock 2 Enable
847          *         0 = Disabled
848          *         1 = Enabled
849          * [29:29] Memory Clock 3 Enable
850          *         0 = Disabled
851          *         1 = Enabled
852          * [31:30] Reserved
853          */
854         PCI_ADDR(0, 0x18, 2, 0x94), 0xc180f0f0,
855         (0 << 29)|(0 << 28)|(0 << 27)|(0 << 26)|(0 << 25)|
856         (0 << 20)|(0 << 19)|(DCH_IDLE_LIMIT_16 << 16)|(0 << 8)|(0 << 0),
857         /* DRAM Delay Line Register
858          * F2:0x98
859          * Adjust the skew of the input DQS strobe relative to DATA
860          * [15: 0] Reserved
861          * [23:16] Delay Line Adjust
862          *         Adjusts the DLL derived PDL delay by one or more delay stages
863          *         in either the faster or slower direction.
864          * [24:24} Adjust Slower
865          *         0 = Do Nothing
866          *         1 = Adj is used to increase the PDL delay
867          * [25:25] Adjust Faster
868          *         0 = Do Nothing
869          *         1 = Adj is used to decrease the PDL delay
870          * [31:26] Reserved
871          */
872         PCI_ADDR(0, 0x18, 2, 0x98), 0xfc00ffff, 0x00000000,
873         /* DRAM Scrub Control Register
874          * F3:0x58
875          * [ 4: 0] DRAM Scrube Rate
876          * [ 7: 5] reserved
877          * [12: 8] L2 Scrub Rate
878          * [15:13] reserved
879          * [20:16] Dcache Scrub
880          * [31:21] reserved
881          *         Scrub Rates
882          *         00000 = Do not scrub
883          *         00001 =  40.00 ns
884          *         00010 =  80.00 ns
885          *         00011 = 160.00 ns
886          *         00100 = 320.00 ns
887          *         00101 = 640.00 ns
888          *         00110 =   1.28 us
889          *         00111 =   2.56 us
890          *         01000 =   5.12 us
891          *         01001 =  10.20 us
892          *         01011 =  41.00 us
893          *         01100 =  81.90 us
894          *         01101 = 163.80 us
895          *         01110 = 327.70 us
896          *         01111 = 655.40 us
897          *         10000 =   1.31 ms
898          *         10001 =   2.62 ms
899          *         10010 =   5.24 ms
900          *         10011 =  10.49 ms
901          *         10100 =  20.97 ms
902          *         10101 =  42.00 ms
903          *         10110 =  84.00 ms
904          *         All Others = Reserved
905          */
906         PCI_ADDR(0, 0x18, 3, 0x58), 0xffe0e0e0, 0x00000000,
907         /* DRAM Scrub Address Low Register
908          * F3:0x5C
909          * [ 0: 0] DRAM Scrubber Redirect Enable
910          *         0 = Do nothing
911          *         1 = Scrubber Corrects errors found in normal operation
912          * [ 5: 1] Reserved
913          * [31: 6] DRAM Scrub Address 31-6
914          */
915         PCI_ADDR(0, 0x18, 3, 0x5C), 0x0000003e, 0x00000000,
916         /* DRAM Scrub Address High Register
917          * F3:0x60
918          * [ 7: 0] DRAM Scrubb Address 39-32
919          * [31: 8] Reserved
920          */
921         PCI_ADDR(0, 0x18, 3, 0x60), 0xffffff00, 0x00000000,
922         };
923         int i;
924         int max;
925         print_debug("setting up CPU");
926         print_debug_hex8(ctrl->node_id);
927         print_debug(" northbridge registers\r\n");
928         max = sizeof(register_values)/sizeof(register_values[0]);
929         for(i = 0; i < max; i += 3) {
930                 device_t dev;
931                 unsigned where;
932                 unsigned long reg;
933 #if 0
934                 print_debug_hex32(register_values[i]);
935                 print_debug(" <-");
936                 print_debug_hex32(register_values[i+2]);
937                 print_debug("\r\n");
938 #endif
939                 dev = (register_values[i] & ~0xff) - PCI_DEV(0, 0x18, 0) + ctrl->f0;
940                 where = register_values[i] & 0xff;
941                 reg = pci_read_config32(dev, where);
942                 reg &= register_values[i+1];
943                 reg |= register_values[i+2];
944                 pci_write_config32(dev, where, reg);
945 #if 0
946
947                 reg = pci_read_config32(register_values[i]);
948                 reg &= register_values[i+1];
949                 reg |= register_values[i+2];
950                 pci_write_config32(register_values[i], reg);
951 #endif
952         }
953         print_debug("done.\r\n");
954 }
955
956
957 static int is_dual_channel(const struct mem_controller *ctrl)
958 {
959         uint32_t dcl;
960         dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
961         return dcl & DCL_128BitEn;
962 }
963
964 static int is_opteron(const struct mem_controller *ctrl)
965 {
966         /* Test to see if I am an Opteron.  
967          * FIXME Testing dual channel capability is correct for now
968          * but a beter test is probably required.
969          */
970         uint32_t nbcap;
971         nbcap = pci_read_config32(ctrl->f3, NORTHBRIDGE_CAP);
972         return !!(nbcap & NBCAP_128Bit);
973 }
974
975 static int is_registered(const struct mem_controller *ctrl)
976 {
977         /* Test to see if we are dealing with registered SDRAM.
978          * If we are not registered we are unbuffered.
979          * This function must be called after spd_handle_unbuffered_dimms.
980          */
981         uint32_t dcl;
982         dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
983         return !(dcl & DCL_UnBufDimm);
984 }
985
986 struct dimm_size {
987         unsigned long side1;
988         unsigned long side2;
989 };
990
991 static struct dimm_size spd_get_dimm_size(unsigned device)
992 {
993         /* Calculate the log base 2 size of a DIMM in bits */
994         struct dimm_size sz;
995         int value, low;
996         sz.side1 = 0;
997         sz.side2 = 0;
998
999         /* Note it might be easier to use byte 31 here, it has the DIMM size as
1000          * a multiple of 4MB.  The way we do it now we can size both
1001          * sides of an assymetric dimm.
1002          */
1003         value = spd_read_byte(device, 3);       /* rows */
1004         if (value < 0) goto out;
1005         sz.side1 += value & 0xf;
1006
1007         value = spd_read_byte(device, 4);       /* columns */
1008         if (value < 0) goto out;
1009         sz.side1 += value & 0xf;
1010
1011         value = spd_read_byte(device, 17);      /* banks */
1012         if (value < 0) goto out;
1013         sz.side1 += log2(value & 0xff);
1014
1015         /* Get the module data width and convert it to a power of two */
1016         value = spd_read_byte(device, 7);       /* (high byte) */
1017         if (value < 0) goto out;
1018         value &= 0xff;
1019         value <<= 8;
1020         
1021         low = spd_read_byte(device, 6); /* (low byte) */
1022         if (low < 0) goto out;
1023         value = value | (low & 0xff);
1024         sz.side1 += log2(value);
1025
1026         /* side 2 */
1027         value = spd_read_byte(device, 5);       /* number of physical banks */
1028         if (value <= 1) goto out;
1029
1030         /* Start with the symmetrical case */
1031         sz.side2 = sz.side1;
1032
1033         value = spd_read_byte(device, 3);       /* rows */
1034         if (value < 0) goto out;
1035         if ((value & 0xf0) == 0) goto out;      /* If symmetrical we are done */
1036         sz.side2 -= (value & 0x0f);             /* Subtract out rows on side 1 */
1037         sz.side2 += ((value >> 4) & 0x0f);      /* Add in rows on side 2 */
1038
1039         value = spd_read_byte(device, 4);       /* columns */
1040         if (value < 0) goto out;
1041         sz.side2 -= (value & 0x0f);             /* Subtract out columns on side 1 */
1042         sz.side2 += ((value >> 4) & 0x0f);      /* Add in columsn on side 2 */
1043
1044  out:
1045         return sz;
1046 }
1047
1048 static void set_dimm_size(const struct mem_controller *ctrl, struct dimm_size sz, unsigned index)
1049 {
1050         uint32_t base0, base1, map;
1051         uint32_t dch;
1052
1053 #if 0
1054         print_debug("set_dimm_size: (");
1055         print_debug_hex32(sz.side1);
1056         print_debug_char(',');
1057         print_debug_hex32(sz.side2);
1058         print_debug_char(',');
1059         print_debug_hex32(index);
1060         print_debug(")\r\n");
1061 #endif
1062         if (sz.side1 != sz.side2) {
1063                 sz.side2 = 0;
1064         }
1065         map = pci_read_config32(ctrl->f2, DRAM_BANK_ADDR_MAP);
1066         map &= ~(0xf << (index + 4));
1067
1068         /* For each base register.
1069          * Place the dimm size in 32 MB quantities in the bits 31 - 21.
1070          * The initialize dimm size is in bits.
1071          * Set the base enable bit0.
1072          */
1073         
1074         base0 = base1 = 0;
1075
1076         /* Make certain side1 of the dimm is at least 32MB */
1077         if (sz.side1 >= (25 +3)) {
1078                 map |= (sz.side1 - (25 + 3)) << (index *4);
1079                 base0 = (1 << ((sz.side1 - (25 + 3)) + 21)) | 1;
1080         }
1081         /* Make certain side2 of the dimm is at least 32MB */
1082         if (sz.side2 >= (25 + 3)) {
1083                 base1 = (1 << ((sz.side2 - (25 + 3)) + 21)) | 1;
1084         }
1085
1086         /* Double the size if we are using dual channel memory */
1087         if (is_dual_channel(ctrl)) {
1088                 base0 = (base0 << 1) | (base0 & 1);
1089                 base1 = (base1 << 1) | (base1 & 1);
1090         }
1091
1092         /* Clear the reserved bits */
1093         base0 &= ~0x001ffffe;
1094         base1 &= ~0x001ffffe;
1095
1096         /* Set the appropriate DIMM base address register */
1097         pci_write_config32(ctrl->f2, DRAM_CSBASE + (((index << 1)+0)<<2), base0);
1098         pci_write_config32(ctrl->f2, DRAM_CSBASE + (((index << 1)+1)<<2), base1);
1099         pci_write_config32(ctrl->f2, DRAM_BANK_ADDR_MAP, map);
1100         
1101         /* Enable the memory clocks for this DIMM */
1102         if (base0) {
1103                 dch = pci_read_config32(ctrl->f2, DRAM_CONFIG_HIGH);
1104                 dch |= DCH_MEMCLK_EN0 << index;
1105                 pci_write_config32(ctrl->f2, DRAM_CONFIG_HIGH, dch);
1106         }
1107 }
1108
1109 static void spd_set_ram_size(const struct mem_controller *ctrl)
1110 {
1111         int i;
1112         
1113         for(i = 0; (i < 4) && (ctrl->channel0[i]); i++) {
1114                 struct dimm_size sz;
1115                 sz = spd_get_dimm_size(ctrl->channel0[i]);
1116                 set_dimm_size(ctrl, sz, i);
1117         }
1118 }
1119
1120 static void route_dram_accesses(const struct mem_controller *ctrl,
1121         unsigned long base_k, unsigned long limit_k)
1122 {
1123         /* Route the addresses to the controller node */
1124         unsigned node_id;
1125         unsigned limit;
1126         unsigned base;
1127         unsigned index;
1128         unsigned limit_reg, base_reg;
1129         device_t device;
1130         node_id = ctrl->node_id;
1131         index = (node_id << 3);
1132         limit = (limit_k << 2);
1133         limit &= 0xffff0000;
1134         limit -= 0x00010000;
1135         limit |= ( 0 << 8) | (node_id << 0);
1136         base = (base_k << 2);
1137         base &= 0xffff0000;
1138         base |= (0 << 8) | (1<<1) | (1<<0);
1139
1140         limit_reg = 0x44 + index;
1141         base_reg = 0x40 + index;
1142         for(device = PCI_DEV(0, 0x18, 1); device <= PCI_DEV(0, 0x1f, 1); device += PCI_DEV(0, 1, 0)) {
1143                 pci_write_config32(device, limit_reg, limit);
1144                 pci_write_config32(device, base_reg, base);
1145         }
1146 }
1147
1148 static void set_top_mem(unsigned tom_k)
1149 {
1150         /* Error if I don't have memory */
1151         if (!tom_k) {
1152                 die("No memory");
1153         }
1154
1155 #if 1
1156         /* Report the amount of memory. */
1157         print_debug("RAM: 0x");
1158         print_debug_hex32(tom_k);
1159         print_debug(" KB\r\n");
1160 #endif
1161
1162         /* Now set top of memory */
1163         msr_t msr;
1164         msr.lo = (tom_k & 0x003fffff) << 10;
1165         msr.hi = (tom_k & 0xffc00000) >> 22;
1166         wrmsr(TOP_MEM2, msr);
1167
1168         /* Leave a 64M hole between TOP_MEM and TOP_MEM2
1169          * so I can see my rom chip and other I/O devices.
1170          */
1171         if (tom_k >= 0x003f0000) {
1172                 tom_k = 0x3f0000;
1173         }
1174         msr.lo = (tom_k & 0x003fffff) << 10;
1175         msr.hi = (tom_k & 0xffc00000) >> 22;
1176         wrmsr(TOP_MEM, msr);
1177 }
1178
1179 static void order_dimms(const struct mem_controller *ctrl)
1180 {
1181         unsigned long tom, tom_k, base_k;
1182         unsigned node_id;
1183
1184         /* Compute the memory base address address */
1185         base_k = 0;
1186         for(node_id = 0; node_id < ctrl->node_id; node_id++) {
1187                 uint32_t limit, base;
1188                 unsigned index;
1189                 index = node_id << 3;
1190                 base = pci_read_config32(ctrl->f1, 0x40 + index);
1191                 /* Only look at the limit if the base is enabled */
1192                 if ((base & 3) == 3) {
1193                         limit = pci_read_config32(ctrl->f1, 0x44 + index);
1194                         base_k = ((limit + 0x00010000) & 0xffff0000) >> 2;
1195                 }
1196         }
1197         /* Remember which registers we have used in the high 8 bits of tom */
1198         tom = base_k >> 15;
1199         for(;;) {
1200                 /* Find the largest remaining canidate */
1201                 unsigned index, canidate;
1202                 uint32_t csbase, csmask;
1203                 unsigned size;
1204                 csbase = 0;
1205                 canidate = 0;
1206                 for(index = 0; index < 8; index++) {
1207                         uint32_t value;
1208                         value = pci_read_config32(ctrl->f2, DRAM_CSBASE + (index << 2));
1209
1210                         /* Is it enabled? */
1211                         if (!(value & 1)) {
1212                                 continue;
1213                         }
1214                         
1215                         /* Is it greater? */
1216                         if (value <= csbase) {
1217                                 continue;
1218                         }
1219                         
1220                         /* Has it already been selected */
1221                         if (tom & (1 << (index + 24))) {
1222                                 continue;
1223                         }
1224                         /* I have a new canidate */
1225                         csbase = value;
1226                         canidate = index;
1227                 }
1228                 /* See if I have found a new canidate */
1229                 if (csbase == 0) {
1230                         break;
1231                 }
1232
1233                 /* Remember the dimm size */
1234                 size = csbase >> 21;
1235
1236                 /* If this is the first chip select, round base_k to
1237                  * be a multiple of it's size.  Then set tom to equal
1238                  * base_k.
1239                  * I assume that size is a power of two.
1240                  */
1241                 if ((tom & 0xff000000) == 0) {
1242                         unsigned size_k;
1243                         size_k = size << 15;
1244                         base_k = (base_k + size_k -1) & ~(size_k -1);
1245                         tom = base_k >> 15; 
1246                 }
1247
1248                 /* Remember I have used this register */
1249                 tom |= (1 << (canidate + 24));
1250
1251                 /* Recompute the cs base register value */
1252                 csbase = (tom << 21) | 1;
1253
1254                 /* Increment the top of memory */
1255                 tom += size;
1256
1257                 /* Compute the memory mask */
1258                 csmask = ((size -1) << 21);
1259                 csmask |= 0xfe00;               /* For now don't optimize */
1260 #warning "Don't forget to optimize the DIMM size"
1261
1262                 /* Write the new base register */
1263                 pci_write_config32(ctrl->f2, DRAM_CSBASE + (canidate << 2), csbase);
1264                 /* Write the new mask register */
1265                 pci_write_config32(ctrl->f2, DRAM_CSMASK + (canidate << 2), csmask);
1266                 
1267         }
1268         tom_k = (tom & ~0xff000000) << 15;
1269 #if 0
1270         print_debug("tom: ");
1271         print_debug_hex32(tom);
1272         print_debug(" base_k: ");
1273         print_debug_hex32(base_k);
1274         print_debug(" tom_k: ");
1275         print_debug_hex32(tom_k);
1276         print_debug("\r\n");
1277 #endif
1278         route_dram_accesses(ctrl, base_k, tom_k);
1279         set_top_mem(tom_k);
1280 }
1281
1282 static void disable_dimm(const struct mem_controller *ctrl, unsigned index)
1283 {
1284         print_debug("disabling dimm"); 
1285         print_debug_hex8(index); 
1286         print_debug("\r\n");
1287         pci_write_config32(ctrl->f2, DRAM_CSBASE + (((index << 1)+0)<<2), 0);
1288         pci_write_config32(ctrl->f2, DRAM_CSBASE + (((index << 1)+1)<<2), 0);
1289 }
1290
1291
1292 static void spd_handle_unbuffered_dimms(const struct mem_controller *ctrl)
1293 {
1294         int i;
1295         int registered;
1296         int unbuffered;
1297         uint32_t dcl;
1298         unbuffered = 0;
1299         registered = 0;
1300         for(i = 0; (i < 4) && (ctrl->channel0[i]); i++) {
1301                 int value;
1302                 value = spd_read_byte(ctrl->channel0[i], 21);
1303                 if (value < 0) {
1304                         disable_dimm(ctrl, i);
1305                         continue;
1306                 }
1307                 /* Registered dimm ? */
1308                 if (value & (1 << 1)) {
1309                         registered = 1;
1310                 } 
1311                 /* Otherwise it must be an unbuffered dimm */
1312                 else {
1313                         unbuffered = 1;
1314                 }
1315         }
1316         if (unbuffered && registered) {
1317                 die("Mixed buffered and registered dimms not supported");
1318         }
1319         if (unbuffered && is_opteron(ctrl)) {
1320                 die("Unbuffered Dimms not supported on Opteron");
1321         }
1322
1323         dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
1324         dcl &= ~DCL_UnBufDimm;
1325         if (unbuffered) {
1326                 dcl |= DCL_UnBufDimm;
1327         }
1328         pci_write_config32(ctrl->f2, DRAM_CONFIG_LOW, dcl);
1329 #if 0
1330         if (is_registered(ctrl)) {
1331                 print_debug("Registered\r\n");
1332         } else {
1333                 print_debug("Unbuffered\r\n");
1334         }
1335 #endif
1336 }
1337
1338 static void spd_enable_2channels(const struct mem_controller *ctrl)
1339 {
1340         int i;
1341         uint32_t nbcap;
1342         /* SPD addresses to verify are identical */
1343 #warning "FINISHME review and see if these are the bytes I need"
1344         /* FINISHME review and see if these are the bytes I need */
1345         static const unsigned addresses[] = {
1346                 2,      /* Type should be DDR SDRAM */
1347                 3,      /* *Row addresses */
1348                 4,      /* *Column addresses */
1349                 5,      /* *Physical Banks */
1350                 6,      /* *Module Data Width low */
1351                 7,      /* *Module Data Width high */
1352                 9,      /* *Cycle time at highest CAS Latency CL=X */
1353                 11,     /* *SDRAM Type */
1354                 13,     /* *SDRAM Width */
1355                 17,     /* *Logical Banks */
1356                 18,     /* *Supported CAS Latencies */
1357                 21,     /* *SDRAM Module Attributes */
1358                 23,     /* *Cycle time at CAS Latnecy (CLX - 0.5) */
1359                 26,     /* *Cycle time at CAS Latnecy (CLX - 1.0) */
1360                 27,     /* *tRP Row precharge time */
1361                 28,     /* *Minimum Row Active to Row Active Delay (tRRD) */
1362                 29,     /* *tRCD RAS to CAS */
1363                 30,     /* *tRAS Activate to Precharge */
1364                 41,     /* *Minimum Active to Active/Auto Refresh Time(Trc) */
1365                 42,     /* *Minimum Auto Refresh Command Time(Trfc) */
1366         };
1367         nbcap = pci_read_config32(ctrl->f3, NORTHBRIDGE_CAP);
1368         if (!(nbcap & NBCAP_128Bit)) {
1369                 return;
1370         }
1371         for(i = 0; (i < 4) && (ctrl->channel0[i]); i++) {
1372                 unsigned device0, device1;
1373                 int value0, value1;
1374                 int j;
1375                 device0 = ctrl->channel0[i];
1376                 device1 = ctrl->channel1[i];
1377                 if (!device1)
1378                         return;
1379                 for(j = 0; j < sizeof(addresses)/sizeof(addresses[0]); j++) {
1380                         unsigned addr;
1381                         addr = addresses[j];
1382                         value0 = spd_read_byte(device0, addr);
1383                         if (value0 < 0) {
1384                                 break;
1385                         }
1386                         value1 = spd_read_byte(device1, addr);
1387                         if (value1 < 0) {
1388                                 return;
1389                         }
1390                         if (value0 != value1) {
1391                                 return;
1392                         }
1393                 }
1394         }
1395         print_debug("Enabling dual channel memory\r\n");
1396         uint32_t dcl;
1397         dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
1398         dcl &= ~DCL_32ByteEn;
1399         dcl |= DCL_128BitEn;
1400         pci_write_config32(ctrl->f2, DRAM_CONFIG_LOW, dcl);
1401 }
1402
1403 struct mem_param {
1404         uint8_t cycle_time;
1405         uint8_t divisor; /* In 1/2 ns increments */
1406         uint8_t tRC;
1407         uint8_t tRFC;
1408         uint32_t dch_memclk;
1409         uint16_t dch_tref4k, dch_tref8k;
1410         uint8_t  dtl_twr;
1411         char name[9];
1412 };
1413
1414 static const struct mem_param *get_mem_param(unsigned min_cycle_time)
1415 {
1416         static const struct mem_param speed[] = {
1417                 {
1418                         .name       = "100Mhz\r\n",
1419                         .cycle_time = 0xa0,
1420                         .divisor    = (10 <<1),
1421                         .tRC        = 0x46,
1422                         .tRFC       = 0x50,
1423                         .dch_memclk = DCH_MEMCLK_100MHZ << DCH_MEMCLK_SHIFT,
1424                         .dch_tref4k = DTH_TREF_100MHZ_4K,
1425                         .dch_tref8k = DTH_TREF_100MHZ_8K,
1426                         .dtl_twr    = 2,
1427                 },
1428                 {
1429                         .name       = "133Mhz\r\n",
1430                         .cycle_time = 0x75,
1431                         .divisor    = (7<<1)+1,
1432                         .tRC        = 0x41,
1433                         .tRFC       = 0x4B,
1434                         .dch_memclk = DCH_MEMCLK_133MHZ << DCH_MEMCLK_SHIFT,
1435                         .dch_tref4k = DTH_TREF_133MHZ_4K,
1436                         .dch_tref8k = DTH_TREF_133MHZ_8K,
1437                         .dtl_twr    = 2,
1438                 },
1439                 {
1440                         .name       = "166Mhz\r\n",
1441                         .cycle_time = 0x60,
1442                         .divisor    = (6<<1),
1443                         .tRC        = 0x3C,
1444                         .tRFC       = 0x48,
1445                         .dch_memclk = DCH_MEMCLK_166MHZ << DCH_MEMCLK_SHIFT,
1446                         .dch_tref4k = DTH_TREF_166MHZ_4K,
1447                         .dch_tref8k = DTH_TREF_166MHZ_8K,
1448                         .dtl_twr    = 3,
1449                 },
1450                 {
1451                         .name       = "200Mhz\r\n",
1452                         .cycle_time = 0x50,
1453                         .divisor    = (5<<1),
1454                         .tRC        = 0x37,
1455                         .tRFC       = 0x46,
1456                         .dch_memclk = DCH_MEMCLK_200MHZ << DCH_MEMCLK_SHIFT,
1457                         .dch_tref4k = DTH_TREF_200MHZ_4K,
1458                         .dch_tref8k = DTH_TREF_200MHZ_8K,
1459                         .dtl_twr    = 3,
1460                 },
1461                 {
1462                         .cycle_time = 0x00,
1463                 },
1464         };
1465         const struct mem_param *param;
1466         for(param = &speed[0]; param->cycle_time ; param++) {
1467                 if (min_cycle_time > (param+1)->cycle_time) {
1468                         break;
1469                 }
1470         }
1471         if (!param->cycle_time) {
1472                 die("min_cycle_time to low");
1473         }
1474 #if 1
1475         print_debug(param->name);
1476 #endif
1477         return param;
1478 }
1479
1480 static const struct mem_param *spd_set_memclk(const struct mem_controller *ctrl)
1481 {
1482         /* Compute the minimum cycle time for these dimms */
1483         const struct mem_param *param;
1484         unsigned min_cycle_time, min_latency;
1485         int i;
1486         uint32_t value;
1487
1488         static const int latency_indicies[] = { 26, 23, 9 };
1489         static const unsigned char min_cycle_times[] = {
1490                 [NBCAP_MEMCLK_200MHZ] = 0x50, /* 5ns */
1491                 [NBCAP_MEMCLK_166MHZ] = 0x60, /* 6ns */
1492                 [NBCAP_MEMCLK_133MHZ] = 0x75, /* 7.5ns */
1493                 [NBCAP_MEMCLK_100MHZ] = 0xa0, /* 10ns */
1494         };
1495
1496
1497         value = pci_read_config32(ctrl->f3, NORTHBRIDGE_CAP);
1498         min_cycle_time = min_cycle_times[(value >> NBCAP_MEMCLK_SHIFT) & NBCAP_MEMCLK_MASK];
1499         min_latency = 2;
1500
1501 #if 0
1502         print_debug("min_cycle_time: "); 
1503         print_debug_hex8(min_cycle_time); 
1504         print_debug(" min_latency: ");
1505         print_debug_hex8(min_latency);
1506         print_debug("\r\n");
1507 #endif
1508
1509         /* Compute the least latency with the fastest clock supported
1510          * by both the memory controller and the dimms.
1511          */
1512         for(i = 0; (i < 4) && (ctrl->channel0[i]); i++) {
1513                 int new_cycle_time, new_latency;
1514                 int index;
1515                 int latencies;
1516                 int latency;
1517
1518                 /* First find the supported CAS latencies
1519                  * Byte 18 for DDR SDRAM is interpreted:
1520                  * bit 0 == CAS Latency = 1.0
1521                  * bit 1 == CAS Latency = 1.5
1522                  * bit 2 == CAS Latency = 2.0
1523                  * bit 3 == CAS Latency = 2.5
1524                  * bit 4 == CAS Latency = 3.0
1525                  * bit 5 == CAS Latency = 3.5
1526                  * bit 6 == TBD
1527                  * bit 7 == TBD
1528                  */
1529                 new_cycle_time = 0xa0;
1530                 new_latency = 5;
1531
1532                 latencies = spd_read_byte(ctrl->channel0[i], 18);
1533                 if (latencies <= 0) continue;
1534
1535                 /* Compute the lowest cas latency supported */
1536                 latency = log2(latencies) -2;
1537
1538                 /* Loop through and find a fast clock with a low latency */
1539                 for(index = 0; index < 3; index++, latency++) {
1540                         int value;
1541                         if ((latency < 2) || (latency > 4) ||
1542                                 (!(latencies & (1 << latency)))) {
1543                                 continue;
1544                         }
1545                         value = spd_read_byte(ctrl->channel0[i], latency_indicies[index]);
1546                         if (value < 0) {
1547                                 continue;
1548                         }
1549
1550                         /* Only increase the latency if we decreas the clock */
1551                         if ((value >= min_cycle_time) && (value < new_cycle_time)) {
1552                                 new_cycle_time = value;
1553                                 new_latency = latency;
1554                         }
1555                 }
1556                 if (new_latency > 4){
1557                         continue;
1558                 }
1559                 /* Does min_latency need to be increased? */
1560                 if (new_cycle_time > min_cycle_time) {
1561                         min_cycle_time = new_cycle_time;
1562                 }
1563                 /* Does min_cycle_time need to be increased? */
1564                 if (new_latency > min_latency) {
1565                         min_latency = new_latency;
1566                 }
1567 #if 0
1568                 print_debug("i: ");
1569                 print_debug_hex8(i);
1570                 print_debug(" min_cycle_time: "); 
1571                 print_debug_hex8(min_cycle_time); 
1572                 print_debug(" min_latency: ");
1573                 print_debug_hex8(min_latency);
1574                 print_debug("\r\n");
1575 #endif
1576         }
1577         /* Make a second pass through the dimms and disable
1578          * any that cannot support the selected memclk and cas latency.
1579          */
1580         
1581         for(i = 0; (i < 4) && (ctrl->channel0[i]); i++) {
1582                 int latencies;
1583                 int latency;
1584                 int index;
1585                 int value;
1586                 int dimm;
1587                 latencies = spd_read_byte(ctrl->channel0[i], 18);
1588                 if (latencies <= 0) {
1589                         goto dimm_err;
1590                 }
1591
1592                 /* Compute the lowest cas latency supported */
1593                 latency = log2(latencies) -2;
1594
1595                 /* Walk through searching for the selected latency */
1596                 for(index = 0; index < 3; index++, latency++) {
1597                         if (!(latencies & (1 << latency))) {
1598                                 continue;
1599                         }
1600                         if (latency == min_latency)
1601                                 break;
1602                 }
1603                 /* If I can't find the latency or my index is bad error */
1604                 if ((latency != min_latency) || (index >= 3)) {
1605                         goto dimm_err;
1606                 }
1607                 
1608                 /* Read the min_cycle_time for this latency */
1609                 value = spd_read_byte(ctrl->channel0[i], latency_indicies[index]);
1610                 
1611                 /* All is good if the selected clock speed 
1612                  * is what I need or slower.
1613                  */
1614                 if (value <= min_cycle_time) {
1615                         continue;
1616                 }
1617                 /* Otherwise I have an error, disable the dimm */
1618         dimm_err:
1619                 disable_dimm(ctrl, i);
1620         }
1621 #if 0
1622         print_debug("min_cycle_time: "); 
1623         print_debug_hex8(min_cycle_time); 
1624         print_debug(" min_latency: ");
1625         print_debug_hex8(min_latency);
1626         print_debug("\r\n");
1627 #endif
1628         /* Now that I know the minimum cycle time lookup the memory parameters */
1629         param = get_mem_param(min_cycle_time);
1630
1631         /* Update DRAM Config High with our selected memory speed */
1632         value = pci_read_config32(ctrl->f2, DRAM_CONFIG_HIGH);
1633         value &= ~(DCH_MEMCLK_MASK << DCH_MEMCLK_SHIFT);
1634         value |= param->dch_memclk;
1635         pci_write_config32(ctrl->f2, DRAM_CONFIG_HIGH, value);
1636
1637         static const unsigned latencies[] = { DTL_CL_2, DTL_CL_2_5, DTL_CL_3 };
1638         /* Update DRAM Timing Low with our selected cas latency */
1639         value = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1640         value &= ~(DTL_TCL_MASK << DTL_TCL_SHIFT);
1641         value |= latencies[min_latency - 2] << DTL_TCL_SHIFT;
1642         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, value);
1643         
1644         return param;
1645 }
1646
1647
1648 static int update_dimm_Trc(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1649 {
1650         unsigned clocks, old_clocks;
1651         uint32_t dtl;
1652         int value;
1653         value = spd_read_byte(ctrl->channel0[i], 41);
1654         if (value < 0) return -1;
1655         if ((value == 0) || (value == 0xff)) {
1656                 value = param->tRC;
1657         }
1658         clocks = ((value << 1) + param->divisor - 1)/param->divisor;
1659         if (clocks < DTL_TRC_MIN) {
1660                 clocks = DTL_TRC_MIN;
1661         }
1662         if (clocks > DTL_TRC_MAX) {
1663                 return -1;
1664         }
1665
1666         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1667         old_clocks = ((dtl >> DTL_TRC_SHIFT) & DTL_TRC_MASK) + DTL_TRC_BASE;
1668         if (old_clocks > clocks) {
1669                 clocks = old_clocks;
1670         }
1671         dtl &= ~(DTL_TRC_MASK << DTL_TRC_SHIFT);
1672         dtl |=  ((clocks - DTL_TRC_BASE) << DTL_TRC_SHIFT);
1673         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1674         return 0;
1675 }
1676
1677 static int update_dimm_Trfc(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1678 {
1679         unsigned clocks, old_clocks;
1680         uint32_t dtl;
1681         int value;
1682         value = spd_read_byte(ctrl->channel0[i], 42);
1683         if (value < 0) return -1;
1684         if ((value == 0) || (value == 0xff)) {
1685                 value = param->tRFC;
1686         }
1687         clocks = ((value << 1) + param->divisor - 1)/param->divisor;
1688         if (clocks < DTL_TRFC_MIN) {
1689                 clocks = DTL_TRFC_MIN;
1690         }
1691         if (clocks > DTL_TRFC_MAX) {
1692                 return -1;
1693         }
1694         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1695         old_clocks = ((dtl >> DTL_TRFC_SHIFT) & DTL_TRFC_MASK) + DTL_TRFC_BASE;
1696         if (old_clocks > clocks) {
1697                 clocks = old_clocks;
1698         }
1699         dtl &= ~(DTL_TRFC_MASK << DTL_TRFC_SHIFT);
1700         dtl |= ((clocks - DTL_TRFC_BASE) << DTL_TRFC_SHIFT);
1701         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1702         return 0;
1703 }
1704
1705
1706 static int update_dimm_Trcd(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1707 {
1708         unsigned clocks, old_clocks;
1709         uint32_t dtl;
1710         int value;
1711         value = spd_read_byte(ctrl->channel0[i], 29);
1712         if (value < 0) return -1;
1713 #if 0
1714         clocks = (value + (param->divisor << 1) -1)/(param->divisor << 1);
1715 #else
1716         clocks = (value + ((param->divisor & 0xff) << 1) -1)/((param->divisor & 0xff) << 1);
1717 #endif
1718         if (clocks < DTL_TRCD_MIN) {
1719                 clocks = DTL_TRCD_MIN;
1720         }
1721         if (clocks > DTL_TRCD_MAX) {
1722                 return -1;
1723         }
1724         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1725         old_clocks = ((dtl >> DTL_TRCD_SHIFT) & DTL_TRCD_MASK) + DTL_TRCD_BASE;
1726         if (old_clocks > clocks) {
1727                 clocks = old_clocks;
1728         }
1729         dtl &= ~(DTL_TRCD_MASK << DTL_TRCD_SHIFT);
1730         dtl |= ((clocks - DTL_TRCD_BASE) << DTL_TRCD_SHIFT);
1731         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1732         return 0;
1733 }
1734
1735 static int update_dimm_Trrd(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1736 {
1737         unsigned clocks, old_clocks;
1738         uint32_t dtl;
1739         int value;
1740         value = spd_read_byte(ctrl->channel0[i], 28);
1741         if (value < 0) return -1;
1742         clocks = (value + ((param->divisor & 0xff) << 1) -1)/((param->divisor & 0xff) << 1);
1743         if (clocks < DTL_TRRD_MIN) {
1744                 clocks = DTL_TRRD_MIN;
1745         }
1746         if (clocks > DTL_TRRD_MAX) {
1747                 return -1;
1748         }
1749         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1750         old_clocks = ((dtl >> DTL_TRRD_SHIFT) & DTL_TRRD_MASK) + DTL_TRRD_BASE;
1751         if (old_clocks > clocks) {
1752                 clocks = old_clocks;
1753         }
1754         dtl &= ~(DTL_TRRD_MASK << DTL_TRRD_SHIFT);
1755         dtl |= ((clocks - DTL_TRRD_BASE) << DTL_TRRD_SHIFT);
1756         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1757         return 0;
1758 }
1759
1760 static int update_dimm_Tras(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1761 {
1762         unsigned clocks, old_clocks;
1763         uint32_t dtl;
1764         int value;
1765         value = spd_read_byte(ctrl->channel0[i], 30);
1766         if (value < 0) return -1;
1767         clocks = ((value << 1) + param->divisor - 1)/param->divisor;
1768         if (clocks < DTL_TRAS_MIN) {
1769                 clocks = DTL_TRAS_MIN;
1770         }
1771         if (clocks > DTL_TRAS_MAX) {
1772                 return -1;
1773         }
1774         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1775         old_clocks = ((dtl >> DTL_TRAS_SHIFT) & DTL_TRAS_MASK) + DTL_TRAS_BASE;
1776         if (old_clocks > clocks) {
1777                 clocks = old_clocks;
1778         }
1779         dtl &= ~(DTL_TRAS_MASK << DTL_TRAS_SHIFT);
1780         dtl |= ((clocks - DTL_TRAS_BASE) << DTL_TRAS_SHIFT);
1781         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1782         return 0;
1783 }
1784
1785 static int update_dimm_Trp(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1786 {
1787         unsigned clocks, old_clocks;
1788         uint32_t dtl;
1789         int value;
1790         value = spd_read_byte(ctrl->channel0[i], 27);
1791         if (value < 0) return -1;
1792 #if 0
1793         clocks = (value + (param->divisor << 1) - 1)/(param->divisor << 1);
1794 #else
1795         clocks = (value + ((param->divisor & 0xff) << 1) - 1)/((param->divisor & 0xff) << 1);
1796 #endif
1797 #if 0
1798         print_debug("Trp: ");
1799         print_debug_hex8(clocks);
1800         print_debug(" spd value: ");
1801         print_debug_hex8(value);
1802         print_debug(" divisor: ");
1803         print_debug_hex8(param->divisor);
1804         print_debug("\r\n");
1805 #endif
1806         if (clocks < DTL_TRP_MIN) {
1807                 clocks = DTL_TRP_MIN;
1808         }
1809         if (clocks > DTL_TRP_MAX) {
1810                 return -1;
1811         }
1812         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1813         old_clocks = ((dtl >> DTL_TRP_SHIFT) & DTL_TRP_MASK) + DTL_TRP_BASE;
1814         if (old_clocks > clocks) {
1815                 clocks = old_clocks;
1816         }
1817         dtl &= ~(DTL_TRP_MASK << DTL_TRP_SHIFT);
1818         dtl |= ((clocks - DTL_TRP_BASE) << DTL_TRP_SHIFT);
1819         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1820         return 0;
1821 }
1822
1823 static void set_Twr(const struct mem_controller *ctrl, const struct mem_param *param)
1824 {
1825         uint32_t dtl;
1826         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1827         dtl &= ~(DTL_TWR_MASK << DTL_TWR_SHIFT);
1828         dtl |= (param->dtl_twr - DTL_TWR_BASE) << DTL_TWR_SHIFT;
1829         pci_write_config32(ctrl->f2, DRAM_TIMING_LOW, dtl);
1830 }
1831
1832
1833 static void init_Tref(const struct mem_controller *ctrl, const struct mem_param *param)
1834 {
1835         uint32_t dth;
1836         dth = pci_read_config32(ctrl->f2, DRAM_TIMING_HIGH);
1837         dth &= ~(DTH_TREF_MASK << DTH_TREF_SHIFT);
1838         dth |= (param->dch_tref4k << DTH_TREF_SHIFT);
1839         pci_write_config32(ctrl->f2, DRAM_TIMING_HIGH, dth);
1840 }
1841
1842 static int update_dimm_Tref(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1843 {
1844         uint32_t dth;
1845         int value;
1846         unsigned tref, old_tref;
1847         value = spd_read_byte(ctrl->channel0[i], 3);
1848         if (value < 0) return -1;
1849         value &= 0xf;
1850
1851         tref = param->dch_tref8k;
1852         if (value == 12) {
1853                 tref = param->dch_tref4k;
1854         }
1855
1856         dth = pci_read_config32(ctrl->f2, DRAM_TIMING_HIGH);
1857         old_tref = (dth >> DTH_TREF_SHIFT) & DTH_TREF_MASK;
1858         if ((value == 12) && (old_tref == param->dch_tref4k)) {
1859                 tref = param->dch_tref4k;
1860         } else {
1861                 tref = param->dch_tref8k;
1862         }
1863         dth &= ~(DTH_TREF_MASK << DTH_TREF_SHIFT);
1864         dth |= (tref << DTH_TREF_SHIFT);
1865         pci_write_config32(ctrl->f2, DRAM_TIMING_HIGH, dth);
1866         return 0;
1867 }
1868
1869
1870 static int update_dimm_x4(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1871 {
1872         uint32_t dcl;
1873         int value;
1874         int dimm;
1875         value = spd_read_byte(ctrl->channel0[i], 13);
1876         if (value < 0) {
1877                 return -1;
1878         }
1879         dimm = i;
1880         dimm += DCL_x4DIMM_SHIFT;
1881         dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
1882         dcl &= ~(1 << dimm);
1883         if (value == 4) {
1884                 dcl |= (1 << dimm);
1885         }
1886         pci_write_config32(ctrl->f2, DRAM_CONFIG_LOW, dcl);
1887         return 0;
1888 }
1889
1890 static int update_dimm_ecc(const struct mem_controller *ctrl, const struct mem_param *param, int i)
1891 {
1892         uint32_t dcl;
1893         int value;
1894         value = spd_read_byte(ctrl->channel0[i], 11);
1895         if (value < 0) {
1896                 return -1;
1897         }
1898         if (value != 2) {
1899                 dcl = pci_read_config32(ctrl->f2, DRAM_CONFIG_LOW);
1900                 dcl &= ~DCL_DimmEccEn;
1901                 pci_write_config32(ctrl->f2, DRAM_CONFIG_LOW, dcl);
1902         }
1903         return 0;
1904 }
1905
1906 static int count_dimms(const struct mem_controller *ctrl)
1907 {
1908         int dimms;
1909         unsigned index;
1910         dimms = 0;
1911         for(index = 0; index < 8; index += 2) {
1912                 uint32_t csbase;
1913                 csbase = pci_read_config32(ctrl->f2, (DRAM_CSBASE + index << 2));
1914                 if (csbase & 1) {
1915                         dimms += 1;
1916                 }
1917         }
1918         return dimms;
1919 }
1920
1921 static void set_Twtr(const struct mem_controller *ctrl, const struct mem_param *param)
1922 {
1923         uint32_t dth;
1924         unsigned clocks;
1925         clocks = 1; /* AMD says hard code this */
1926         dth = pci_read_config32(ctrl->f2, DRAM_TIMING_HIGH);
1927         dth &= ~(DTH_TWTR_MASK << DTH_TWTR_SHIFT);
1928         dth |= ((clocks - DTH_TWTR_BASE) << DTH_TWTR_SHIFT);
1929         pci_write_config32(ctrl->f2, DRAM_TIMING_HIGH, dth);
1930 }
1931
1932 static void set_Trwt(const struct mem_controller *ctrl, const struct mem_param *param)
1933 {
1934         uint32_t dth, dtl;
1935         unsigned divisor;
1936         unsigned latency;
1937         unsigned clocks;
1938
1939         clocks = 0;
1940         dtl = pci_read_config32(ctrl->f2, DRAM_TIMING_LOW);
1941         latency = (dtl >> DTL_TCL_SHIFT) & DTL_TCL_MASK;
1942         divisor = param->divisor;
1943
1944         if (is_opteron(ctrl)) {
1945                 if (latency == DTL_CL_2) {
1946                         if (divisor == ((6 << 0) + 0)) {
1947                                 /* 166Mhz */
1948                                 clocks = 3;
1949                         }
1950                         else if (divisor > ((6 << 0)+0)) {
1951                                 /* 100Mhz && 133Mhz */
1952                                 clocks = 2;
1953                         }
1954                 }
1955                 else if (latency == DTL_CL_2_5) {
1956                         clocks = 3;
1957                 }
1958                 else if (latency == DTL_CL_3) {
1959                         if (divisor == ((6 << 0)+0)) {
1960                                 /* 166Mhz */
1961                                 clocks = 4;
1962                         }
1963                         else if (divisor > ((6 << 0)+0)) {
1964                                 /* 100Mhz && 133Mhz */
1965                                 clocks = 3;
1966                         }
1967                 }
1968         }
1969         else /* Athlon64 */ {
1970                 if (is_registered(ctrl)) {
1971                         if (latency == DTL_CL_2) {
1972                                 clocks = 2;
1973                         }
1974                         else if (latency == DTL_CL_2_5) {
1975                                 clocks = 3;
1976                         }
1977                         else if (latency == DTL_CL_3) {
1978                                 clocks = 3;
1979                         }
1980                 }
1981                 else /* Unbuffered */{
1982                         if (latency == DTL_CL_2) {
1983                                 clocks = 3;
1984                         }
1985                         else if (latency == DTL_CL_2_5) {
1986                                 clocks = 4;
1987                         }
1988                         else if (latency == DTL_CL_3) {
1989                                 clocks = 4;
1990                         }
1991                 }
1992         }
1993         if ((clocks < DTH_TRWT_MIN) || (clocks > DTH_TRWT_MAX)) {
1994                 die("Unknown Trwt");
1995         }
1996         
1997         dth = pci_read_config32(ctrl->f2, DRAM_TIMING_HIGH);
1998         dth &= ~(DTH_TRWT_MASK << DTH_TRWT_SHIFT);
1999         dth |= ((clocks - DTH_TRWT_BASE) << DTH_TRWT_SHIFT);
2000         pci_write_config32(ctrl->f2, DRAM_TIMING_HIGH, dth);
2001         return;
2002 }
2003
2004 static void set_Twcl(const struct mem_controller *ctrl, const struct mem_param *param)
2005 {
2006         /* Memory Clocks after CAS# */
2007         uint32_t dth;
2008         unsigned clocks;
2009         if (is_registered(ctrl)) {
2010                 clocks = 2;
2011         } else {
2012                 clocks = 1;
2013         }
2014         dth = pci_read_config32(ctrl->f2, DRAM_TIMING_HIGH);
2015         dth &= ~(DTH_TWCL_MASK << DTH_TWCL_SHIFT);
2016         dth |= ((clocks - DTH_TWCL_BASE) << DTH_TWCL_SHIFT);
2017         pci_write_config32(ctrl->f2, DRAM_TIMING_HIGH, dth);
2018 }
2019
2020
2021 static void set_read_preamble(const struct mem_controller *ctrl, const struct mem_param *param)
2022 {
2023         uint32_t dch;
2024         unsigned divisor;
2025         unsigned rdpreamble;
2026         divisor = param->divisor;
2027         dch = pci_read_config32(ctrl->f2, DRAM_CONFIG_HIGH);
2028         dch &= ~(DCH_RDPREAMBLE_MASK << DCH_RDPREAMBLE_SHIFT);
2029         rdpreamble = 0;
2030         if (is_registered(ctrl)) {
2031                 if (divisor == ((10 << 1)+0)) {
2032                         /* 100Mhz, 9ns */
2033                         rdpreamble = ((9 << 1)+ 0);
2034                 }
2035                 else if (divisor == ((7 << 1)+1)) {
2036                         /* 133Mhz, 8ns */
2037                         rdpreamble = ((8 << 1)+0);
2038                 }
2039                 else if (divisor == ((6 << 1)+0)) {
2040                         /* 166Mhz, 7.5ns */
2041                         rdpreamble = ((7 << 1)+1);
2042                 }
2043         }
2044         else {
2045                 int slots;
2046                 int i;
2047                 slots = 0;
2048                 for(i = 0; i < 4; i++) {
2049                         if (ctrl->channel0[i]) {
2050                                 slots += 1;
2051                         }
2052                 }
2053                 if (divisor == ((10 << 1)+0)) {
2054                         /* 100Mhz */
2055                         if (slots <= 2) {
2056                                 /* 9ns */
2057                                 rdpreamble = ((9 << 1)+0);
2058                         } else {
2059                                 /* 14ns */
2060                                 rdpreamble = ((14 << 1)+0);
2061                         }
2062                 }
2063                 else if (divisor == ((7 << 1)+1)) {
2064                         /* 133Mhz */
2065                         if (slots <= 2) {
2066                                 /* 7ns */
2067                                 rdpreamble = ((7 << 1)+0);
2068                         } else {
2069                                 /* 11 ns */
2070                                 rdpreamble = ((11 << 1)+0);
2071                         }
2072                 }
2073                 else if (divisor == ((6 << 1)+0)) {
2074                         /* 166Mhz */
2075                         if (slots <= 2) {
2076                                 /* 6ns */
2077                                 rdpreamble = ((7 << 1)+0);
2078                         } else {
2079                                 /* 9ns */
2080                                 rdpreamble = ((9 << 1)+0);
2081                         }
2082                 }
2083                 else if (divisor == ((5 << 1)+0)) {
2084                         /* 200Mhz */
2085                         if (slots <= 2) {
2086                                 /* 5ns */
2087                                 rdpreamble = ((5 << 1)+0);
2088                         } else {
2089                                 /* 7ns */
2090                                 rdpreamble = ((7 << 1)+0);
2091                         }
2092                 }
2093         }
2094         if ((rdpreamble < DCH_RDPREAMBLE_MIN) || (rdpreamble > DCH_RDPREAMBLE_MAX)) {
2095                 die("Unknown rdpreamble");
2096         }
2097         dch |= (rdpreamble - DCH_RDPREAMBLE_BASE) << DCH_RDPREAMBLE_SHIFT;
2098         pci_write_config32(ctrl->f2, DRAM_CONFIG_HIGH, dch);
2099 }
2100
2101 static void set_max_async_latency(const struct mem_controller *ctrl, const struct mem_param *param)
2102 {
2103         uint32_t dch;
2104         int i;
2105         unsigned async_lat;
2106         int dimms;
2107
2108         dimms = count_dimms(ctrl);
2109
2110         dch = pci_read_config32(ctrl->f2, DRAM_CONFIG_HIGH);
2111         dch &= ~(DCH_ASYNC_LAT_MASK << DCH_ASYNC_LAT_SHIFT);
2112         async_lat = 0;
2113         if (is_registered(ctrl)) {
2114                 if (dimms == 4) {
2115                         /* 9ns */
2116                         async_lat = 9;
2117                 } 
2118                 else {
2119                         /* 8ns */
2120                         async_lat = 8;
2121                 }
2122         }
2123         else {
2124                 if (dimms > 3) {
2125                         die("Too many unbuffered dimms");
2126                 }
2127                 else if (dimms == 3) {
2128                         /* 7ns */
2129                         async_lat = 7;
2130                 }
2131                 else {
2132                         /* 6ns */
2133                         async_lat = 6;
2134                 }
2135         }
2136         dch |= ((async_lat - DCH_ASYNC_LAT_BASE) << DCH_ASYNC_LAT_SHIFT);
2137         pci_write_config32(ctrl->f2, DRAM_CONFIG_HIGH, dch);
2138 }
2139
2140 static void set_idle_cycle_limit(const struct mem_controller *ctrl, const struct mem_param *param)
2141 {
2142         uint32_t dch;
2143         /* AMD says to Hardcode this */
2144         dch = pci_read_config32(ctrl->f2, DRAM_CONFIG_HIGH);
2145         dch &= ~(DCH_IDLE_LIMIT_MASK << DCH_IDLE_LIMIT_SHIFT);
2146         dch |= DCH_IDLE_LIMIT_16 << DCH_IDLE_LIMIT_SHIFT;
2147         dch |= DCH_DYN_IDLE_CTR_EN;
2148         pci_write_config32(ctrl->f2, DRAM_CONFIG_HIGH, dch);
2149 }
2150
2151 static void spd_set_dram_timing(const struct mem_controller *ctrl, const struct mem_param *param)
2152 {
2153         int dimms;
2154         int i;
2155         init_Tref(ctrl, param);
2156         for(i = 0; (i < 4) && ctrl->channel0[i]; i++) {
2157                 int rc;
2158                 /* DRAM Timing Low Register */
2159                 if (update_dimm_Trc (ctrl, param, i) < 0) goto dimm_err;
2160                 if (update_dimm_Trfc(ctrl, param, i) < 0) goto dimm_err;
2161                 if (update_dimm_Trcd(ctrl, param, i) < 0) goto dimm_err;
2162                 if (update_dimm_Trrd(ctrl, param, i) < 0) goto dimm_err;
2163                 if (update_dimm_Tras(ctrl, param, i) < 0) goto dimm_err;
2164                 if (update_dimm_Trp (ctrl, param, i) < 0) goto dimm_err;
2165
2166                 /* DRAM Timing High Register */
2167                 if (update_dimm_Tref(ctrl, param, i) < 0) goto dimm_err;
2168
2169                 /* DRAM Config Low */
2170                 if (update_dimm_x4 (ctrl, param, i) < 0) goto dimm_err;
2171                 if (update_dimm_ecc(ctrl, param, i) < 0) goto dimm_err;
2172                 continue;
2173         dimm_err:
2174                 disable_dimm(ctrl, i);
2175                 
2176         }
2177         /* DRAM Timing Low Register */
2178         set_Twr(ctrl, param);
2179
2180         /* DRAM Timing High Register */
2181         set_Twtr(ctrl, param);
2182         set_Trwt(ctrl, param);
2183         set_Twcl(ctrl, param);
2184
2185         /* DRAM Config High */
2186         set_read_preamble(ctrl, param);
2187         set_max_async_latency(ctrl, param);
2188         set_idle_cycle_limit(ctrl, param);
2189 }
2190
2191 static void sdram_set_spd_registers(const struct mem_controller *ctrl) 
2192 {
2193         const struct mem_param *param;
2194         spd_enable_2channels(ctrl);
2195         spd_set_ram_size(ctrl);
2196         spd_handle_unbuffered_dimms(ctrl);
2197         param = spd_set_memclk(ctrl);
2198         spd_set_dram_timing(ctrl, param);
2199         order_dimms(ctrl);
2200 }
2201
2202 #define TIMEOUT_LOOPS 300000
2203 static void sdram_enable(int controllers, const struct mem_controller *ctrl)
2204 {
2205         int i;
2206
2207         /* Before enabling memory start the memory clocks */
2208         for(i = 0; i < controllers; i++) {
2209                 uint32_t dch;
2210                 dch = pci_read_config32(ctrl[i].f2, DRAM_CONFIG_HIGH);
2211                 dch |= DCH_MEMCLK_VALID;
2212                 pci_write_config32(ctrl[i].f2, DRAM_CONFIG_HIGH, dch);
2213         }
2214
2215         /* And if necessary toggle the the reset on the dimms by hand */
2216         memreset(controllers, ctrl);
2217
2218         for(i = 0; i < controllers; i++) {
2219                 uint32_t dcl;
2220                 /* Toggle DisDqsHys to get it working */
2221                 dcl = pci_read_config32(ctrl[i].f2, DRAM_CONFIG_LOW);
2222 #if 0
2223                 print_debug("dcl: ");
2224                 print_debug_hex32(dcl);
2225                 print_debug("\r\n");
2226 #endif
2227 #if 1
2228                 dcl &= ~DCL_DimmEccEn;
2229 #endif          
2230 #warning "FIXME set the ECC type to perform"
2231 #warning "FIXME initialize the scrub registers"
2232 #if 0
2233                 if (dcl & DCL_DimmEccEn) {
2234                         print_debug("ECC enabled\r\n");
2235                 }
2236 #endif
2237                 dcl |= DCL_DisDqsHys;
2238                 pci_write_config32(ctrl[i].f2, DRAM_CONFIG_LOW, dcl);
2239                 dcl &= ~DCL_DisDqsHys;
2240                 dcl &= ~DCL_DLL_Disable;
2241                 dcl &= ~DCL_D_DRV;
2242                 dcl &= ~DCL_QFC_EN;
2243                 dcl |= DCL_DramInit;
2244                 pci_write_config32(ctrl[i].f2, DRAM_CONFIG_LOW, dcl);
2245
2246         }
2247         for(i = 0; i < controllers; i++) {
2248                 uint32_t dcl;
2249                 print_debug("Initializing memory: ");
2250                 int loops = 0;
2251                 do {
2252                         dcl = pci_read_config32(ctrl[i].f2, DRAM_CONFIG_LOW);
2253                         loops += 1;
2254                         if ((loops & 1023) == 0) {
2255                                 print_debug(".");
2256                         }
2257                 } while(((dcl & DCL_DramInit) != 0) && (loops < TIMEOUT_LOOPS));
2258                 if (loops >= TIMEOUT_LOOPS) {
2259                         print_debug(" failed\r\n");
2260                 } else {
2261                         print_debug(" done\r\n");
2262                 }
2263 #if 0
2264                 if (dcl & DCL_DimmEccEn) {
2265                         print_debug("Clearing memory: ");
2266                         loops = 0;
2267                         dcl &= ~DCL_MemClrStatus;
2268                         pci_write_config32(ctrl[i].f2, DRAM_CONFIG_LOW, dcl);
2269                         
2270                         do {
2271                                 dcl = pci_read_config32(ctrl[i].f2, DRAM_CONFIG_LOW);
2272                                 loops += 1;
2273                                 if ((loops & 1023) == 0) {
2274                                         print_debug(" ");
2275                                         print_debug_hex32(loops);
2276                                 }
2277                         } while(((dcl & DCL_MemClrStatus) == 0) && (loops < TIMEOUT_LOOPS));
2278                         if (loops >= TIMEOUT_LOOPS) {
2279                                 print_debug("failed\r\n");
2280                         } else {
2281                                 print_debug("done\r\n");
2282                         }
2283                         pci_write_config32(ctrl[i].f3, SCRUB_ADDR_LOW, 0);
2284                         pci_write_config32(ctrl[i].f3, SCRUB_ADDR_HIGH, 0);
2285                 }
2286 #endif
2287         }
2288 }