lunaix-os/arch/i386/hal/cpu.c

   1 #include <cpuid.h>
   2 #include <lunaix/types.h>
   3 #include <sys/cpu.h>
   4 #include <sys/vectors.h>
   5
   6 #define BRAND_LEAF 0x80000000UL
   7
   8 void
   9 cpu_get_model(char* model_out)
  10 {
  11     u32_t* out = (u32_t*)model_out;
  12     u32_t eax = 0, ebx = 0, edx = 0, ecx = 0;
  13
  14     __get_cpuid(0, &eax, &ebx, &ecx, &edx);
  15
  16     out[0] = ebx;
  17     out[1] = edx;
  18     out[2] = ecx;
  19     model_out[12] = '\0';
  20 }
  21
  22 int
  23 cpu_brand_string_supported()
  24 {
  25     u32_t supported = __get_cpuid_max(BRAND_LEAF, 0);
  26     return (supported >= 0x80000004UL);
  27 }
  28
  29 void
  30 cpu_get_id(char* id_out)
  31 {
  32     if (!cpu_brand_string_supported()) {
  33         id_out[0] = '?';
  34         id_out[1] = '\0';
  35     }
  36     u32_t* out = (u32_t*)id_out;
  37     u32_t eax = 0, ebx = 0, edx = 0, ecx = 0;
  38     for (u32_t i = 2, j = 0; i < 5; i++) {
  39         __get_cpuid(BRAND_LEAF + i, &eax, &ebx, &ecx, &edx);
  40         out[j] = eax;
  41         out[j + 1] = ebx;
  42         out[j + 2] = ecx;
  43         out[j + 3] = edx;
  44         j += 4;
  45     }
  46     id_out[48] = '\0';
  47 }
  48
  49 void
  50 cpu_rdmsr(u32_t msr_idx, u32_t* reg_high, u32_t* reg_low)
  51 {
  52     u32_t h = 0, l = 0;
  53     asm volatile("rdmsr" : "=d"(h), "=a"(l) : "c"(msr_idx));
  54
  55     *reg_high = h;
  56     *reg_low = l;
  57 }
  58
  59 void
  60 cpu_wrmsr(u32_t msr_idx, u32_t reg_high, u32_t reg_low)
  61 {
  62     asm volatile("wrmsr" : : "d"(reg_high), "a"(reg_low), "c"(msr_idx));
  63 }
  64
  65 void
  66 cpu_trap_sched()
  67 {
  68     asm("int %0" ::"i"(LUNAIX_SCHED));
  69 }
  70
  71 void
  72 cpu_trap_panic(char* message)
  73 {
  74     asm("int %0" ::"i"(LUNAIX_SYS_PANIC), "D"(message));
  75 }