src/arch/i386/lib/cpu.c

   1 #include <console/console.h>
   2 #include <cpu/cpu.h>
   3 #include <arch/io.h>
   4 #include <string.h>
   5 #include <cpu/x86/mtrr.h>
   6 #include <cpu/x86/msr.h>
   7 #include <cpu/x86/lapic.h>
   8 #include <arch/cpu.h>
   9 #include <device/path.h>
  10 #include <device/device.h>
  11 #include <smp/spinlock.h>
  12
  13 /* Standard macro to see if a specific flag is changeable */
  14 static inline int flag_is_changeable_p(uint32_t flag)
  15 {
  16         uint32_t f1, f2;
  17
  18         asm(
  19                 "pushfl\n\t"
  20                 "pushfl\n\t"
  21                 "popl %0\n\t"
  22                 "movl %0,%1\n\t"
  23                 "xorl %2,%0\n\t"
  24                 "pushl %0\n\t"
  25                 "popfl\n\t"
  26                 "pushfl\n\t"
  27                 "popl %0\n\t"
  28                 "popfl\n\t"
  29                 : "=&r" (f1), "=&r" (f2)
  30                 : "ir" (flag));
  31         return ((f1^f2) & flag) != 0;
  32 }
  33
  34
  35 /* Probe for the CPUID instruction */
  36 static int have_cpuid_p(void)
  37 {
  38         return flag_is_changeable_p(X86_EFLAGS_ID);
  39 }
  40
  41 /*
  42  * Cyrix CPUs without cpuid or with cpuid not yet enabled can be detected
  43  * by the fact that they preserve the flags across the division of 5/2.
  44  * PII and PPro exhibit this behavior too, but they have cpuid available.
  45  */
  46
  47 /*
  48  * Perform the Cyrix 5/2 test. A Cyrix won't change
  49  * the flags, while other 486 chips will.
  50  */
  51 static inline int test_cyrix_52div(void)
  52 {
  53         unsigned int test;
  54
  55         __asm__ __volatile__(
  56              "sahf\n\t"         /* clear flags (%eax = 0x0005) */
  57              "div %b2\n\t"      /* divide 5 by 2 */
  58              "lahf"             /* store flags into %ah */
  59              : "=a" (test)
  60              : "0" (5), "q" (2)
  61              : "cc");
  62
  63         /* AH is 0x02 on Cyrix after the divide.. */
  64         return (unsigned char) (test >> 8) == 0x02;
  65 }
  66
  67 /*
  68  *      Detect a NexGen CPU running without BIOS hypercode new enough
  69  *      to have CPUID. (Thanks to Herbert Oppmann)
  70  */
  71
  72 static int deep_magic_nexgen_probe(void)
  73 {
  74         int ret;
  75
  76         __asm__ __volatile__ (
  77                 "       movw    $0x5555, %%ax\n"
  78                 "       xorw    %%dx,%%dx\n"
  79                 "       movw    $2, %%cx\n"
  80                 "       divw    %%cx\n"
  81                 "       movl    $0, %%eax\n"
  82                 "       jnz     1f\n"
  83                 "       movl    $1, %%eax\n"
  84                 "1:\n"
  85                 : "=a" (ret) : : "cx", "dx" );
  86         return  ret;
  87 }
  88
  89 /* List of cpu vendor strings along with their normalized
  90  * id values.
  91  */
  92 static struct {
  93         int vendor;
  94         const char *name;
  95 } x86_vendors[] = {
  96         { X86_VENDOR_INTEL,     "GenuineIntel", },
  97         { X86_VENDOR_CYRIX,     "CyrixInstead", },
  98         { X86_VENDOR_AMD,       "AuthenticAMD", },
  99         { X86_VENDOR_UMC,       "UMC UMC UMC ", },
 100         { X86_VENDOR_NEXGEN,    "NexGenDriven", },
 101         { X86_VENDOR_CENTAUR,   "CentaurHauls", },
 102         { X86_VENDOR_RISE,      "RiseRiseRise", },
 103         { X86_VENDOR_TRANSMETA, "GenuineTMx86", },
 104         { X86_VENDOR_TRANSMETA, "TransmetaCPU", },
 105         { X86_VENDOR_NSC,       "Geode by NSC", },
 106         { X86_VENDOR_SIS,       "SiS SiS SiS ", },
 107 };
 108
 109 static const char *x86_vendor_name[] = {
 110         [X86_VENDOR_INTEL]     = "Intel",
 111         [X86_VENDOR_CYRIX]     = "Cyrix",
 112         [X86_VENDOR_AMD]       = "AMD",
 113         [X86_VENDOR_UMC]       = "UMC",
 114         [X86_VENDOR_NEXGEN]    = "NexGen",
 115         [X86_VENDOR_CENTAUR]   = "Centaur",
 116         [X86_VENDOR_RISE]      = "Rise",
 117         [X86_VENDOR_TRANSMETA] = "Transmeta",
 118         [X86_VENDOR_NSC]       = "NSC",
 119         [X86_VENDOR_SIS]       = "SiS",
 120 };
 121
 122 static const char *cpu_vendor_name(int vendor)
 123 {
 124         const char *name;
 125         name = "<invalid cpu vendor>";
 126         if ((vendor < (ARRAY_SIZE(x86_vendor_name))) &&
 127                 (x86_vendor_name[vendor] != 0))
 128         {
 129                 name = x86_vendor_name[vendor];
 130         }
 131         return name;
 132 }
 133
 134 static void identify_cpu(struct device *cpu)
 135 {
 136         char vendor_name[16];
 137         int i;
 138
 139         vendor_name[0] = '\0'; /* Unset */
 140
 141         /* Find the id and vendor_name */
 142         if (!have_cpuid_p()) {
 143                 /* Its a 486 if we can modify the AC flag */
 144                 if (flag_is_changeable_p(X86_EFLAGS_AC)) {
 145                         cpu->device = 0x00000400; /* 486 */
 146                 } else {
 147                         cpu->device = 0x00000300; /* 386 */
 148                 }
 149                 if ((cpu->device == 0x00000400) && test_cyrix_52div()) {
 150                         memcpy(vendor_name, "CyrixInstead", 13);
 151                         /* If we ever care we can enable cpuid here */
 152                 }
 153                 /* Detect NexGen with old hypercode */
 154                 else if (deep_magic_nexgen_probe()) {
 155                         memcpy(vendor_name, "NexGenDriven", 13);
 156                 }
 157         }
 158         if (have_cpuid_p()) {
 159                 int  cpuid_level;
 160                 struct cpuid_result result;
 161                 result = cpuid(0x00000000);
 162                 cpuid_level    = result.eax;
 163                 vendor_name[ 0] = (result.ebx >>  0) & 0xff;
 164                 vendor_name[ 1] = (result.ebx >>  8) & 0xff;
 165                 vendor_name[ 2] = (result.ebx >> 16) & 0xff;
 166                 vendor_name[ 3] = (result.ebx >> 24) & 0xff;
 167                 vendor_name[ 4] = (result.edx >>  0) & 0xff;
 168                 vendor_name[ 5] = (result.edx >>  8) & 0xff;
 169                 vendor_name[ 6] = (result.edx >> 16) & 0xff;
 170                 vendor_name[ 7] = (result.edx >> 24) & 0xff;
 171                 vendor_name[ 8] = (result.ecx >>  0) & 0xff;
 172                 vendor_name[ 9] = (result.ecx >>  8) & 0xff;
 173                 vendor_name[10] = (result.ecx >> 16) & 0xff;
 174                 vendor_name[11] = (result.ecx >> 24) & 0xff;
 175                 vendor_name[12] = '\0';
 176
 177                 /* Intel-defined flags: level 0x00000001 */
 178                 if (cpuid_level >= 0x00000001) {
 179                         cpu->device = cpuid_eax(0x00000001);
 180                 }
 181                 else {
 182                         /* Have CPUID level 0 only unheard of */
 183                         cpu->device = 0x00000400;
 184                 }
 185         }
 186         cpu->vendor = X86_VENDOR_UNKNOWN;
 187         for(i = 0; i < ARRAY_SIZE(x86_vendors); i++) {
 188                 if (memcmp(vendor_name, x86_vendors[i].name, 12) == 0) {
 189                         cpu->vendor = x86_vendors[i].vendor;
 190                         break;
 191                 }
 192         }
 193 }
 194
 195 static void set_cpu_ops(struct device *cpu)
 196 {
 197         struct cpu_driver *driver;
 198         cpu->ops = 0;
 199         for (driver = cpu_drivers; driver < ecpu_drivers; driver++) {
 200                 struct cpu_device_id *id;
 201                 for(id = driver->id_table; id->vendor != X86_VENDOR_INVALID; id++) {
 202                         if ((cpu->vendor == id->vendor) &&
 203                                 (cpu->device == id->device))
 204                         {
 205                                 goto found;
 206                         }
 207                 }
 208         }
 209         return;
 210  found:
 211         cpu->ops = driver->ops;
 212 }
 213
 214 void cpu_initialize(void)
 215 {
 216         /* Because we busy wait at the printk spinlock.
 217          * It is important to keep the number of printed messages
 218          * from secondary cpus to a minimum, when debugging is
 219          * disabled.
 220          */
 221         struct device *cpu;
 222         struct cpu_info *info;
 223         struct cpuinfo_x86 c;
 224
 225         info = cpu_info();
 226
 227         printk(BIOS_INFO, "Initializing CPU #%ld\n", info->index);
 228
 229         cpu = info->cpu;
 230         if (!cpu) {
 231                 die("CPU: missing cpu device structure");
 232         }
 233
 234         /* Find what type of cpu we are dealing with */
 235         identify_cpu(cpu);
 236         printk(BIOS_DEBUG, "CPU: vendor %s device %x\n",
 237                 cpu_vendor_name(cpu->vendor), cpu->device);
 238
 239         get_fms(&c, cpu->device);
 240
 241         printk(BIOS_DEBUG, "CPU: family %02x, model %02x, stepping %02x\n",
 242                 c.x86, c.x86_model, c.x86_mask);
 243
 244         /* Lookup the cpu's operations */
 245         set_cpu_ops(cpu);
 246
 247         if(!cpu->ops) {
 248                 /* mask out the stepping and try again */
 249                 cpu->device -= c.x86_mask;
 250                 set_cpu_ops(cpu);
 251                 cpu->device += c.x86_mask;
 252                 if(!cpu->ops) die("Unknown cpu");
 253                 printk(BIOS_DEBUG, "Using generic cpu ops (good)\n");
 254         }
 255
 256
 257         /* Initialize the cpu */
 258         if (cpu->ops && cpu->ops->init) {
 259                 cpu->enabled = 1;
 260                 cpu->initialized = 1;
 261                 cpu->ops->init(cpu);
 262         }
 263
 264         printk(BIOS_INFO, "CPU #%ld initialized\n", info->index);
 265
 266         return;
 267 }
 268