#include <sys/cpuvar.h>
#include <sys/psm.h>
#include <sys/archsystm.h>
#include <sys/apic.h>
#include <sys/apic_common.h>
#include <sys/sunddi.h>
#include <sys/ddi_impldefs.h>
#include <sys/mach_intr.h>
#include <sys/sysmacros.h>
#include <sys/trap.h>
#include <sys/x86_archext.h>
#include <sys/privregs.h>
#include <sys/psm_common.h>
static uint64_t local_x2apic_read(uint32_t msr);
static void local_x2apic_write(uint32_t msr, uint64_t value);
static int get_local_x2apic_pri(void);
static void local_x2apic_write_task_reg(uint64_t value);
static void local_x2apic_write_int_cmd(uint32_t cpu_id, uint32_t cmd1);
int x2apic_enable = 1;
static apic_reg_ops_t x2apic_regs_ops = {
local_x2apic_read,
local_x2apic_write,
get_local_x2apic_pri,
local_x2apic_write_task_reg,
local_x2apic_write_int_cmd,
apic_send_EOI,
};
static uint64_t
local_x2apic_read(uint32_t msr)
{
uint64_t i;
i = (uint64_t)(rdmsr(REG_X2APIC_BASE_MSR + (msr >> 2)) & 0xffffffff);
return (i);
}
static void
local_x2apic_write(uint32_t msr, uint64_t value)
{
uint64_t tmp;
if (msr != APIC_EOI_REG) {
tmp = rdmsr(REG_X2APIC_BASE_MSR + (msr >> 2));
tmp = (tmp & 0xffffffff00000000) | value;
} else {
tmp = 0;
}
wrmsr((REG_X2APIC_BASE_MSR + (msr >> 2)), tmp);
}
static int
get_local_x2apic_pri(void)
{
return (rdmsr(REG_X2APIC_BASE_MSR + (APIC_TASK_REG >> 2)));
}
static void
local_x2apic_write_task_reg(uint64_t value)
{
X2APIC_WRITE(APIC_TASK_REG, value);
}
static void
local_x2apic_write_int_cmd(uint32_t cpu_id, uint32_t cmd1)
{
wrmsr((REG_X2APIC_BASE_MSR + (APIC_INT_CMD1 >> 2)),
(((uint64_t)cpu_id << 32) | cmd1));
}
int
apic_detect_x2apic(void)
{
if (x2apic_enable == 0)
return (0);
return (is_x86_feature(x86_featureset, X86FSET_X2APIC));
}
void
apic_enable_x2apic(void)
{
uint64_t apic_base_msr;
if (apic_local_mode() == LOCAL_X2APIC) {
if (apic_mode != LOCAL_X2APIC)
x2apic_update_psm();
return;
}
apic_base_msr = rdmsr(REG_APIC_BASE_MSR);
apic_base_msr = apic_base_msr | (0x1 << X2APIC_ENABLE_BIT);
wrmsr(REG_APIC_BASE_MSR, apic_base_msr);
if (apic_mode != LOCAL_X2APIC)
x2apic_update_psm();
}
void
apic_change_ops()
{
if (apic_mode == LOCAL_APIC)
apic_reg_ops = &local_apic_regs_ops;
else if (apic_mode == LOCAL_X2APIC)
apic_reg_ops = &x2apic_regs_ops;
}
void
x2apic_send_ipi(int cpun, int ipl)
{
int vector;
ulong_t flag;
ASSERT(apic_mode == LOCAL_X2APIC);
atomic_or_ulong(&flag, 1);
vector = apic_resv_vector[ipl];
flag = intr_clear();
#ifdef DEBUG
APIC_AV_PENDING_SET();
#endif
if ((cpun == psm_get_cpu_id())) {
X2APIC_WRITE(X2APIC_SELF_IPI, vector);
} else {
apic_reg_ops->apic_write_int_cmd(
apic_cpus[cpun].aci_local_id, vector);
}
intr_restore(flag);
}
void
x2apic_send_pir_ipi(processorid_t cpun)
{
const int vector = apic_pir_vect;
ulong_t flag;
ASSERT(apic_mode == LOCAL_X2APIC);
ASSERT((vector >= APIC_BASE_VECT) && (vector <= APIC_SPUR_INTR));
atomic_or_ulong(&flag, 1);
flag = intr_clear();
if ((cpun != psm_get_cpu_id())) {
#ifdef DEBUG
APIC_AV_PENDING_SET();
#endif
apic_reg_ops->apic_write_int_cmd(apic_cpus[cpun].aci_local_id,
vector);
}
intr_restore(flag);
}
void
apic_common_send_ipi(int cpun, int ipl)
{
int vector;
ulong_t flag;
int mode = apic_local_mode();
if (mode == LOCAL_X2APIC) {
x2apic_send_ipi(cpun, ipl);
return;
}
ASSERT(mode == LOCAL_APIC);
vector = apic_resv_vector[ipl];
ASSERT((vector >= APIC_BASE_VECT) && (vector <= APIC_SPUR_INTR));
flag = intr_clear();
while (local_apic_regs_ops.apic_read(APIC_INT_CMD1) & AV_PENDING)
apic_ret();
local_apic_regs_ops.apic_write_int_cmd(apic_cpus[cpun].aci_local_id,
vector);
intr_restore(flag);
}
void
apic_common_send_pir_ipi(processorid_t cpun)
{
const int mode = apic_local_mode();
if (mode == LOCAL_X2APIC) {
x2apic_send_pir_ipi(cpun);
return;
}
apic_send_pir_ipi(cpun);
}