com32/sysdump/cpuid.c

   1 /*
   2  * Dump CPUID information
   3  */
   4
   5 #include <stdio.h>
   6 #include <string.h>
   7 #include <stdlib.h>
   8 #include <com32.h>
   9 #include <sys/cpu.h>
  10 #include "sysdump.h"
  11
  12 struct cpuid_data {
  13     uint32_t eax, ebx, ecx, edx;
  14 };
  15
  16 struct cpuid_info {
  17     uint32_t eax, ecx;
  18     struct cpuid_data data;
  19 };
  20
  21 static void get_cpuid(uint32_t eax, uint32_t ecx, struct cpuid_data *data)
  22 {
  23     asm("pushl %%ebx ; cpuid ; movl %%ebx,%1 ; popl %%ebx"
  24         : "=a" (data->eax), "=r" (data->ebx),
  25           "=c" (data->ecx), "=d" (data->edx)
  26         : "a" (eax), "c" (ecx));
  27 }
  28
  29 #define CPUID_CHUNK 128
  30
  31 void dump_cpuid(struct upload_backend *be)
  32 {
  33     struct cpuid_info *buf = NULL;
  34     int nentry, nalloc;
  35     uint32_t region;
  36     struct cpuid_data base_leaf;
  37     uint32_t base, leaf, count;
  38     struct cpuid_data invalid_leaf;
  39     struct cpuid_data data;
  40
  41     if (!cpu_has_eflag(EFLAGS_ID))
  42         return;
  43
  44     printf("Dumping CPUID... ");
  45
  46     nentry = nalloc = 0;
  47
  48     /* Find out what the CPU returns for invalid leaves */
  49     get_cpuid(0, 0, &base_leaf);
  50     get_cpuid(base_leaf.eax+1, 0, &invalid_leaf);
  51
  52     for (region = 0 ; region <= 0xffff ; region++) {
  53         base = region << 16;
  54
  55         get_cpuid(base, 0, &base_leaf);
  56         if (region && !memcmp(&base_leaf, &invalid_leaf, sizeof base_leaf))
  57             continue;
  58
  59         if ((base_leaf.eax ^ base) & 0xffff0000)
  60             continue;
  61
  62         for (leaf = base ; leaf <= base_leaf.eax ; leaf++) {
  63             get_cpuid(leaf, 0, &data);
  64             count = 0;
  65
  66             do {
  67                 if (nentry >= nalloc) {
  68                     nalloc += CPUID_CHUNK;
  69                     buf = realloc(buf, nalloc*sizeof *buf);
  70                     if (!buf)
  71                         return;         /* FAILED */
  72                 }
  73                 buf[nentry].eax = leaf;
  74                 buf[nentry].ecx = count;
  75                 buf[nentry].data = data;
  76                 nentry++;
  77                 count++;
  78
  79                 get_cpuid(leaf, count, &data);
  80             } while (memcmp(&data, &buf[nentry-1].data, sizeof data) &&
  81                      (data.eax | data.ebx | data.ecx | data.edx));
  82         }
  83     }
  84
  85     if (nentry)
  86         cpio_writefile(be, "cpuid", buf, nentry*sizeof *buf);
  87     free(buf);
  88
  89     printf("done.\n");
  90 }