Chameleon

Chameleon Svn Source Tree

Root/branches/valv/i386/libsaio/cpu.c

  • Property svn:executable set to
1/*
2 * Copyright 2008 Islam Ahmed Zaid. All rights reserved. <azismed@gmail.com>
3 * AsereBLN: 2009: cleanup and bugfix
4 * valv: 2010: fine-tuning and additions
5 */
6
7#include "libsaio.h"
8#include "platform.h"
9#include "cpu.h"
10#include "boot.h"
11#include "bootstruct.h"
12
13#ifndef DEBUG_CPU
14#define DEBUG_CPU 0
15#endif
16
17#if DEBUG_CPU
18#define DBG(x...)printf(x)
19#else
20#define DBG(x...)msglog(x)
21#endif
22
23/*
24 * DFE: Measures the TSC frequency in Hz (64-bit) using the ACPI PM timer
25 */
26static uint64_t measure_tsc_frequency(void)
27{
28 uint64_t tscStart;
29 uint64_t tscEnd;
30 uint64_t tscDelta = 0xffffffffffffffffULL;
31 unsigned long pollCount;
32 uint64_t retval = 0;
33 int i;
34
35 /* Time how many TSC ticks elapse in 30 msec using the 8254 PIT
36 * counter 2. We run this loop 3 times to make sure the cache
37 * is hot and we take the minimum delta from all of the runs.
38 * That is to say that we're biased towards measuring the minimum
39 * number of TSC ticks that occur while waiting for the timer to
40 * expire. That theoretically helps avoid inconsistencies when
41 * running under a VM if the TSC is not virtualized and the host
42 * steals time. The TSC is normally virtualized for VMware.
43 */
44 for(i = 0; i < 10; ++i)
45 {
46 enable_PIT2();
47 set_PIT2_mode0(CALIBRATE_LATCH);
48 tscStart = rdtsc64();
49 pollCount = poll_PIT2_gate();
50 tscEnd = rdtsc64();
51 /* The poll loop must have run at least a few times for accuracy */
52 if(pollCount <= 1)
53 continue;
54 /* The TSC must increment at LEAST once every millisecond. We
55 * should have waited exactly 30 msec so the TSC delta should
56 * be >= 30. Anything less and the processor is way too slow.
57 */
58 if((tscEnd - tscStart) <= CALIBRATE_TIME_MSEC)
59 continue;
60 // tscDelta = min(tscDelta, (tscEnd - tscStart))
61 if( (tscEnd - tscStart) < tscDelta )
62 tscDelta = tscEnd - tscStart;
63 }
64 /* tscDelta is now the least number of TSC ticks the processor made in
65 * a timespan of 0.03 s (e.g. 30 milliseconds)
66 * Linux thus divides by 30 which gives the answer in kiloHertz because
67 * 1 / ms = kHz. But we're xnu and most of the rest of the code uses
68 * Hz so we need to convert our milliseconds to seconds. Since we're
69 * dividing by the milliseconds, we simply multiply by 1000.
70 */
71
72 /* Unlike linux, we're not limited to 32-bit, but we do need to take care
73 * that we're going to multiply by 1000 first so we do need at least some
74 * arithmetic headroom. For now, 32-bit should be enough.
75 * Also unlike Linux, our compiler can do 64-bit integer arithmetic.
76 */
77 if(tscDelta > (1ULL<<32))
78 retval = 0;
79 else
80 {
81 retval = tscDelta * 1000 / 30;
82 }
83 disable_PIT2();
84 return retval;
85}
86
87
88/*
89 * Calculates the FSB and CPU frequencies using specific MSRs for each CPU
90 * - multi. is read from a specific MSR. In the case of Intel, there is:
91 * a max multi. (used to calculate the FSB freq.),
92 * and a current multi. (used to calculate the CPU freq.)
93 * - fsbFrequency = tscFrequency / multi
94 * - cpuFrequency = fsbFrequency * multi
95 */
96
97void scan_cpu(PlatformInfo_t *p)
98{
99const char*newratio, *newfsb;
100intlen, myfsb, i;
101uint64_ttscFrequency, fsbFrequency, cpuFrequency, fsbi;
102uint64_tmsr, flex_ratio = 0;
103uint32_ttms, ida, max_ratio, min_ratio;
104uint8_tbus_ratio_max, maxdiv, bus_ratio_min, currdiv;
105boolfix_fsb, did, core_i, turbo, isatom, fsbad;
106
107max_ratio = min_ratio = myfsb = bus_ratio_max = maxdiv = bus_ratio_min = currdiv = i = 0;
108
109/* get cpuid values */
110for( ; i <= 3; i++)
111{
112do_cpuid(i, p->CPU.CPUID[i]);
113}
114
115do_cpuid2(0x00000004, 0, p->CPU.CPUID[CPUID_4]);
116do_cpuid(0x80000000, p->CPU.CPUID[CPUID_80]);
117if ((p->CPU.CPUID[CPUID_80][0] & 0x0000000f) >= 1) {
118do_cpuid(0x80000001, p->CPU.CPUID[CPUID_81]);
119}
120#if DEBUG_CPU
121{
122inti;
123printf("CPUID Raw Values:\n");
124for (i=0; i<CPUID_MAX; i++) {
125printf("%02d: %08x-%08x-%08x-%08x\n", i,
126p->CPU.CPUID[i][0], p->CPU.CPUID[i][1],
127p->CPU.CPUID[i][2], p->CPU.CPUID[i][3]);
128}
129}
130#endif
131p->CPU.Vendor= p->CPU.CPUID[CPUID_0][1];
132p->CPU.Signature= p->CPU.CPUID[CPUID_1][0];
133p->CPU.Stepping= bitfield(p->CPU.CPUID[CPUID_1][0], 3, 0);
134p->CPU.Model= bitfield(p->CPU.CPUID[CPUID_1][0], 7, 4);
135p->CPU.Type= bitfield(p->CPU.CPUID[CPUID_1][0], 13, 12);
136p->CPU.Family= bitfield(p->CPU.CPUID[CPUID_1][0], 11, 8);
137p->CPU.ExtModel= bitfield(p->CPU.CPUID[CPUID_1][0], 19, 16);
138p->CPU.ExtFamily= bitfield(p->CPU.CPUID[CPUID_1][0], 27, 20);
139p->CPU.NoThreads= bitfield(p->CPU.CPUID[CPUID_1][1], 23, 16);
140p->CPU.NoCores= bitfield(p->CPU.CPUID[CPUID_4][0], 31, 26) + 1;
141
142p->CPU.Model += (p->CPU.ExtModel << 4);
143
144/* get brand string (if supported) */
145/* Copyright: from Apple's XNU cpuid.c */
146if (p->CPU.CPUID[CPUID_80][0] > 0x80000004) {
147uint32_treg[4];
148 char str[128], *s;
149/*
150 * The brand string 48 bytes (max), guaranteed to
151 * be NUL terminated.
152 */
153do_cpuid(0x80000002, reg);
154bcopy((char *)reg, &str[0], 16);
155do_cpuid(0x80000003, reg);
156bcopy((char *)reg, &str[16], 16);
157do_cpuid(0x80000004, reg);
158bcopy((char *)reg, &str[32], 16);
159for (s = str; *s != '\0'; s++) {
160if (*s != ' ') break;
161}
162
163strlcpy(p->CPU.BrandString,s, sizeof(p->CPU.BrandString));
164
165if (!strncmp(p->CPU.BrandString, CPU_STRING_UNKNOWN, min(sizeof(p->CPU.BrandString), strlen(CPU_STRING_UNKNOWN) + 1))) {
166 /*
167 * This string means we have a firmware-programmable brand string,
168 * and the firmware couldn't figure out what sort of CPU we have.
169 */
170 p->CPU.BrandString[0] = '\0';
171 }
172}
173
174/* setup features */
175p->CPU.Features |= (CPU_FEATURE_MMX | CPU_FEATURE_SSE | CPU_FEATURE_SSE2 | CPU_FEATURE_MSR | CPU_FEATURE_APIC | CPU_FEATURE_TM1 | CPU_FEATURE_ACPI) & p->CPU.CPUID[CPUID_1][3];
176p->CPU.Features |= (CPU_FEATURE_SSE3 | CPU_FEATURE_SSE41 | CPU_FEATURE_SSE42 | CPU_FEATURE_EST | CPU_FEATURE_TM2 | CPU_FEATURE_SSSE3 | CPU_FEATURE_xAPIC) & p->CPU.CPUID[CPUID_1][2];
177p->CPU.Features |= (CPU_FEATURE_EM64T | CPU_FEATURE_XD) & p->CPU.CPUID[CPUID_81][3];
178p->CPU.Features |= (CPU_FEATURE_LAHF) & p->CPU.CPUID[CPUID_81][2];
179
180
181//if ((CPU_FEATURE_HTT & p->CPU.CPUID[CPUID_1][3]) != 0) {
182if (p->CPU.NoThreads > p->CPU.NoCores) {
183p->CPU.Features |= CPU_FEATURE_HTT;
184}
185
186
187tscFrequency = measure_tsc_frequency();
188fsbFrequency = 0;
189cpuFrequency = 0;
190fsbi = 0;
191fix_fsb = false;
192did = false;
193core_i = false;
194turbo = false;
195isatom = false;
196fsbad = false;
197
198if ((p->CPU.Vendor == 0x756E6547 /* Intel */) && ((p->CPU.Family == 0x06) || (p->CPU.Family == 0x0f)))
199{
200verbose("CPU: ");
201int tjmax = 0;
202msr = rdmsr64(MSR_IA32_PLATFORM_ID);
203if((((msr >> 50) & 0x01) == 1) || (rdmsr64(0x17) & (1<<28)))
204{
205p->CPU.Features |= CPU_FEATURE_MOBILE;
206verbose("Mobile ");
207}
208verbose("%s\n", p->CPU.BrandString);
209
210if ((p->CPU.Family == 0x06 && p->CPU.Model >= 0x0c) || (p->CPU.Family == 0x0f && p->CPU.Model >= 0x03))
211{
212if (p->CPU.Family == 0x06)
213{
214int intelCPU = p->CPU.Model;
215int Stepp = p->CPU.Stepping;
216int bus;
217
218switch (intelCPU)
219{
220case 0xc:// Core i7 & Atom
221if (strstr(p->CPU.BrandString, "Atom")) goto teleport1;
222case 0x1a:// Core i7 LGA1366, Xeon 5500, "Bloomfield", "Gainstown", 45nm
223case 0x1e:// Core i7, i5 LGA1156, "Clarksfield", "Lynnfield", "Jasper", 45nm
224case 0x1f:// Core i7, i5, Nehalem
225case 0x25:// Core i7, i5, i3 LGA1156, "Westmere", "Clarkdale", "Arrandale", 32nm
226case 0x2a:// Sandy Bridge, 32nm
227case 0x2c:// Core i7 LGA1366, Six-core, "Westmere", "Gulftown", 32nm
228case 0x2e:// Core i7, Nehalem-Ex Xeon, "Beckton"
229case 0x2f:// Core i7, Nehalem-Ex Xeon, "Eagleton"
230core_i = true;
231tjmax = (rdmsr64(MSR_THERMAL_TARGET) >> 16) & 0xff;
232msr = rdmsr64(MSR_PLATFORM_INFO);
233bus_ratio_max = (msr >> 8) & 0xff;
234bus_ratio_min = (msr >> 40) & 0xff; //valv: not sure about this one (Remarq.1)
235verbose("CPU: Flex-Ratio = %d ", bus_ratio_max);
236min_ratio = bus_ratio_min * 10;
237msr = rdmsr64(MSR_FLEX_RATIO);
238if ((msr >> 16) & 0x01)
239{
240flex_ratio = (msr >> 8) & 0xff;
241verbose(">> %d", flex_ratio);
242if(bus_ratio_max > flex_ratio) bus_ratio_max = flex_ratio;
243}
244verbose("\n");
245if(bus_ratio_max) fsbFrequency = (tscFrequency / bus_ratio_max);
246
247//valv: Turbo Ratio Limit
248if ((intelCPU != 0x2e) && (intelCPU != 0x2f))
249{
250turbo = true;
251msr = rdmsr64(MSR_TURBO_RATIO_LIMIT);
252
253p->CPU.Tone = (msr >> 0) & 0xff;
254p->CPU.Ttwo = (msr >> 8) & 0xff;
255p->CPU.Tthr = (msr >> 16) & 0xff;
256p->CPU.Tfor = (msr >> 24) & 0xff;
257
258cpuFrequency = bus_ratio_max * fsbFrequency;
259max_ratio = bus_ratio_max * 10;
260}
261else cpuFrequency = tscFrequency;
262
263if ((getValueForKey(kbusratio, &newratio, &len, &bootInfo->bootConfig)) && (len <= 4))
264{
265max_ratio = atoi(newratio);
266max_ratio = (max_ratio * 10);
267if (len >= 3) max_ratio = (max_ratio + 5);
268
269verbose("Bus-Ratio: min=%d, max=%s\n", bus_ratio_min, newratio);
270
271// extreme overclockers may love 320 ;)
272if ((max_ratio >= min_ratio) && (max_ratio <= 320))
273{
274cpuFrequency = (fsbFrequency * max_ratio) / 10;
275if (len >= 3) maxdiv = 1;
276else maxdiv = 0;
277}
278else max_ratio = (bus_ratio_max * 10);
279}
280//valv: to be uncommented if Remarq.1 didn't stick
281/*if(bus_ratio_max > 0) bus_ratio = flex_ratio;*/
282p->CPU.MaxRatio = max_ratio;
283p->CPU.MinRatio = min_ratio;
284
285//fsbi = fsbFrequency;
286if(getIntForKey(kForceFSB, &myfsb, &bootInfo->bootConfig)) goto forcefsb;
287else myfsb = fsbFrequency / 1000000;
288verbose("Sticking with [BCLK: %dMhz, Bus-Ratio: %s]\n", myfsb, newratio);
289break;
290case 0xd:// Pentium M, Dothan, 90nm
291case 0xe:// Core Duo/Solo, Pentium M DC
292teleport1:
293msr = rdmsr64(MSR_IA32_EXT_CONFIG);
294if(msr & (1 << 30)) tjmax = 85;
295goto teleport2;
296case 0xf:// Core Xeon, Core 2 DC, 65nm
297switch (Stepp)
298{
299case 0x2:
300tjmax = 95;
301break;
302case 0x6:
303if (p->CPU.NoCores = 2) tjmax = 80;
304if (p->CPU.NoCores = 4) tjmax = 90;
305else tjmax = 85;
306break;
307case 0xb:
308tjmax = 90;
309break;
310case 0xd:
311default:
312msr = rdmsr64(MSR_IA32_EXT_CONFIG);
313if(msr & (1 << 30)) tjmax = 85;
314break;
315}
316case 0x1c:// Atom :)
317switch (Stepp)
318{
319case 0xa:
320tjmax = 100;
321break;
322case 0x2:
323default:
324tjmax = 90;
325break;
326}
327case 0x17:// Core 2 Duo/Extreme, Xeon, 45nm
328switch (Stepp)
329{
330case 0x6:// Mobile Core2 Duo
331tjmax = 104;
332break;
333case 0xa:// Mobile Centrino 2
334tjmax = 105;
335break;
336default:
337if (platformCPUFeature(CPU_FEATURE_MOBILE)) tjmax = 105;
338break;
339}
340case 0x16:// Celeron, Core 2 SC, 65nm
341case 0x27:// Atom Lincroft, 45nm
342teleport2:
343core_i = false;
344//valv: todo: msr_therm2_ctl (0x19d) bit 16 (mode of automatic thermal monitor): 0=tm1, 1=tm2
345//also, if bit 3 of misc_enable is cleared the above would have no effect
346if (strstr(p->CPU.BrandString, "Atom"))
347isatom = true;
348if(!isatom && (platformCPUFeature(CPU_FEATURE_TM1)))
349{
350msr_t msr32;
351msr32 = rdmsr(MSR_IA32_MISC_ENABLE);
352bool tmfix = false;
353getBoolForKey(kFixTM, &tmfix, &bootInfo->bootConfig);
354if(tmfix)
355{
356//thermally-initiated on-die modulation of the stop-clock duty cycle
357if(!(rdmsr64(MSR_IA32_MISC_ENABLE) & (1 << 3))) msr32.lo |= (1 << 3);
358verbose("CPU: Thermal Monitor: TM, ");
359
360//BIOS must enable this feature if the TM2 feature flag (CPUID.1:ECX[8]) is set
361if(platformCPUFeature(CPU_FEATURE_TM2))
362{
363//thermally-initiated frequency transitions
364msr32.lo |= (1 << 13);
365verbose("TM2, ");
366}
367msr32.lo |= (1 << 17);
368verbose("PROCHOT, ");
369msr32.lo |= (1 << 10);
370verbose("FERR\n");
371}
372bool oem_ssdt, tmpval;
373oem_ssdt = false;
374
375oem_ssdt = getBoolForKey(kOEMSSDT, &tmpval, &bootInfo->bootConfig)&&tmpval;
376if(oem_ssdt)
377{
378bool c2e, c4e, hc4e;
379c2e = c4e = hc4e = false;
380
381getBoolForKey(kC2EEnable, &c2e, &bootInfo->bootConfig);
382if(c2e) msr32.lo |= (1 << 26);
383
384getBoolForKey(kC4EEnable, &c4e, &bootInfo->bootConfig);
385if((c4e) && platformCPUFeature(CPU_FEATURE_MOBILE)) msr32.hi |= (1 << (32 - 32));
386getBoolForKey(kHardC4EEnable, &hc4e, &bootInfo->bootConfig);
387if((hc4e) && platformCPUFeature(CPU_FEATURE_MOBILE)) msr32.hi |= (1 << (33 - 32));
388if(c2e || c4e || hc4e) tmfix = true;
389}
390
391if(tmfix)
392{
393msr32.hi |= (1 << (36 - 32)); // EMTTM
394wrmsr(MSR_IA32_MISC_ENABLE, msr32);
395}
396if(tmfix)
397{
398msr32 = rdmsr(PIC_SENS_CFG);
399msr32.lo |= (1 << 21);
400wrmsr(PIC_SENS_CFG, msr32);
401}
402}
403
404if (rdmsr64(MSR_IA32_EXT_CONFIG) & (1 << 27))
405{
406wrmsr64(MSR_IA32_EXT_CONFIG, (rdmsr64(MSR_IA32_EXT_CONFIG) | (1 << 28)));
407delay(1);
408did = rdmsr64(MSR_IA32_EXT_CONFIG) & (1 << 28);
409}
410getBoolForKey(kFixFSB, &fix_fsb, &bootInfo->bootConfig);
411if(fix_fsb)
412{
413msr = rdmsr64(MSR_FSB_FREQ);
414bus = (msr >> 0) & 0x7;
415if(p->CPU.Model == 0xd && bus == 0)
416{
417fsbFrequency = 100000000;
418myfsb = 100;
419}
420else if(p->CPU.Model == 0xe && p->CPU.ExtModel == 1) goto ratio;
421else
422{
423switch (bus)
424{
425case 0:
426fsbFrequency = 266666667;
427myfsb = 266;
428break;
429case 1:
430fsbFrequency = 133333333;
431myfsb = 133;
432break;
433case 3:
434fsbFrequency = 166666667;
435myfsb = 166;
436break;
437case 4:
438fsbFrequency = 333333333;
439myfsb = 333;
440break;
441case 5:
442fsbFrequency = 100000000;
443myfsb = 100;
444break;
445case 6:
446fsbFrequency = 400000000;
447myfsb = 400;
448break;
449case 2:
450default:
451fsbFrequency = 200000000;
452myfsb = 200;
453break;
454}
455}
456uint64_t minfsb = 182000000, maxfsb = 185000000;
457if(((fsbFrequency > minfsb) && (fsbFrequency < maxfsb)) || !fsbFrequency)
458{
459fsbFrequency = 200000000;
460fsbad = true;
461}
462goto ratio;
463}
464case 0x1d:// Xeon MP MP 7400
465// for 0x2a & 0x2b turbo is true;
466//case 0x2a:// SNB
467//case 0x2b:// SNB Xeon
468default:
469if(getIntForKey(kForceFSB, &myfsb, &bootInfo->bootConfig))
470{
471forcefsb:
472switch(myfsb)
473{
474case 133:
475fsbFrequency = 133333333;
476break;
477case 166:
478fsbFrequency = 166666667;
479break;
480case 233:
481fsbFrequency = 233333333;
482break;
483case 266:
484fsbFrequency = 266666667;
485break;
486case 333:
487fsbFrequency = 333333333;
488break;
489case 100:
490case 200:
491case 400:
492fsbFrequency = (myfsb * 1000000);
493break;
494default:
495getValueForKey(kForceFSB, &newfsb, &len, &bootInfo->bootConfig);
496if((len <= 3) && (myfsb < 400))
497{
498fsbFrequency = (myfsb * 1000000);
499verbose("Specified FSB: %dMhz. Assuming you know what you 're doing !\n", myfsb);
500}
501else if(core_i) fsbFrequency = 133333333;
502else fsbFrequency = 200000000;
503break;
504}
505if(core_i)
506{
507cpuFrequency = (fsbFrequency * max_ratio) / 10;
508verbose("Sticking with [BCLK: %dMhz, Bus-Ratio: %s]\n", myfsb, newratio);
509break;
510}
511fix_fsb = true;
512}
513goto ratio;
514break;
515}
516}
517else
518{
519ratio:
520msr = rdmsr64(MSR_IA32_PERF_STATUS);
521maxdiv = (msr >> 46) & 0x01;
522//valv: this seems to be bit 15 instead of 14.
523currdiv = (msr >> 15) & 0x01;
524uint8_t XE = (msr >> 31) & 0x01;
525
526msr_t msr32;
527msr32 = rdmsr(MSR_IA32_PERF_STATUS);
528bus_ratio_min = (msr32.lo >> 24) & 0x1f;
529min_ratio = bus_ratio_min * 10;
530if(currdiv) min_ratio = min_ratio + 5;
531
532if(XE || (p->CPU.Family == 0x0f)) bus_ratio_max = (msr32.hi >> (40-32)) & 0x1f;
533else bus_ratio_max = ((rdmsr64(MSR_IA32_PLATFORM_ID) >> 8) & 0x1f);
534/* On lower models, currcoef defines TSC freq */
535if (((p->CPU.Family == 0x06) && (p->CPU.Model < 0x0e)) && (p->CPU.Family != 0x0f)) bus_ratio_max = bus_ratio_min;
536// bad hack! Could force a value relying on kpstates, but I fail to see its benefits.
537if(bus_ratio_min == 0) bus_ratio_min = bus_ratio_max;
538
539if(p->CPU.Family == 0x0f)
540{
541getBoolForKey(kFixFSB, &fix_fsb, &bootInfo->bootConfig);
542if(fix_fsb)
543{
544msr = rdmsr64(MSR_EBC_FREQUENCY_ID);
545int bus = (msr >> 16) & 0x7;
546switch (bus)
547{
548case 0:
549fsbFrequency = 266666667;
550myfsb = 266;
551break;
552case 1:
553fsbFrequency = 133333333;
554myfsb = 133;
555break;
556case 3:
557fsbFrequency = 166666667;
558myfsb = 166;
559break;
560case 2:
561default:
562fsbFrequency = 200000000;
563myfsb = 200;
564break;
565}
566uint64_t minfsb = 183000000, maxfsb = 185000000;
567if (((fsbFrequency > minfsb) && (fsbFrequency < maxfsb)) || (!fsbFrequency))
568{
569fsbFrequency = 200000000;
570fsbad = true;
571}
572}
573}
574
575if(fix_fsb)
576{
577if (bus_ratio_max)
578{
579if (maxdiv) fsbi = ((tscFrequency * 2) / ((bus_ratio_max * 2) + 1));
580else fsbi = (tscFrequency / bus_ratio_max);
581}
582ratio_gn:
583if ((getValueForKey(kbusratio, &newratio, &len, &bootInfo->bootConfig)) && (len <= 4))
584{
585max_ratio = atoi(newratio);
586max_ratio = (max_ratio * 10);
587if (len >= 3) max_ratio = (max_ratio + 5);
588
589verbose("Bus-Ratio defaults: min=%d%s, max=%d%s\n", bus_ratio_min, currdiv ? ".5" : "", bus_ratio_max, maxdiv ? ".5" : "");
590if ((max_ratio >= min_ratio) && (max_ratio < 200))
591{
592cpuFrequency = (fsbFrequency * max_ratio) / 10;
593if (len >= 3) maxdiv = 1;
594else maxdiv = 0;
595verbose("Sticking with [FSB: %dMhz, Bus-Ratio: %s]\n", myfsb, newratio);
596}
597else
598{
599printf("Bus-Ratio: Lowest allowed = %d%s. ", bus_ratio_min, currdiv ? ".5" : "");
600goto ratio_vldt;
601}
602}
603else
604{
605ratio_vldt:
606if (maxdiv)
607{
608cpuFrequency = ((fsbFrequency * ((bus_ratio_max * 2) + 1)) / 2);
609max_ratio = (bus_ratio_max * 10) + 5;
610}
611else
612{
613cpuFrequency = (fsbFrequency * bus_ratio_max);
614max_ratio = bus_ratio_max * 10;
615}
616verbose("CPU: Sticking with: [FSB: %dMhz, Bus-Ratio: %d%s] %s\n", myfsb, bus_ratio_max, maxdiv ? ".5" : "", newratio ? "instead" : "");
617}
618}
619else
620{
621if (bus_ratio_max)
622{
623if (maxdiv)
624{
625fsbFrequency = ((tscFrequency * 2) / ((bus_ratio_max * 2) + 1));
626max_ratio = ((bus_ratio_max * 10) + 5);
627}
628else
629{
630fsbFrequency = (tscFrequency / bus_ratio_max);
631max_ratio = (bus_ratio_max * 10);
632}
633
634myfsb = (fsbFrequency / 1000000);
635if (getValueForKey(kbusratio, &newratio, &len, &bootInfo->bootConfig)) goto ratio_gn;
636else cpuFrequency = ((fsbFrequency * max_ratio) / 10);
637
638DBG("max: %d%s current: %d%s\n", bus_ratio_max, maxdiv ? ".5" : "", bus_ratio_min, currdiv ? ".5" : "");
639}
640}
641p->CPU.MaxRatio = max_ratio;
642p->CPU.MinRatio = min_ratio;
643}
644}
645
646// on-die sensor
647if (p->CPU.CPUID[CPUID_0][0] >= 0x6)
648{
649// Highest Basic Functions Number
650do_cpuid(6, p->CPU.CPUID[CPUID_81]);
651tms = bitfield(p->CPU.CPUID[CPUID_81][0], 0, 0);
652ida = bitfield(p->CPU.CPUID[CPUID_81][0], 1, 1);
653if(tms != 0)
654{
655int temp, utjmax;
656if (tjmax == 0) tjmax = 100;
657if((getIntForKey(kTjmax, &utjmax, &bootInfo->bootConfig)) && ((70 <= utjmax) && (utjmax <= 110))) tjmax = utjmax;
658msr = rdmsr64(MSR_THERMAL_STATUS);
659//if ((msr & 0x3) == 0x3)
660if (((msr >> 31) & 0x1) == 1)
661{
662temp = tjmax - ((msr >> 16) & 0x7F);
663verbose("CPU: Tjmax ~ %d°C Temperature= ~ %d°C\n", tjmax, temp);
664}
665else temp = -1;
666}
667if(ida == 0)
668{
669verbose("CPU: Attempting to enable IDA ");
670msr_t msr;
671msr = rdmsr(MSR_IA32_MISC_ENABLE);
672msr.hi |= (0 << (38-32));
673wrmsr(MSR_IA32_MISC_ENABLE, msr);
674delay(1);
675if(bitfield(p->CPU.CPUID[CPUID_81][0], 1, 1) == 0) verbose("Failed!\n");
676else verbose("Succeded!\n");
677}
678else verbose("CPU: IDA: Enabled!\n");
679}
680}
681//#if 0
682// valv: work in progress. Most of this code is going to be moved when ready
683else if(p->CPU.Vendor == 0x68747541 /* AMD */ && p->CPU.Family == 0x0f)
684{
685verbose("CPU: ");
686// valv: very experimental mobility check
687if (p->CPU.CPUID[0x80000000][0] >= 0x80000007)
688{
689uint32_t amo, const_tsc;
690do_cpuid(0x80000007, p->CPU.CPUID[CPUID_MAX]);
691amo = bitfield(p->CPU.CPUID[CPUID_MAX][0], 6, 6);
692const_tsc = bitfield(p->CPU.CPUID[CPUID_MAX][3], 8, 8);
693// valv: p-state support verification
694//uint32_t pstate_support = bitfield(p->CPU.CPUID[CPUID_MAX][3], 2, 1);
695//if(pstate_support != 0) verbose("supproted p-state transition\n")
696
697if (const_tsc != 0) verbose("Constant TSC!\n");
698if (amo == 1)
699{
700p->CPU.Features |= CPU_FEATURE_MOBILE;
701if (!strstr(p->CPU.BrandString, "obile")) verbose("Mobile ");
702}
703}
704//valv: 2nd attemp; just in case
705if (!platformCPUFeature(CPU_FEATURE_MOBILE))
706{
707if (strstr(p->CPU.BrandString, "obile"))
708{
709p->CPU.Features |= CPU_FEATURE_MOBILE;
710}
711}
712verbose("%s\n", p->CPU.BrandString);
713
714if(p->CPU.ExtFamily == 0x00 /* K8 */)
715{
716// valv: this section needs some work
717msr = rdmsr64(K8_FIDVID_STATUS);
718bus_ratio_max = bitfield(msr, 21, 16);
719//bus_ratio_max = (msr & 0x3f) / 2 + 4;
720bus_ratio_min = bitfield(msr, 13, 8);
721currdiv = (msr & 0x01) * 2;
722if (bus_ratio_max)
723{
724if (currdiv)
725{
726fsbFrequency = ((tscFrequency * currdiv) / bus_ratio_max); // ?
727DBG("%d.%d\n", bus_ratio_max / currdiv, ((bus_ratio_max % currdiv) * 100) / currdiv);
728}
729else
730{
731fsbFrequency = (tscFrequency / bus_ratio_max);
732DBG("%d\n", bus_ratio_max);
733}
734//fsbFrequency = (tscFrequency / bus_ratio_max); // ?
735cpuFrequency = tscFrequency; // ?
736}
737}
738
739else if(p->CPU.ExtFamily >= 0x01 /* K10+ */)
740{
741msr = rdmsr64(K10_COFVID_STATUS);
742currdiv = (2 << ((msr >> 6) & 0x07));
743msr = rdmsr64(AMD_10H_11H_CONFIG);
744bus_ratio_max = ((msr) & 0x3F);
745//verbose("max_multi: %d\n", bus_ratio_max);
746
747/*msr_t divmsr;
748divmsr = rdmsr(AMD_10H_11H_CONFIG);
749maxdiv = (divmsr.hi >> 0x08) & 0x01;
750verbose("maxdiv: %d, currdiv: %d\n", maxdiv, currdiv);*/
751
752if(p->CPU.ExtFamily == 0x01)
753cpuFrequency = 100 * (bus_ratio_max + 0x10);
754else
755cpuFrequency = 100 * (bus_ratio_max + 0x08);
756
757uint32_t minFreq = cpuFrequency / (1 << currdiv);
758
759uint8_t maxrtio = (cpuFrequency / 20);
760p->CPU.MaxRatio = maxrtio;
761
762fsbFrequency = ((tscFrequency / 100000) / maxrtio);
763verbose("fsb: %d\n", fsbFrequency);
764
765if(maxrtio == ((bus_ratio_max * 10) - 5))
766{
767verbose("multi: max:%d.5, min:", (bus_ratio_max - 1));
768maxdiv = 1;
769}
770else if(maxrtio == ((bus_ratio_max - 1) * 10))
771{
772verbose("multi: max:%d, min:", (bus_ratio_max - 1));
773maxdiv = 0;
774}
775
776bus_ratio_min = (minFreq / fsbFrequency);
777verbose("%d", bus_ratio_min);
778while(minFreq < 800)
779{
780bus_ratio_min = bus_ratio_min + 1; // bus_ratio_min++; ???
781verbose(" >> %d", bus_ratio_min);
782}
783verbose("\n");
784
785struct hwpstate
786{
787uint32_tfreq;/* CPU clock in Mhz. */
788uint32_tvolts;/* Voltage in mV. */
789uint32_tpower;/* Power consumed in mW. */
790uint8_tlat;/* Transition latency in us. */
791uint8_tpstate_id;/* P-State id */
792};
793
794struct hwpstate state[32];
795int max_state, i,/* did,*/ vid;
796uint8_t fid;
797msr = rdmsr64(MSR_AMD_10H_11H_LIMIT);
798max_state = 1 + (((msr) >> 4) & 0x7);
799
800for(i=0; i<max_state; i++)
801{
802msr = rdmsr64(AMD_10H_11H_CONFIG + i);
803//msr_t didmsr;
804//didmsr = rdmsr(AMD_10H_11H_CONFIG + i);
805if ((msr & ((uint64_t)1 << 63)) != ((uint64_t)1 << 63)) verbose("Invalid MSR!\n");
806else
807{
808//did = (didmsr.hi >> 0x08) & 0x01;
809if(i == 0)
810{
811//maxdiv = did;
812fid = p->CPU.MaxRatio;
813state[i].freq = ((fid * fsbFrequency) / 10);
814fid = (fid / 10);
815}
816else
817{
818fid = bitfield(msr, 5, 0);
819state[i].freq = (fid * fsbFrequency);
820}
821
822if(i == (max_state -1))
823{
824fid = bus_ratio_min;
825state[i].freq = (fid * fsbFrequency);
826}
827
828vid = bitfield(msr, 15, 9);
829
830if(i == 0) verbose("P-State %d: Frequency: %d, Multiplier: %d%s, vid: %d\n", i, state[i].freq, fid, maxdiv ? ".5" : "", vid);
831else if((state[i].freq > state[i-1].freq) || (state[i].freq < 800)) verbose("P-State %d: Removed!\n", i);
832else verbose("P-State %d: Frequency: %d, Multiplier: %d, vid: %d\n", i, state[i].freq, fid, vid);
833state[i].pstate_id = i;
834// valv: zeroed for now
835state[i].volts = 0;
836state[i].power = 0;
837state[i].lat = 0;
838}
839}
840fsbFrequency = (fsbFrequency * 1000000);
841cpuFrequency = (state[0].freq * 1000000);
842}
843
844p->CPU.MinRatio = bus_ratio_min * 10;
845}
846else if(p->CPU.Vendor == 0x746e6543 /* CENTAUR */ && p->CPU.Family == 6) //valv: partial!
847{
848msr = rdmsr64(MSR_EBL_CR_POWERON);
849int bus = (msr >> 18) & 0x3;
850switch (bus)
851{
852case 1:
853fsbFrequency = 133333333;
854break;
855case 2:
856fsbFrequency = 200000000;
857break;
858case 3:
859fsbFrequency = 166666667;
860break;
861case 0:
862default:
863fsbFrequency = 100000000;
864break;
865}
866msr_t msr;
867msr = rdmsr(MSR_IA32_PERF_STATUS);
868bus_ratio_min = (msr.lo >> 24) & 0x1f;
869min_ratio = bus_ratio_min * 10;
870bus_ratio_max = (msr.hi >> (40-32)) & 0x1f;
871max_ratio = bus_ratio_max * 10;
872cpuFrequency = ((fsbFrequency * max_ratio) / 10);
873}
874
875if (!fsbFrequency)
876{
877fsbFrequency = (DEFAULT_FSB * 1000);
878cpuFrequency = tscFrequency;
879DBG("0 ! using the default value for FSB !\n");
880}
881
882//#endif
883
884p->CPU.MaxDiv = maxdiv;
885p->CPU.CurrDiv = currdiv;
886p->CPU.TSCFrequency = tscFrequency;
887p->CPU.FSBFrequency = fsbFrequency;
888p->CPU.CPUFrequency = cpuFrequency;
889p->CPU.ISerie = false;
890p->CPU.Turbo = false;
891
892if(!fsbad) p->CPU.FSBIFrequency = fsbFrequency;
893else p->CPU.FSBIFrequency = fsbi;
894
895if (platformCPUFeature(CPU_FEATURE_EST))
896{
897msr_t msr32;
898msr32 = rdmsr(MSR_IA32_MISC_ENABLE);
899if (!(rdmsr64(MSR_IA32_MISC_ENABLE) & (1 << 16)))
900{//valv: we can also attempt to enable
901msr32.lo |= (1 << 16);
902// Lock till next reset!
903msr32.lo |= (1 << 20);
904wrmsr(MSR_IA32_MISC_ENABLE, msr32);
905delay(1);
906if(rdmsr64(MSR_IA32_MISC_ENABLE) & (1 << 16))
907{
908p->CPU.EST = 1;
909verbose("CPU: EIST Successfully Enabled!\n");
910}
911else
912{
913p->CPU.EST = 0;
914verbose("CPU: EIST couldn't be enabled!\n");
915}
916}
917
918else p->CPU.EST = 1;
919}
920
921if(core_i) p->CPU.ISerie = true;
922DBG("CPU: Vendor/Family/ExtFamily: 0x%x/0x%x/0x%x\n", p->CPU.Vendor, p->CPU.Family, p->CPU.ExtFamily);
923DBG("CPU: Model/ExtModel/Stepping: 0x%x/0x%x/0x%x\n", p->CPU.Model, p->CPU.ExtModel, p->CPU.Stepping);
924DBG("CPU: Multipliers x10: max=%d, min=%d\n", p->CPU.MaxRatio, p->CPU.MinRatio);
925if(turbo)
926{
927DBG("Turbo Ratio: %d/%d/%d/%d\n", p->CPU.Tone, p->CPU.Ttwo, p->CPU.Tthr, p->CPU.Tfor);
928p->CPU.Turbo = true;
929}
930DBG("CPU: MaxDiv/CurrDiv: 0x%x/0x%x\n", p->CPU.MaxDiv, p->CPU.CurrDiv);
931DBG("CPU: TSCFreq: %dMHz\n", p->CPU.TSCFrequency / 1000000);
932DBG("CPU: CPUFreq: %dMHz\n", p->CPU.CPUFrequency / 1000000);
933DBG("CPU: FSBFreq: %dMHz\n", p->CPU.FSBFrequency / 1000000);
934if(did)
935{
936p->CPU.SLFM = did;
937DBG("CPU: SLFM: %d\n", p->CPU.SLFM);
938}
939if(platformCPUFeature(CPU_FEATURE_EST))
940DBG("CPU: Enhanced SpeedStep: %d\n", p->CPU.EST);
941DBG("CPU: NoCores/NoThreads: %d/%d\n", p->CPU.NoCores, p->CPU.NoThreads);
942DBG("CPU: Features: 0x%08x\n", p->CPU.Features);
943}
944

Archive Download this file

Revision: 707