Chameleon

Chameleon Svn Source Tree

Root/branches/ErmaC/Trunk/i386/libsaio/dram_controllers.c

1/*
2 * dram controller access and scan from the pci host controller
3 * Integrated and adapted for chameleon 2.0 RC5 by Rekursor from bs0d work
4 * original source comes from:
5 *
6 * memtest86
7 *
8 * Released under version 2 of the Gnu Public License.
9 * By Chris Brady, cbrady@sgi.com
10 * ----------------------------------------------------
11 * MemTest86+ V4.00 Specific code (GPL V2.0)
12 * By Samuel DEMEULEMEESTER, sdemeule@memtest.org
13 * http://www.canardpc.com - http://www.memtest.org
14 */
15
16#include "libsaio.h"
17#include "bootstruct.h"
18#include "pci.h"
19#include "platform.h"
20#include "dram_controllers.h"
21
22#ifndef DEBUG_DRAM
23#define DEBUG_DRAM 0
24#endif
25
26#if DEBUG_DRAM
27#define DBG(x...) printf(x)
28#else
29#define DBG(x...)
30#endif
31
32/*
33 * Initialise memory controller functions
34 */
35
36// Setup P35 Memory Controller
37static void setup_p35(pci_dt_t *dram_dev)
38{
39uint32_t dev0;
40
41// Activate MMR I/O
42dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
43if (!(dev0 & 0x1))
44{
45pci_config_write8(dram_dev->dev.addr, 0x48, (dev0 | 1));
46}
47}
48
49int nhm_bus = 0x3F;
50
51// Setup Nehalem Integrated Memory Controller
52static void setup_nhm(pci_dt_t *dram_dev)
53{
54static long possible_nhm_bus[] = {0xFF, 0x7F, 0x3F};
55unsigned long did, vid;
56int i;
57
58// Nehalem supports Scrubbing
59// First, locate the PCI bus where the MCH is located
60for(i = 0; i < sizeof(possible_nhm_bus); i++)
61{
62vid = pci_config_read16(PCIADDR(possible_nhm_bus[i], 3, 4), PCI_VENDOR_ID);
63did = pci_config_read16(PCIADDR(possible_nhm_bus[i], 3, 4), PCI_DEVICE_ID);
64vid &= 0xFFFF;
65did &= 0xFF00;
66
67if(vid == 0x8086 && did >= 0x2C00)
68{
69nhm_bus = possible_nhm_bus[i];
70}
71}
72}
73
74/*
75 * Retrieve memory controller fsb functions
76 */
77
78
79// Get i965 Memory Speed
80static void get_fsb_i965(pci_dt_t *dram_dev)
81{
82uint32_t dev0, mch_ratio, mch_cfg, mch_fsb;
83
84long *ptr;
85
86// Find Ratio
87dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
88dev0 &= 0xFFFFC000;
89ptr = (long*)(dev0 + 0xC00);
90mch_cfg = *ptr & 0xFFFF;
91
92mch_ratio = 100000;
93
94switch (mch_cfg & 7)
95{
96case 0: mch_fsb = 1066; break;
97case 1: mch_fsb = 533; break;
98default:
99case 2: mch_fsb = 800; break;
100case 3: mch_fsb = 667; break;
101case 4: mch_fsb = 1333; break;
102case 6: mch_fsb = 1600; break;
103}
104
105DBG("mch_fsb %d\n", mch_fsb);
106
107switch (mch_fsb)
108{
109case 533:
110switch ((mch_cfg >> 4) & 7)
111{
112case 1:mch_ratio = 200000; break;
113case 2:mch_ratio = 250000; break;
114case 3:mch_ratio = 300000; break;
115}
116break;
117
118default:
119case 800:
120switch ((mch_cfg >> 4) & 7)
121{
122case 0:mch_ratio = 100000; break;
123case 1:mch_ratio = 125000; break;
124case 2:mch_ratio = 166667; break; // 1.666666667
125case 3:mch_ratio = 200000; break;
126case 4:mch_ratio = 266667; break; // 2.666666667
127case 5:mch_ratio = 333333; break; // 3.333333333
128}
129break;
130
131case 1066:
132switch ((mch_cfg >> 4) & 7)
133{
134case 1:mch_ratio = 100000; break;
135case 2:mch_ratio = 125000; break;
136case 3:mch_ratio = 150000; break;
137case 4:mch_ratio = 200000; break;
138case 5:mch_ratio = 250000; break;
139}
140break;
141
142case 1333:
143switch ((mch_cfg >> 4) & 7)
144{
145case 2:mch_ratio = 100000; break;
146case 3:mch_ratio = 120000; break;
147case 4:mch_ratio = 160000; break;
148case 5:mch_ratio = 200000; break;
149}
150break;
151
152case 1600:
153switch ((mch_cfg >> 4) & 7)
154{
155case 3:mch_ratio = 100000; break;
156case 4:mch_ratio = 133333; break; // 1.333333333
157case 5:mch_ratio = 150000; break;
158case 6:mch_ratio = 200000; break;
159}
160break;
161}
162
163DBG("mch_ratio %d\n", mch_ratio);
164
165// Compute RAM Frequency
166Platform.RAM.Frequency = (Platform.CPU.FSBFrequency * mch_ratio) / 100000;
167
168DBG("ram_fsb %d\n", Platform.RAM.Frequency);
169
170}
171
172// Get i965m Memory Speed
173static void get_fsb_im965(pci_dt_t *dram_dev)
174{
175uint32_t dev0, mch_ratio, mch_cfg, mch_fsb;
176
177long *ptr;
178
179// Find Ratio
180dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
181dev0 &= 0xFFFFC000;
182ptr = (long*)(dev0 + 0xC00);
183mch_cfg = *ptr & 0xFFFF;
184
185mch_ratio = 100000;
186
187switch (mch_cfg & 7)
188{
189case 1: mch_fsb = 533; break;
190default:
191case 2:mch_fsb = 800; break;
192case 3:mch_fsb = 667; break;
193case 6:mch_fsb = 1066; break;
194}
195
196switch (mch_fsb)
197{
198case 533:
199switch ((mch_cfg >> 4) & 7)
200{
201case 1:mch_ratio = 125000; break;
202case 2:mch_ratio = 150000; break;
203case 3:mch_ratio = 200000; break;
204}
205break;
206
207case 667:
208switch ((mch_cfg >> 4)& 7)
209{
210case 1:mch_ratio = 100000; break;
211case 2:mch_ratio = 120000; break;
212case 3:mch_ratio = 160000; break;
213case 4:mch_ratio = 200000; break;
214case 5:mch_ratio = 240000; break;
215}
216break;
217
218default:
219case 800:
220switch ((mch_cfg >> 4) & 7)
221{
222case 1:mch_ratio = 83333; break; // 0.833333333
223case 2:mch_ratio = 100000; break;
224case 3:mch_ratio = 133333; break; // 1.333333333
225case 4:mch_ratio = 166667; break; // 1.666666667
226case 5:mch_ratio = 200000; break;
227}
228break;
229case 1066:
230switch ((mch_cfg >> 4)&7)
231{
232case 5:mch_ratio = 150000; break;
233case 6:mch_ratio = 200000; break;
234}
235
236}
237
238// Compute RAM Frequency
239Platform.RAM.Frequency = (Platform.CPU.FSBFrequency * mch_ratio) / 100000;
240}
241
242
243// Get iCore7 Memory Speed
244static void get_fsb_nhm(pci_dt_t *dram_dev)
245{
246uint32_t mch_ratio, mc_dimm_clk_ratio;
247
248// Get the clock ratio
249mc_dimm_clk_ratio = pci_config_read16(PCIADDR(nhm_bus, 3, 4), 0x54 );
250mch_ratio = (mc_dimm_clk_ratio & 0x1F);
251
252// Compute RAM Frequency
253Platform.RAM.Frequency = Platform.CPU.FSBFrequency * mch_ratio / 2;
254}
255
256/*
257 * Retrieve memory controller info functions
258 */
259
260// Get i965 Memory Timings
261static void get_timings_i965(pci_dt_t *dram_dev)
262{
263// Thanks for CDH optis
264uint32_t dev0, c0ckectrl, c1ckectrl, offset;
265uint32_t ODT_Control_Register, Precharge_Register, ACT_Register, Read_Register, Misc_Register;
266
267long *ptr;
268
269// Read MMR Base Address
270dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
271dev0 &= 0xFFFFC000;
272
273ptr = (long*)(dev0 + 0x260);
274c0ckectrl = *ptr & 0xFFFFFFFF;
275
276ptr = (long*)(dev0 + 0x660);
277c1ckectrl = *ptr & 0xFFFFFFFF;
278
279// If DIMM 0 not populated, check DIMM 1
280((c0ckectrl) >> 20 & 0xF) ? (offset = 0) : (offset = 0x400);
281
282ptr = (long*)(dev0 + offset + 0x29C);
283ODT_Control_Register = *ptr & 0xFFFFFFFF;
284
285ptr = (long*)(dev0 + offset + 0x250);
286Precharge_Register = *ptr & 0xFFFFFFFF;
287
288ptr = (long*)(dev0 + offset + 0x252);
289ACT_Register = *ptr & 0xFFFFFFFF;
290
291ptr = (long*)(dev0 + offset + 0x258);
292Read_Register = *ptr & 0xFFFFFFFF;
293
294ptr = (long*)(dev0 + offset + 0x244);
295Misc_Register = *ptr & 0xFFFFFFFF;
296
297// 965 Series only support DDR2
298Platform.RAM.Type = SMB_MEM_TYPE_DDR2;
299
300// CAS Latency (tCAS)
301Platform.RAM.CAS = ((ODT_Control_Register >> 17) & 7) + 3;
302
303// RAS-To-CAS (tRCD)
304Platform.RAM.TRC = (Read_Register >> 16) & 0xF;
305
306// RAS Precharge (tRP)
307Platform.RAM.TRP = (ACT_Register >> 13) & 0xF;
308
309// RAS Active to precharge (tRAS)
310Platform.RAM.RAS = (Precharge_Register >> 11) & 0x1F;
311
312if ((c0ckectrl >> 20 & 0xF) && (c1ckectrl >> 20 & 0xF))
313{
314Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
315}
316else
317{
318Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
319}
320}
321
322// Get im965 Memory Timings
323static void get_timings_im965(pci_dt_t *dram_dev)
324{
325// Thanks for CDH optis
326uint32_t dev0, c0ckectrl, c1ckectrl, offset, ODT_Control_Register, Precharge_Register;
327long *ptr;
328
329// Read MMR Base Address
330dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
331dev0 &= 0xFFFFC000;
332
333ptr = (long*)(dev0 + 0x1200);
334c0ckectrl = *ptr & 0xFFFFFFFF;
335
336ptr = (long*)(dev0 + 0x1300);
337c1ckectrl = *ptr & 0xFFFFFFFF;
338
339// If DIMM 0 not populated, check DIMM 1
340((c0ckectrl) >> 20 & 0xF) ? (offset = 0) : (offset = 0x100);
341
342ptr = (long*)(dev0 + offset + 0x121C);
343ODT_Control_Register = *ptr & 0xFFFFFFFF;
344
345ptr = (long*)(dev0 + offset + 0x1214);
346Precharge_Register = *ptr & 0xFFFFFFFF;
347
348// Series only support DDR2
349Platform.RAM.Type = SMB_MEM_TYPE_DDR2;
350
351// CAS Latency (tCAS)
352Platform.RAM.CAS = ((ODT_Control_Register >> 23) & 7) + 3;
353
354// RAS-To-CAS (tRCD)
355Platform.RAM.TRC = ((Precharge_Register >> 5) & 7) + 2;
356
357// RAS Precharge (tRP)
358Platform.RAM.TRP= (Precharge_Register & 7) + 2;
359
360// RAS Active to precharge (tRAS)
361Platform.RAM.RAS = (Precharge_Register >> 21) & 0x1F;
362
363if ((c0ckectrl >> 20 & 0xF) && (c1ckectrl >> 20 & 0xF))
364{
365Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
366}
367else
368{
369Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
370}
371}
372
373// Get P35 Memory Timings
374static void get_timings_p35(pci_dt_t *dram_dev)
375{
376// Thanks for CDH optis
377unsigned long dev0, Memory_Check, c0ckectrl, c1ckectrl, offset;
378unsigned long ODT_Control_Register, Precharge_Register, ACT_Register, Read_Register, Misc_Register;
379long *ptr;
380
381//Device_ID = pci_config_read16(dram_dev->dev.addr, 0x02);
382//Device_ID &= 0xFFFF;
383
384// Now, read MMR Base Address
385dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
386dev0 &= 0xFFFFC000;
387
388ptr = (long*)(dev0 + 0x260);
389c0ckectrl = *ptr & 0xFFFFFFFF;
390
391ptr = (long*)(dev0 + 0x660);
392c1ckectrl = *ptr & 0xFFFFFFFF;
393
394// If DIMM 0 not populated, check DIMM 1
395((c0ckectrl) >> 20 & 0xF) ? (offset = 0) : (offset = 0x400);
396
397ptr = (long*)(dev0 + offset + 0x265);
398ODT_Control_Register = *ptr & 0xFFFFFFFF;
399
400ptr = (long*)(dev0 + offset + 0x25D);
401Precharge_Register = *ptr & 0xFFFFFFFF;
402
403ptr = (long*)(dev0 + offset + 0x252);
404ACT_Register = *ptr & 0xFFFFFFFF;
405
406ptr = (long*)(dev0 + offset + 0x258);
407Read_Register = *ptr & 0xFFFFFFFF;
408
409ptr = (long*)(dev0 + offset + 0x244);
410Misc_Register = *ptr & 0xFFFFFFFF;
411
412ptr = (long*)(dev0 + offset + 0x1E8);
413Memory_Check = *ptr & 0xFFFFFFFF;
414
415// On P45, check 1A8
416if(dram_dev->device_id > 0x2E00)
417{
418ptr = (long*)(dev0 + offset + 0x1A8);
419Memory_Check = *ptr & 0xFFFFFFFF;
420Memory_Check >>= 2;
421Memory_Check &= 1;
422Memory_Check = !Memory_Check;
423}
424else
425{
426ptr = (long*)(dev0 + offset + 0x1E8);
427Memory_Check = *ptr & 0xFFFFFFFF;
428}
429
430// Determine DDR-II or DDR-III
431if (Memory_Check & 1)
432{
433Platform.RAM.Type = SMB_MEM_TYPE_DDR2;
434}
435else
436{
437Platform.RAM.Type = SMB_MEM_TYPE_DDR3;
438}
439
440// CAS Latency (tCAS)
441if(dram_dev->device_id > 0x2E00)
442{
443Platform.RAM.CAS = ((ODT_Control_Register >> 8) & 0x3F) - 6;
444}
445else
446{
447Platform.RAM.CAS = ((ODT_Control_Register >> 8) & 0x3F) - 9;
448}
449
450// RAS-To-CAS (tRCD)
451Platform.RAM.TRC = (Read_Register >> 17) & 0xF;
452
453// RAS Precharge (tRP)
454Platform.RAM.TRP = (ACT_Register >> 13) & 0xF;
455
456// RAS Active to precharge (tRAS)
457Platform.RAM.RAS = Precharge_Register & 0x3F;
458
459// Channel configuration
460if (((c0ckectrl >> 20) & 0xF) && ((c1ckectrl >> 20) & 0xF))
461{
462Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
463}
464else
465{
466Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
467}
468}
469
470// Get Nehalem Memory Timings
471static void get_timings_nhm(pci_dt_t *dram_dev)
472{
473unsigned long mc_channel_bank_timing, mc_control, mc_channel_mrs_value;
474int fvc_bn = 4;
475
476// Find which channels are populated
477mc_control = pci_config_read16(PCIADDR(nhm_bus, 3, 0), 0x48);
478mc_control = (mc_control >> 8) & 0x7;
479
480// DDR-III
481Platform.RAM.Type = SMB_MEM_TYPE_DDR3;
482
483// Get the first valid channel
484if(mc_control & 1)
485{
486fvc_bn = 4;
487}
488else if(mc_control & 2)
489{
490fvc_bn = 5;
491}
492else if(mc_control & 7)
493{
494fvc_bn = 6;
495}
496
497// Now, detect timings
498mc_channel_bank_timing = pci_config_read32(PCIADDR(nhm_bus, fvc_bn, 0), 0x88);
499mc_channel_mrs_value = pci_config_read32(PCIADDR(nhm_bus, fvc_bn, 0), 0x70);
500
501// CAS Latency (tCAS)
502Platform.RAM.CAS = ((mc_channel_mrs_value >> 4) & 0xF ) + 4;
503
504// RAS-To-CAS (tRCD)
505Platform.RAM.TRC = (mc_channel_bank_timing >> 9) & 0xF;
506
507// RAS Active to precharge (tRAS)
508Platform.RAM.RAS = (mc_channel_bank_timing >> 4) & 0x1F;
509
510// RAS Precharge (tRP)
511Platform.RAM.TRP = mc_channel_bank_timing & 0xF;
512
513// Single , Dual or Triple Channels
514if (mc_control == 1 || mc_control == 2 || mc_control == 4 )
515{
516Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
517}
518else if (mc_control == 7)
519{
520Platform.RAM.Channels = SMB_MEM_CHANNEL_TRIPLE;
521}
522else
523{
524Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
525}
526}
527
528static struct mem_controller_t dram_controllers[] = {
529
530// Default unknown chipset
531{ 0, 0, "",NULL, NULL, NULL },
532
533// Intel
534{ 0x8086, 0x7190, "VMWare",NULL, NULL, NULL },
535
536{ 0x8086, 0x1A30, "i845",NULL, NULL, NULL },
537
538{ 0x8086, 0x2970, "i946PL/GZ",setup_p35, get_fsb_i965,get_timings_i965},
539{ 0x8086, 0x2990, "Q963/Q965",setup_p35, get_fsb_i965,get_timings_i965},
540{ 0x8086, 0x29A0, "P965/G965",setup_p35, get_fsb_i965,get_timings_i965},
541
542{ 0x8086, 0x2A00, "GM965/GL960",setup_p35, get_fsb_im965,get_timings_im965},
543{ 0x8086, 0x2A10, "GME965/GLE960",setup_p35, get_fsb_im965,get_timings_im965},
544{ 0x8086, 0x2A40, "PM/GM45/47",setup_p35, get_fsb_im965,get_timings_im965},
545
546{ 0x8086, 0x29B0, "Q35",setup_p35, get_fsb_i965,get_timings_p35},
547{ 0x8086, 0x29C0, "P35/G33",setup_p35, get_fsb_i965,get_timings_p35},
548{ 0x8086, 0x29D0, "Q33",setup_p35, get_fsb_i965,get_timings_p35},
549{ 0x8086, 0x29E0, "X38/X48",setup_p35, get_fsb_i965,get_timings_p35},
550{ 0x8086, 0x2E00, "Eaglelake",setup_p35, get_fsb_i965,get_timings_p35},
551{ 0x8086, 0x2E10, "Q45/Q43",setup_p35, get_fsb_i965,get_timings_p35},
552{ 0x8086, 0x2E20, "P45/G45",setup_p35, get_fsb_i965,get_timings_p35},
553{ 0x8086, 0x2E30, "G41",setup_p35, get_fsb_i965,get_timings_p35},
554
555{ 0x8086, 0xD131, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
556{ 0x8086, 0xD132, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
557{ 0x8086, 0x3400, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
558{ 0x8086, 0x3401, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
559{ 0x8086, 0x3402, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
560{ 0x8086, 0x3403, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
561{ 0x8086, 0x3404, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
562{ 0x8086, 0x3405, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
563{ 0x8086, 0x3406, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
564{ 0x8086, 0x3407, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
565
566};
567
568static const char *memory_channel_types[] =
569{
570"Unknown", "Single", "Dual", "Triple"
571};
572
573void scan_dram_controller(pci_dt_t *dram_dev)
574{
575int i;
576for(i = 1; i < sizeof(dram_controllers) / sizeof(dram_controllers[0]); i++)
577{
578if ((dram_controllers[i].vendor == dram_dev->vendor_id) && (dram_controllers[i].device == dram_dev->device_id))
579{
580verbose("%s%s DRAM Controller [%4x:%4x] at %02x:%02x.%x\n",
581(dram_dev->vendor_id == 0x8086) ? "Intel " : "" ,
582dram_controllers[i].name, dram_dev->vendor_id, dram_dev->device_id,
583dram_dev->dev.bits.bus, dram_dev->dev.bits.dev, dram_dev->dev.bits.func);
584
585if (dram_controllers[i].initialise != NULL)
586{
587dram_controllers[i].initialise(dram_dev);
588}
589
590if (dram_controllers[i].poll_timings != NULL)
591{
592dram_controllers[i].poll_timings(dram_dev);
593}
594
595if (dram_controllers[i].poll_speed != NULL)
596{
597dram_controllers[i].poll_speed(dram_dev);
598}
599
600verbose("Frequency detected: %d MHz (%d) %s Channel \n\tCAS:%d tRC:%d tRP:%d RAS:%d (%d-%d-%d-%d)\n",
601(uint32_t)Platform.RAM.Frequency / 1000000,
602(uint32_t)Platform.RAM.Frequency / 500000,
603memory_channel_types[Platform.RAM.Channels],
604Platform.RAM.CAS, Platform.RAM.TRC, Platform.RAM.TRP, Platform.RAM.RAS,
605Platform.RAM.CAS, Platform.RAM.TRC, Platform.RAM.TRP, Platform.RAM.RAS);
606//getchar();
607}
608}
609}
610

Archive Download this file

Revision: 2045