Chameleon

Chameleon Svn Source Tree

Root/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))
313Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
314else
315Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
316}
317
318// Get im965 Memory Timings
319static void get_timings_im965(pci_dt_t *dram_dev)
320{
321// Thanks for CDH optis
322uint32_t dev0, c0ckectrl, c1ckectrl, offset, ODT_Control_Register, Precharge_Register;
323long *ptr;
324
325// Read MMR Base Address
326dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
327dev0 &= 0xFFFFC000;
328
329ptr = (long*)(dev0 + 0x1200);
330c0ckectrl = *ptr & 0xFFFFFFFF;
331
332ptr = (long*)(dev0 + 0x1300);
333c1ckectrl = *ptr & 0xFFFFFFFF;
334
335// If DIMM 0 not populated, check DIMM 1
336((c0ckectrl) >> 20 & 0xF) ? (offset = 0) : (offset = 0x100);
337
338ptr = (long*)(dev0 + offset + 0x121C);
339ODT_Control_Register = *ptr & 0xFFFFFFFF;
340
341ptr = (long*)(dev0 + offset + 0x1214);
342Precharge_Register = *ptr & 0xFFFFFFFF;
343
344// Series only support DDR2
345Platform.RAM.Type = SMB_MEM_TYPE_DDR2;
346
347// CAS Latency (tCAS)
348Platform.RAM.CAS = ((ODT_Control_Register >> 23) & 7) + 3;
349
350// RAS-To-CAS (tRCD)
351Platform.RAM.TRC = ((Precharge_Register >> 5) & 7) + 2;
352
353// RAS Precharge (tRP)
354Platform.RAM.TRP= (Precharge_Register & 7) + 2;
355
356// RAS Active to precharge (tRAS)
357Platform.RAM.RAS = (Precharge_Register >> 21) & 0x1F;
358
359if ((c0ckectrl >> 20 & 0xF) && (c1ckectrl >> 20 & 0xF))
360Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
361else
362Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
363}
364
365// Get P35 Memory Timings
366static void get_timings_p35(pci_dt_t *dram_dev)
367{
368// Thanks for CDH optis
369unsigned long dev0, Memory_Check, c0ckectrl, c1ckectrl, offset;
370unsigned long ODT_Control_Register, Precharge_Register, ACT_Register, Read_Register, Misc_Register;
371long *ptr;
372
373//Device_ID = pci_config_read16(dram_dev->dev.addr, 0x02);
374//Device_ID &= 0xFFFF;
375
376// Now, read MMR Base Address
377dev0 = pci_config_read32(dram_dev->dev.addr, 0x48);
378dev0 &= 0xFFFFC000;
379
380ptr = (long*)(dev0 + 0x260);
381c0ckectrl = *ptr & 0xFFFFFFFF;
382
383ptr = (long*)(dev0 + 0x660);
384c1ckectrl = *ptr & 0xFFFFFFFF;
385
386// If DIMM 0 not populated, check DIMM 1
387((c0ckectrl) >> 20 & 0xF) ? (offset = 0) : (offset = 0x400);
388
389ptr = (long*)(dev0 + offset + 0x265);
390ODT_Control_Register = *ptr & 0xFFFFFFFF;
391
392ptr = (long*)(dev0 + offset + 0x25D);
393Precharge_Register = *ptr & 0xFFFFFFFF;
394
395ptr = (long*)(dev0 + offset + 0x252);
396ACT_Register = *ptr & 0xFFFFFFFF;
397
398ptr = (long*)(dev0 + offset + 0x258);
399Read_Register = *ptr & 0xFFFFFFFF;
400
401ptr = (long*)(dev0 + offset + 0x244);
402Misc_Register = *ptr & 0xFFFFFFFF;
403
404ptr = (long*)(dev0 + offset + 0x1E8);
405Memory_Check = *ptr & 0xFFFFFFFF;
406
407// On P45, check 1A8
408if(dram_dev->device_id > 0x2E00) {
409ptr = (long*)(dev0 + offset + 0x1A8);
410Memory_Check = *ptr & 0xFFFFFFFF;
411Memory_Check >>= 2;
412Memory_Check &= 1;
413Memory_Check = !Memory_Check;
414} else {
415ptr = (long*)(dev0 + offset + 0x1E8);
416Memory_Check = *ptr & 0xFFFFFFFF;
417}
418
419// Determine DDR-II or DDR-III
420if (Memory_Check & 1)
421Platform.RAM.Type = SMB_MEM_TYPE_DDR2;
422else
423Platform.RAM.Type = SMB_MEM_TYPE_DDR3;
424
425// CAS Latency (tCAS)
426if(dram_dev->device_id > 0x2E00)
427Platform.RAM.CAS = ((ODT_Control_Register >> 8) & 0x3F) - 6;
428else
429Platform.RAM.CAS = ((ODT_Control_Register >> 8) & 0x3F) - 9;
430
431// RAS-To-CAS (tRCD)
432Platform.RAM.TRC = (Read_Register >> 17) & 0xF;
433
434// RAS Precharge (tRP)
435Platform.RAM.TRP = (ACT_Register >> 13) & 0xF;
436
437// RAS Active to precharge (tRAS)
438Platform.RAM.RAS = Precharge_Register & 0x3F;
439
440// Channel configuration
441if (((c0ckectrl >> 20) & 0xF) && ((c1ckectrl >> 20) & 0xF))
442Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
443else
444Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
445}
446
447// Get Nehalem Memory Timings
448static void get_timings_nhm(pci_dt_t *dram_dev)
449{
450unsigned long mc_channel_bank_timing, mc_control, mc_channel_mrs_value;
451int fvc_bn = 4;
452
453// Find which channels are populated
454mc_control = pci_config_read16(PCIADDR(nhm_bus, 3, 0), 0x48);
455mc_control = (mc_control >> 8) & 0x7;
456
457// DDR-III
458Platform.RAM.Type = SMB_MEM_TYPE_DDR3;
459
460// Get the first valid channel
461if(mc_control & 1)
462fvc_bn = 4;
463else if(mc_control & 2)
464fvc_bn = 5;
465else if(mc_control & 7)
466fvc_bn = 6;
467
468// Now, detect timings
469mc_channel_bank_timing = pci_config_read32(PCIADDR(nhm_bus, fvc_bn, 0), 0x88);
470mc_channel_mrs_value = pci_config_read32(PCIADDR(nhm_bus, fvc_bn, 0), 0x70);
471
472// CAS Latency (tCAS)
473Platform.RAM.CAS = ((mc_channel_mrs_value >> 4) & 0xF ) + 4;
474
475// RAS-To-CAS (tRCD)
476Platform.RAM.TRC = (mc_channel_bank_timing >> 9) & 0xF;
477
478// RAS Active to precharge (tRAS)
479Platform.RAM.RAS = (mc_channel_bank_timing >> 4) & 0x1F;
480
481// RAS Precharge (tRP)
482Platform.RAM.TRP = mc_channel_bank_timing & 0xF;
483
484// Single , Dual or Triple Channels
485if (mc_control == 1 || mc_control == 2 || mc_control == 4 )
486Platform.RAM.Channels = SMB_MEM_CHANNEL_SINGLE;
487else if (mc_control == 7)
488Platform.RAM.Channels = SMB_MEM_CHANNEL_TRIPLE;
489else
490Platform.RAM.Channels = SMB_MEM_CHANNEL_DUAL;
491}
492
493static struct mem_controller_t dram_controllers[] = {
494
495// Default unknown chipset
496{ 0, 0, "",NULL, NULL, NULL },
497
498// Intel
499{ 0x8086, 0x7190, "VMWare",NULL, NULL, NULL },
500
501{ 0x8086, 0x1A30, "i845",NULL, NULL, NULL },
502
503{ 0x8086, 0x2970, "i946PL/GZ",setup_p35, get_fsb_i965,get_timings_i965},
504{ 0x8086, 0x2990, "Q963/Q965",setup_p35, get_fsb_i965,get_timings_i965},
505{ 0x8086, 0x29A0, "P965/G965",setup_p35, get_fsb_i965,get_timings_i965},
506
507{ 0x8086, 0x2A00, "GM965/GL960",setup_p35, get_fsb_im965,get_timings_im965},
508{ 0x8086, 0x2A10, "GME965/GLE960",setup_p35, get_fsb_im965,get_timings_im965},
509{ 0x8086, 0x2A40, "PM/GM45/47",setup_p35, get_fsb_im965,get_timings_im965},
510
511{ 0x8086, 0x29B0, "Q35",setup_p35, get_fsb_i965,get_timings_p35},
512{ 0x8086, 0x29C0, "P35/G33",setup_p35, get_fsb_i965,get_timings_p35},
513{ 0x8086, 0x29D0, "Q33",setup_p35, get_fsb_i965,get_timings_p35},
514{ 0x8086, 0x29E0, "X38/X48",setup_p35, get_fsb_i965,get_timings_p35},
515{ 0x8086, 0x2E00, "Eaglelake",setup_p35, get_fsb_i965,get_timings_p35},
516{ 0x8086, 0x2E10, "Q45/Q43",setup_p35, get_fsb_i965,get_timings_p35},
517{ 0x8086, 0x2E20, "P45/G45",setup_p35, get_fsb_i965,get_timings_p35},
518{ 0x8086, 0x2E30, "G41",setup_p35, get_fsb_i965,get_timings_p35},
519
520{ 0x8086, 0xD131, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
521{ 0x8086, 0xD132, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
522{ 0x8086, 0x3400, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
523{ 0x8086, 0x3401, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
524{ 0x8086, 0x3402, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
525{ 0x8086, 0x3403, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
526{ 0x8086, 0x3404, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
527{ 0x8086, 0x3405, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
528{ 0x8086, 0x3406, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
529{ 0x8086, 0x3407, "NHM IMC",setup_nhm, get_fsb_nhm,get_timings_nhm},
530};
531
532static const char *memory_channel_types[] =
533{
534"Unknown", "Single", "Dual", "Triple"
535};
536
537void scan_dram_controller(pci_dt_t *dram_dev)
538{
539int i;
540for(i = 1; i < sizeof(dram_controllers) / sizeof(dram_controllers[0]); i++)
541if ((dram_controllers[i].vendor == dram_dev->vendor_id)
542&& (dram_controllers[i].device == dram_dev->device_id))
543{
544verbose("%s%s DRAM Controller [%4x:%4x] at %02x:%02x.%x\n",
545(dram_dev->vendor_id == 0x8086) ? "Intel " : "" ,
546dram_controllers[i].name, dram_dev->vendor_id, dram_dev->device_id,
547dram_dev->dev.bits.bus, dram_dev->dev.bits.dev, dram_dev->dev.bits.func);
548
549if (dram_controllers[i].initialise != NULL)
550dram_controllers[i].initialise(dram_dev);
551
552if (dram_controllers[i].poll_timings != NULL)
553dram_controllers[i].poll_timings(dram_dev);
554
555if (dram_controllers[i].poll_speed != NULL)
556dram_controllers[i].poll_speed(dram_dev);
557
558verbose("Frequency detected: %d MHz (%d) %s Channel \n\tCAS:%d tRC:%d tRP:%d RAS:%d (%d-%d-%d-%d)\n",
559(uint32_t)Platform.RAM.Frequency / 1000000,
560(uint32_t)Platform.RAM.Frequency / 500000,
561memory_channel_types[Platform.RAM.Channels]
562,Platform.RAM.CAS, Platform.RAM.TRC, Platform.RAM.TRP, Platform.RAM.RAS
563,Platform.RAM.CAS, Platform.RAM.TRC, Platform.RAM.TRP, Platform.RAM.RAS
564);
565//getchar();
566}
567}
568

Archive Download this file

Revision: 2253