arch/x86/lib/mpspec.c

   1 /*
   2  * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
   3  *
   4  * Adapted from coreboot src/arch/x86/boot/mpspec.c
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 #include <common.h>
  10 #include <cpu.h>
  11 #include <dm.h>
  12 #include <asm/cpu.h>
  13 #include <asm/ioapic.h>
  14 #include <asm/lapic.h>
  15 #include <asm/mpspec.h>
  16 #include <asm/tables.h>
  17 #include <dm/uclass-internal.h>
  18
  19 struct mp_config_table *mp_write_floating_table(struct mp_floating_table *mf)
  20 {
  21         u32 mc;
  22
  23         memcpy(mf->mpf_signature, MPF_SIGNATURE, 4);
  24         mf->mpf_physptr = (u32)mf + sizeof(struct mp_floating_table);
  25         mf->mpf_length = 1;
  26         mf->mpf_spec = MPSPEC_V14;
  27         mf->mpf_checksum = 0;
  28         /* We don't use the default configuration table */
  29         mf->mpf_feature1 = 0;
  30         /* Indicate that virtual wire mode is always implemented */
  31         mf->mpf_feature2 = 0;
  32         mf->mpf_feature3 = 0;
  33         mf->mpf_feature4 = 0;
  34         mf->mpf_feature5 = 0;
  35         mf->mpf_checksum = table_compute_checksum(mf, mf->mpf_length * 16);
  36
  37         mc = (u32)mf + sizeof(struct mp_floating_table);
  38         return (struct mp_config_table *)mc;
  39 }
  40
  41 void mp_config_table_init(struct mp_config_table *mc)
  42 {
  43         memcpy(mc->mpc_signature, MPC_SIGNATURE, 4);
  44         mc->mpc_length = sizeof(struct mp_config_table);
  45         mc->mpc_spec = MPSPEC_V14;
  46         mc->mpc_checksum = 0;
  47         mc->mpc_oemptr = 0;
  48         mc->mpc_oemsize = 0;
  49         mc->mpc_entry_count = 0;
  50         mc->mpc_lapic = LAPIC_DEFAULT_BASE;
  51         mc->mpe_length = 0;
  52         mc->mpe_checksum = 0;
  53         mc->reserved = 0;
  54
  55         /* The oem/product id fields are exactly 8/12 bytes long */
  56         table_fill_string(mc->mpc_oem, CONFIG_SYS_VENDOR, 8, ' ');
  57         table_fill_string(mc->mpc_product, CONFIG_SYS_BOARD, 12, ' ');
  58 }
  59
  60 void mp_write_processor(struct mp_config_table *mc)
  61 {
  62         struct mpc_config_processor *mpc;
  63         struct udevice *dev;
  64         u8 boot_apicid, apicver;
  65         u32 cpusignature, cpufeature;
  66         struct cpuid_result result;
  67
  68         boot_apicid = lapicid();
  69         apicver = lapic_read(LAPIC_LVR) & 0xff;
  70         result = cpuid(1);
  71         cpusignature = result.eax;
  72         cpufeature = result.edx;
  73
  74         for (uclass_find_first_device(UCLASS_CPU, &dev);
  75              dev;
  76              uclass_find_next_device(&dev)) {
  77                 struct cpu_platdata *plat = dev_get_parent_platdata(dev);
  78                 u8 cpuflag = MPC_CPU_EN;
  79
  80                 if (!device_active(dev))
  81                         continue;
  82
  83                 mpc = (struct mpc_config_processor *)mp_next_mpc_entry(mc);
  84                 mpc->mpc_type = MP_PROCESSOR;
  85                 mpc->mpc_apicid = plat->cpu_id;
  86                 mpc->mpc_apicver = apicver;
  87                 if (boot_apicid == plat->cpu_id)
  88                         cpuflag |= MPC_CPU_BP;
  89                 mpc->mpc_cpuflag = cpuflag;
  90                 mpc->mpc_cpusignature = cpusignature;
  91                 mpc->mpc_cpufeature = cpufeature;
  92                 mpc->mpc_reserved[0] = 0;
  93                 mpc->mpc_reserved[1] = 0;
  94                 mp_add_mpc_entry(mc, sizeof(*mpc));
  95         }
  96 }
  97
  98 void mp_write_bus(struct mp_config_table *mc, int id, const char *bustype)
  99 {
 100         struct mpc_config_bus *mpc;
 101
 102         mpc = (struct mpc_config_bus *)mp_next_mpc_entry(mc);
 103         mpc->mpc_type = MP_BUS;
 104         mpc->mpc_busid = id;
 105         memcpy(mpc->mpc_bustype, bustype, 6);
 106         mp_add_mpc_entry(mc, sizeof(*mpc));
 107 }
 108
 109 void mp_write_ioapic(struct mp_config_table *mc, int id, int ver, u32 apicaddr)
 110 {
 111         struct mpc_config_ioapic *mpc;
 112
 113         mpc = (struct mpc_config_ioapic *)mp_next_mpc_entry(mc);
 114         mpc->mpc_type = MP_IOAPIC;
 115         mpc->mpc_apicid = id;
 116         mpc->mpc_apicver = ver;
 117         mpc->mpc_flags = MPC_APIC_USABLE;
 118         mpc->mpc_apicaddr = apicaddr;
 119         mp_add_mpc_entry(mc, sizeof(*mpc));
 120 }
 121
 122 void mp_write_intsrc(struct mp_config_table *mc, int irqtype, int irqflag,
 123                      int srcbus, int srcbusirq, int dstapic, int dstirq)
 124 {
 125         struct mpc_config_intsrc *mpc;
 126
 127         mpc = (struct mpc_config_intsrc *)mp_next_mpc_entry(mc);
 128         mpc->mpc_type = MP_INTSRC;
 129         mpc->mpc_irqtype = irqtype;
 130         mpc->mpc_irqflag = irqflag;
 131         mpc->mpc_srcbus = srcbus;
 132         mpc->mpc_srcbusirq = srcbusirq;
 133         mpc->mpc_dstapic = dstapic;
 134         mpc->mpc_dstirq = dstirq;
 135         mp_add_mpc_entry(mc, sizeof(*mpc));
 136 }
 137
 138 void mp_write_pci_intsrc(struct mp_config_table *mc, int irqtype,
 139                          int srcbus, int dev, int pin, int dstapic, int dstirq)
 140 {
 141         u8 srcbusirq = (dev << 2) | (pin - 1);
 142
 143         mp_write_intsrc(mc, irqtype, MP_IRQ_TRIGGER_LEVEL | MP_IRQ_POLARITY_LOW,
 144                         srcbus, srcbusirq, dstapic, dstirq);
 145 }
 146
 147 void mp_write_lintsrc(struct mp_config_table *mc, int irqtype, int irqflag,
 148                       int srcbus, int srcbusirq, int destapic, int destlint)
 149 {
 150         struct mpc_config_lintsrc *mpc;
 151
 152         mpc = (struct mpc_config_lintsrc *)mp_next_mpc_entry(mc);
 153         mpc->mpc_type = MP_LINTSRC;
 154         mpc->mpc_irqtype = irqtype;
 155         mpc->mpc_irqflag = irqflag;
 156         mpc->mpc_srcbusid = srcbus;
 157         mpc->mpc_srcbusirq = srcbusirq;
 158         mpc->mpc_destapic = destapic;
 159         mpc->mpc_destlint = destlint;
 160         mp_add_mpc_entry(mc, sizeof(*mpc));
 161 }
 162
 163 void mp_write_address_space(struct mp_config_table *mc,
 164                             int busid, int addr_type,
 165                             u32 addr_base_low, u32 addr_base_high,
 166                             u32 addr_length_low, u32 addr_length_high)
 167 {
 168         struct mp_ext_system_address_space *mpe;
 169
 170         mpe = (struct mp_ext_system_address_space *)mp_next_mpe_entry(mc);
 171         mpe->mpe_type = MPE_SYSTEM_ADDRESS_SPACE;
 172         mpe->mpe_length = sizeof(*mpe);
 173         mpe->mpe_busid = busid;
 174         mpe->mpe_addr_type = addr_type;
 175         mpe->mpe_addr_base_low = addr_base_low;
 176         mpe->mpe_addr_base_high = addr_base_high;
 177         mpe->mpe_addr_length_low = addr_length_low;
 178         mpe->mpe_addr_length_high = addr_length_high;
 179         mp_add_mpe_entry(mc, (struct mp_ext_config *)mpe);
 180 }
 181
 182 void mp_write_bus_hierarchy(struct mp_config_table *mc,
 183                             int busid, int bus_info, int parent_busid)
 184 {
 185         struct mp_ext_bus_hierarchy *mpe;
 186
 187         mpe = (struct mp_ext_bus_hierarchy *)mp_next_mpe_entry(mc);
 188         mpe->mpe_type = MPE_BUS_HIERARCHY;
 189         mpe->mpe_length = sizeof(*mpe);
 190         mpe->mpe_busid = busid;
 191         mpe->mpe_bus_info = bus_info;
 192         mpe->mpe_parent_busid = parent_busid;
 193         mpe->reserved[0] = 0;
 194         mpe->reserved[1] = 0;
 195         mpe->reserved[2] = 0;
 196         mp_add_mpe_entry(mc, (struct mp_ext_config *)mpe);
 197 }
 198
 199 void mp_write_compat_address_space(struct mp_config_table *mc, int busid,
 200                                    int addr_modifier, u32 range_list)
 201 {
 202         struct mp_ext_compat_address_space *mpe;
 203
 204         mpe = (struct mp_ext_compat_address_space *)mp_next_mpe_entry(mc);
 205         mpe->mpe_type = MPE_COMPAT_ADDRESS_SPACE;
 206         mpe->mpe_length = sizeof(*mpe);
 207         mpe->mpe_busid = busid;
 208         mpe->mpe_addr_modifier = addr_modifier;
 209         mpe->mpe_range_list = range_list;
 210         mp_add_mpe_entry(mc, (struct mp_ext_config *)mpe);
 211 }
 212
 213 u32 mptable_finalize(struct mp_config_table *mc)
 214 {
 215         u32 end;
 216
 217         mc->mpe_checksum = table_compute_checksum((void *)mp_next_mpc_entry(mc),
 218                                                   mc->mpe_length);
 219         mc->mpc_checksum = table_compute_checksum(mc, mc->mpc_length);
 220         end = mp_next_mpe_entry(mc);
 221
 222         debug("Write the MP table at: %x - %x\n", (u32)mc, end);
 223
 224         return end;
 225 }