sync with OpenBSD -current
This commit is contained in:
parent
acf2ed1690
commit
06dd911763
20 changed files with 327 additions and 83 deletions
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: vmm_machdep.c,v 1.29 2024/07/14 07:57:42 dv Exp $ */
|
||||
/* $OpenBSD: vmm_machdep.c,v 1.30 2024/07/24 21:04:12 dv Exp $ */
|
||||
/*
|
||||
* Copyright (c) 2014 Mike Larkin <mlarkin@openbsd.org>
|
||||
*
|
||||
|
@ -1987,10 +1987,8 @@ vcpu_reset_regs_svm(struct vcpu *vcpu, struct vcpu_reg_state *vrs)
|
|||
PATENTRY(6, PAT_UCMINUS) | PATENTRY(7, PAT_UC);
|
||||
|
||||
/* NPT */
|
||||
if (vmm_softc->mode == VMM_MODE_RVI) {
|
||||
vmcb->v_np_enable = 1;
|
||||
vmcb->v_n_cr3 = vcpu->vc_parent->vm_map->pmap->pm_pdirpa;
|
||||
}
|
||||
vmcb->v_np_enable = 1;
|
||||
vmcb->v_n_cr3 = vcpu->vc_parent->vm_map->pmap->pm_pdirpa;
|
||||
|
||||
/* Enable SVME in EFER (must always be set) */
|
||||
vmcb->v_efer |= EFER_SVME;
|
||||
|
@ -2363,11 +2361,8 @@ vcpu_reset_regs_vmx(struct vcpu *vcpu, struct vcpu_reg_state *vrs)
|
|||
IA32_VMX_USE_TPR_SHADOW;
|
||||
want0 = 0;
|
||||
|
||||
if (vmm_softc->mode == VMM_MODE_EPT) {
|
||||
want1 |= IA32_VMX_ACTIVATE_SECONDARY_CONTROLS;
|
||||
want0 |= IA32_VMX_CR3_LOAD_EXITING |
|
||||
IA32_VMX_CR3_STORE_EXITING;
|
||||
}
|
||||
want1 |= IA32_VMX_ACTIVATE_SECONDARY_CONTROLS;
|
||||
want0 |= IA32_VMX_CR3_LOAD_EXITING | IA32_VMX_CR3_STORE_EXITING;
|
||||
|
||||
if (vcpu->vc_vmx_basic & IA32_VMX_TRUE_CTLS_AVAIL) {
|
||||
ctrl = IA32_VMX_TRUE_PROCBASED_CTLS;
|
||||
|
@ -2403,7 +2398,7 @@ vcpu_reset_regs_vmx(struct vcpu *vcpu, struct vcpu_reg_state *vrs)
|
|||
* IA32_VMX_UNRESTRICTED_GUEST - enable unrestricted guest (if caller
|
||||
* specified CR0_PG | CR0_PE in %cr0 in the 'vrs' parameter)
|
||||
*/
|
||||
want1 = 0;
|
||||
want1 = IA32_VMX_ENABLE_EPT;
|
||||
|
||||
/* XXX checking for 2ndary controls can be combined here */
|
||||
if (vcpu_vmx_check_cap(vcpu, IA32_VMX_PROCBASED_CTLS,
|
||||
|
@ -2415,9 +2410,6 @@ vcpu_reset_regs_vmx(struct vcpu *vcpu, struct vcpu_reg_state *vrs)
|
|||
}
|
||||
}
|
||||
|
||||
if (vmm_softc->mode == VMM_MODE_EPT)
|
||||
want1 |= IA32_VMX_ENABLE_EPT;
|
||||
|
||||
if (vcpu_vmx_check_cap(vcpu, IA32_VMX_PROCBASED_CTLS,
|
||||
IA32_VMX_ACTIVATE_SECONDARY_CONTROLS, 1)) {
|
||||
if (vcpu_vmx_check_cap(vcpu, IA32_VMX_PROCBASED2_CTLS,
|
||||
|
@ -5419,8 +5411,7 @@ vmx_handle_cr0_write(struct vcpu *vcpu, uint64_t r)
|
|||
/* If the guest hasn't enabled paging ... */
|
||||
if (!(r & CR0_PG) && (oldcr0 & CR0_PG)) {
|
||||
/* Paging was disabled (prev. enabled) - Flush TLB */
|
||||
if (vmm_softc->mode == VMM_MODE_EPT &&
|
||||
vcpu->vc_vmx_vpid_enabled) {
|
||||
if (vcpu->vc_vmx_vpid_enabled) {
|
||||
vid.vid_vpid = vcpu->vc_vpid;
|
||||
vid.vid_addr = 0;
|
||||
invvpid(IA32_VMX_INVVPID_SINGLE_CTX_GLB, &vid);
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: cpu.c,v 1.129 2024/07/21 18:57:31 kettenis Exp $ */
|
||||
/* $OpenBSD: cpu.c,v 1.130 2024/07/24 21:24:18 kettenis Exp $ */
|
||||
|
||||
/*
|
||||
* Copyright (c) 2016 Dale Rahn <drahn@dalerahn.com>
|
||||
|
@ -242,6 +242,9 @@ int cpu_node;
|
|||
uint64_t cpu_id_aa64isar0;
|
||||
uint64_t cpu_id_aa64isar1;
|
||||
uint64_t cpu_id_aa64isar2;
|
||||
uint64_t cpu_id_aa64mmfr0;
|
||||
uint64_t cpu_id_aa64mmfr1;
|
||||
uint64_t cpu_id_aa64mmfr2;
|
||||
uint64_t cpu_id_aa64pfr0;
|
||||
uint64_t cpu_id_aa64pfr1;
|
||||
|
||||
|
@ -487,6 +490,7 @@ cpu_identify(struct cpu_info *ci)
|
|||
static uint64_t prev_id_aa64isar2;
|
||||
static uint64_t prev_id_aa64mmfr0;
|
||||
static uint64_t prev_id_aa64mmfr1;
|
||||
static uint64_t prev_id_aa64mmfr2;
|
||||
static uint64_t prev_id_aa64pfr0;
|
||||
static uint64_t prev_id_aa64pfr1;
|
||||
uint64_t midr, impl, part;
|
||||
|
@ -642,6 +646,7 @@ cpu_identify(struct cpu_info *ci)
|
|||
READ_SPECIALREG(id_aa64isar2_el1) == prev_id_aa64isar2 &&
|
||||
READ_SPECIALREG(id_aa64mmfr0_el1) == prev_id_aa64mmfr0 &&
|
||||
READ_SPECIALREG(id_aa64mmfr1_el1) == prev_id_aa64mmfr1 &&
|
||||
READ_SPECIALREG(id_aa64mmfr2_el1) == prev_id_aa64mmfr2 &&
|
||||
READ_SPECIALREG(id_aa64pfr0_el1) == prev_id_aa64pfr0 &&
|
||||
READ_SPECIALREG(id_aa64pfr1_el1) == prev_id_aa64pfr1)
|
||||
return;
|
||||
|
@ -662,6 +667,18 @@ cpu_identify(struct cpu_info *ci)
|
|||
printf("\n%s: mismatched ID_AA64ISAR2_EL1",
|
||||
ci->ci_dev->dv_xname);
|
||||
}
|
||||
if (READ_SPECIALREG(id_aa64mmfr0_el1) != cpu_id_aa64mmfr0) {
|
||||
printf("\n%s: mismatched ID_AA64MMFR0_EL1",
|
||||
ci->ci_dev->dv_xname);
|
||||
}
|
||||
if (READ_SPECIALREG(id_aa64mmfr1_el1) != cpu_id_aa64mmfr1) {
|
||||
printf("\n%s: mismatched ID_AA64MMFR1_EL1",
|
||||
ci->ci_dev->dv_xname);
|
||||
}
|
||||
if (READ_SPECIALREG(id_aa64mmfr2_el1) != cpu_id_aa64mmfr2) {
|
||||
printf("\n%s: mismatched ID_AA64MMFR2_EL1",
|
||||
ci->ci_dev->dv_xname);
|
||||
}
|
||||
id = READ_SPECIALREG(id_aa64pfr0_el1);
|
||||
/* Allow CSV2/CVS3 to be different. */
|
||||
id &= ~ID_AA64PFR0_CSV2_MASK;
|
||||
|
@ -938,6 +955,16 @@ cpu_identify(struct cpu_info *ci)
|
|||
sep = ",";
|
||||
}
|
||||
|
||||
/*
|
||||
* ID_AA64MMFR2
|
||||
*/
|
||||
id = READ_SPECIALREG(id_aa64mmfr2_el1);
|
||||
|
||||
if (ID_AA64MMFR2_IDS(id) >= ID_AA64MMFR2_IDS_IMPL) {
|
||||
printf("%sIDS", sep);
|
||||
sep = ",";
|
||||
}
|
||||
|
||||
/*
|
||||
* ID_AA64PFR0
|
||||
*/
|
||||
|
@ -989,6 +1016,7 @@ cpu_identify(struct cpu_info *ci)
|
|||
prev_id_aa64isar2 = READ_SPECIALREG(id_aa64isar2_el1);
|
||||
prev_id_aa64mmfr0 = READ_SPECIALREG(id_aa64mmfr0_el1);
|
||||
prev_id_aa64mmfr1 = READ_SPECIALREG(id_aa64mmfr1_el1);
|
||||
prev_id_aa64mmfr2 = READ_SPECIALREG(id_aa64mmfr2_el1);
|
||||
prev_id_aa64pfr0 = READ_SPECIALREG(id_aa64pfr0_el1);
|
||||
prev_id_aa64pfr1 = READ_SPECIALREG(id_aa64pfr1_el1);
|
||||
|
||||
|
@ -1023,6 +1051,7 @@ cpu_identify(struct cpu_info *ci)
|
|||
void
|
||||
cpu_identify_cleanup(void)
|
||||
{
|
||||
uint64_t id_aa64mmfr2;
|
||||
uint64_t value;
|
||||
|
||||
/* ID_AA64ISAR0_EL1 */
|
||||
|
@ -1040,6 +1069,15 @@ cpu_identify_cleanup(void)
|
|||
value &= ~ID_AA64ISAR2_CLRBHB_MASK;
|
||||
cpu_id_aa64isar2 = value;
|
||||
|
||||
/* ID_AA64MMFR0_EL1 */
|
||||
cpu_id_aa64mmfr0 = 0;
|
||||
|
||||
/* ID_AA64MMFR1_EL1 */
|
||||
cpu_id_aa64mmfr1 = 0;
|
||||
|
||||
/* ID_AA64MMFR2_EL1 */
|
||||
cpu_id_aa64mmfr2 = 0;
|
||||
|
||||
/* ID_AA64PFR0_EL1 */
|
||||
value = 0;
|
||||
value |= cpu_id_aa64pfr0 & ID_AA64PFR0_FP_MASK;
|
||||
|
@ -1071,7 +1109,9 @@ cpu_identify_cleanup(void)
|
|||
hwcap |= HWCAP_ATOMICS;
|
||||
/* HWCAP_FPHP */
|
||||
/* HWCAP_ASIMDHP */
|
||||
/* HWCAP_CPUID */
|
||||
id_aa64mmfr2 = READ_SPECIALREG(id_aa64mmfr2_el1);
|
||||
if (ID_AA64MMFR2_IDS(id_aa64mmfr2) >= ID_AA64MMFR2_IDS_IMPL)
|
||||
hwcap |= HWCAP_CPUID;
|
||||
if (ID_AA64ISAR0_RDM(cpu_id_aa64isar0) >= ID_AA64ISAR0_RDM_IMPL)
|
||||
hwcap |= HWCAP_ASIMDRDM;
|
||||
if (ID_AA64ISAR1_JSCVT(cpu_id_aa64isar1) >= ID_AA64ISAR1_JSCVT_IMPL)
|
||||
|
@ -1271,6 +1311,9 @@ cpu_attach(struct device *parent, struct device *dev, void *aux)
|
|||
cpu_id_aa64isar0 = READ_SPECIALREG(id_aa64isar0_el1);
|
||||
cpu_id_aa64isar1 = READ_SPECIALREG(id_aa64isar1_el1);
|
||||
cpu_id_aa64isar2 = READ_SPECIALREG(id_aa64isar2_el1);
|
||||
cpu_id_aa64mmfr0 = READ_SPECIALREG(id_aa64mmfr0_el1);
|
||||
cpu_id_aa64mmfr1 = READ_SPECIALREG(id_aa64mmfr1_el1);
|
||||
cpu_id_aa64mmfr2 = READ_SPECIALREG(id_aa64mmfr2_el1);
|
||||
cpu_id_aa64pfr0 = READ_SPECIALREG(id_aa64pfr0_el1);
|
||||
cpu_id_aa64pfr1 = READ_SPECIALREG(id_aa64pfr1_el1);
|
||||
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: fpu.c,v 1.1 2022/01/01 18:52:36 kettenis Exp $ */
|
||||
/* $OpenBSD: fpu.c,v 1.2 2024/07/26 00:23:57 jsg Exp $ */
|
||||
/*
|
||||
* Copyright (c) 2022 Mark Kettenis <kettenis@openbsd.org>
|
||||
*
|
||||
|
@ -22,6 +22,7 @@
|
|||
|
||||
#include <machine/armreg.h>
|
||||
|
||||
__attribute__((target("+fp")))
|
||||
void
|
||||
fpu_save(struct proc *p)
|
||||
{
|
||||
|
@ -74,6 +75,7 @@ fpu_save(struct proc *p)
|
|||
fp->fp_cr = READ_SPECIALREG(fpcr);
|
||||
}
|
||||
|
||||
__attribute__((target("+fp")))
|
||||
void
|
||||
fpu_load(struct proc *p)
|
||||
{
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: machdep.c,v 1.91 2024/07/17 15:21:59 kettenis Exp $ */
|
||||
/* $OpenBSD: machdep.c,v 1.92 2024/07/24 21:24:18 kettenis Exp $ */
|
||||
/*
|
||||
* Copyright (c) 2014 Patrick Wildt <patrick@blueri.se>
|
||||
* Copyright (c) 2021 Mark Kettenis <kettenis@openbsd.org>
|
||||
|
@ -360,8 +360,11 @@ cpu_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp, void *newp,
|
|||
case CPU_ID_AA64PFR1:
|
||||
return sysctl_rdquad(oldp, oldlenp, newp, cpu_id_aa64pfr1);
|
||||
case CPU_ID_AA64MMFR0:
|
||||
return sysctl_rdquad(oldp, oldlenp, newp, cpu_id_aa64mmfr0);
|
||||
case CPU_ID_AA64MMFR1:
|
||||
return sysctl_rdquad(oldp, oldlenp, newp, cpu_id_aa64mmfr1);
|
||||
case CPU_ID_AA64MMFR2:
|
||||
return sysctl_rdquad(oldp, oldlenp, newp, cpu_id_aa64mmfr2);
|
||||
case CPU_ID_AA64SMFR0:
|
||||
case CPU_ID_AA64ZFR0:
|
||||
return sysctl_rdquad(oldp, oldlenp, newp, 0);
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: trap.c,v 1.48 2024/02/21 15:53:07 deraadt Exp $ */
|
||||
/* $OpenBSD: trap.c,v 1.49 2024/07/24 21:24:18 kettenis Exp $ */
|
||||
/*-
|
||||
* Copyright (c) 2014 Andrew Turner
|
||||
* All rights reserved.
|
||||
|
@ -187,6 +187,99 @@ kdata_abort(struct trapframe *frame, uint64_t esr, uint64_t far, int exe)
|
|||
}
|
||||
}
|
||||
|
||||
static int
|
||||
emulate_msr(struct trapframe *frame, uint64_t esr)
|
||||
{
|
||||
u_int rt = ISS_MSR_Rt(esr);
|
||||
uint64_t val;
|
||||
|
||||
/* Only emulate reads. */
|
||||
if ((esr & ISS_MSR_DIR) == 0)
|
||||
return 0;
|
||||
|
||||
/* Only emulate non-debug System register access. */
|
||||
if (ISS_MSR_OP0(esr) != 3 || ISS_MSR_OP1(esr) != 0 ||
|
||||
ISS_MSR_CRn(esr) != 0)
|
||||
return 0;
|
||||
|
||||
switch (ISS_MSR_CRm(esr)) {
|
||||
case 0:
|
||||
switch (ISS_MSR_OP2(esr)) {
|
||||
case 0: /* MIDR_EL1 */
|
||||
val = READ_SPECIALREG(midr_el1);
|
||||
break;
|
||||
case 5: /* MPIDR_EL1 */
|
||||
/*
|
||||
* Don't reveal the topology to userland. But
|
||||
* return a valid value; Bit 31 is RES1.
|
||||
*/
|
||||
val = 0x80000000;
|
||||
break;
|
||||
case 6: /* REVIDR_EL1 */
|
||||
val = 0;
|
||||
break;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
case 4:
|
||||
switch (ISS_MSR_OP2(esr)) {
|
||||
case 0: /* ID_AA64PFR0_EL1 */
|
||||
val = cpu_id_aa64pfr0;
|
||||
break;
|
||||
case 1: /* ID_AA64PFR1_EL1 */
|
||||
val = cpu_id_aa64pfr1;
|
||||
break;
|
||||
case 2: /* ID_AA64PFR2_EL1 */
|
||||
case 4: /* ID_AA64ZFR0_EL1 */
|
||||
case 5: /* ID_AA64SMFR0_EL1 */
|
||||
val = 0;
|
||||
break;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
case 6:
|
||||
switch (ISS_MSR_OP2(esr)) {
|
||||
case 0: /* ID_AA64ISAR0_EL1 */
|
||||
val = cpu_id_aa64isar0;
|
||||
break;
|
||||
case 1: /* ID_AA64ISAR1_EL1 */
|
||||
val = cpu_id_aa64isar1;
|
||||
break;
|
||||
case 2: /* ID_AA64ISAR2_EL2 */
|
||||
val = cpu_id_aa64isar2;
|
||||
break;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
case 7:
|
||||
switch (ISS_MSR_OP2(esr)) {
|
||||
case 0: /* ID_AA64MMFR0_EL1 */
|
||||
case 1: /* ID_AA64MMFR1_EL1 */
|
||||
case 2: /* ID_AA64MMFR2_EL1 */
|
||||
case 3: /* ID_AA64MMFR3_EL1 */
|
||||
case 4: /* ID_AA64MMFR4_EL1 */
|
||||
val = 0;
|
||||
break;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (rt < 30)
|
||||
frame->tf_x[rt] = val;
|
||||
else if (rt == 30)
|
||||
frame->tf_lr = val;
|
||||
frame->tf_elr += 4;
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
void
|
||||
do_el1h_sync(struct trapframe *frame)
|
||||
{
|
||||
|
@ -288,6 +381,10 @@ do_el0_sync(struct trapframe *frame)
|
|||
sv.sival_ptr = (void *)frame->tf_elr;
|
||||
trapsignal(p, SIGILL, esr, ILL_BTCFI, sv);
|
||||
break;
|
||||
case EXCP_MSR:
|
||||
if (emulate_msr(frame, esr))
|
||||
break;
|
||||
/* FALLTHROUGH */
|
||||
case EXCP_FPAC:
|
||||
curcpu()->ci_flush_bp();
|
||||
sv.sival_ptr = (void *)frame->tf_elr;
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: armreg.h,v 1.35 2024/06/23 10:17:16 kettenis Exp $ */
|
||||
/* $OpenBSD: armreg.h,v 1.36 2024/07/24 21:24:18 kettenis Exp $ */
|
||||
/*-
|
||||
* Copyright (c) 2013, 2014 Andrew Turner
|
||||
* Copyright (c) 2015 The FreeBSD Foundation
|
||||
|
@ -171,6 +171,26 @@
|
|||
#define ISS_DATA_DFSC_ECC_L3 (0x1f << 0)
|
||||
#define ISS_DATA_DFSC_ALIGN (0x21 << 0)
|
||||
#define ISS_DATA_DFSC_TLB_CONFLICT (0x30 << 0)
|
||||
#define ISS_MSR_DIR_SHIFT 0
|
||||
#define ISS_MSR_DIR (0x01 << ISS_MSR_DIR_SHIFT)
|
||||
#define ISS_MSR_Rt_SHIFT 5
|
||||
#define ISS_MSR_Rt_MASK (0x1f << ISS_MSR_Rt_SHIFT)
|
||||
#define ISS_MSR_Rt(x) (((x) & ISS_MSR_Rt_MASK) >> ISS_MSR_Rt_SHIFT)
|
||||
#define ISS_MSR_CRm_SHIFT 1
|
||||
#define ISS_MSR_CRm_MASK (0xf << ISS_MSR_CRm_SHIFT)
|
||||
#define ISS_MSR_CRm(x) (((x) & ISS_MSR_CRm_MASK) >> ISS_MSR_CRm_SHIFT)
|
||||
#define ISS_MSR_CRn_SHIFT 10
|
||||
#define ISS_MSR_CRn_MASK (0xf << ISS_MSR_CRn_SHIFT)
|
||||
#define ISS_MSR_CRn(x) (((x) & ISS_MSR_CRn_MASK) >> ISS_MSR_CRn_SHIFT)
|
||||
#define ISS_MSR_OP1_SHIFT 14
|
||||
#define ISS_MSR_OP1_MASK (0x7 << ISS_MSR_OP1_SHIFT)
|
||||
#define ISS_MSR_OP1(x) (((x) & ISS_MSR_OP1_MASK) >> ISS_MSR_OP1_SHIFT)
|
||||
#define ISS_MSR_OP2_SHIFT 17
|
||||
#define ISS_MSR_OP2_MASK (0x7 << ISS_MSR_OP2_SHIFT)
|
||||
#define ISS_MSR_OP2(x) (((x) & ISS_MSR_OP2_MASK) >> ISS_MSR_OP2_SHIFT)
|
||||
#define ISS_MSR_OP0_SHIFT 20
|
||||
#define ISS_MSR_OP0_MASK (0x3 << ISS_MSR_OP0_SHIFT)
|
||||
#define ISS_MSR_OP0(x) (((x) & ISS_MSR_OP0_MASK) >> ISS_MSR_OP0_SHIFT)
|
||||
#define ESR_ELx_IL (0x01 << 25)
|
||||
#define ESR_ELx_EC_SHIFT 26
|
||||
#define ESR_ELx_EC_MASK (0x3f << 26)
|
||||
|
@ -537,6 +557,10 @@
|
|||
#define ID_AA64MMFR2_CCIDX_MASK (0xfULL << ID_AA64MMFR2_CCIDX_SHIFT)
|
||||
#define ID_AA64MMFR2_CCIDX(x) ((x) & ID_AA64MMFR2_CCIDX_MASK)
|
||||
#define ID_AA64MMFR2_CCIDX_IMPL (0x1ULL << ID_AA64MMFR2_CCIDX_SHIFT)
|
||||
#define ID_AA64MMFR2_IDS_SHIFT 36
|
||||
#define ID_AA64MMFR2_IDS_MASK (0xfULL << ID_AA64MMFR2_IDS_SHIFT)
|
||||
#define ID_AA64MMFR2_IDS(x) ((x) & ID_AA64MMFR2_IDS_MASK)
|
||||
#define ID_AA64MMFR2_IDS_IMPL (0x1ULL << ID_AA64MMFR2_IDS_SHIFT)
|
||||
|
||||
/* ID_AA64PFR0_EL1 */
|
||||
#define ID_AA64PFR0_MASK 0xff0fffffffffffffULL
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: cpu.h,v 1.49 2024/07/17 15:21:59 kettenis Exp $ */
|
||||
/* $OpenBSD: cpu.h,v 1.50 2024/07/24 21:24:18 kettenis Exp $ */
|
||||
/*
|
||||
* Copyright (c) 2016 Dale Rahn <drahn@dalerahn.com>
|
||||
*
|
||||
|
@ -64,6 +64,9 @@
|
|||
extern uint64_t cpu_id_aa64isar0;
|
||||
extern uint64_t cpu_id_aa64isar1;
|
||||
extern uint64_t cpu_id_aa64isar2;
|
||||
extern uint64_t cpu_id_aa64mmfr0;
|
||||
extern uint64_t cpu_id_aa64mmfr1;
|
||||
extern uint64_t cpu_id_aa64mmfr2;
|
||||
extern uint64_t cpu_id_aa64pfr0;
|
||||
extern uint64_t cpu_id_aa64pfr1;
|
||||
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: qcpas.c,v 1.2 2023/07/01 15:50:18 drahn Exp $ */
|
||||
/* $OpenBSD: qcpas.c,v 1.3 2024/07/25 20:21:40 kettenis Exp $ */
|
||||
/*
|
||||
* Copyright (c) 2023 Patrick Wildt <patrick@blueri.se>
|
||||
*
|
||||
|
@ -795,13 +795,6 @@ qcpas_glink_recv_open(struct qcpas_softc *sc, uint32_t rcid, uint32_t namelen)
|
|||
return;
|
||||
}
|
||||
|
||||
/* Assume we can leave HW dangling if proto init fails */
|
||||
err = proto->init(NULL);
|
||||
if (err) {
|
||||
free(name, M_TEMP, namelen);
|
||||
return;
|
||||
}
|
||||
|
||||
ch = malloc(sizeof(*ch), M_DEVBUF, M_WAITOK | M_ZERO);
|
||||
ch->ch_sc = sc;
|
||||
ch->ch_proto = proto;
|
||||
|
@ -811,6 +804,15 @@ qcpas_glink_recv_open(struct qcpas_softc *sc, uint32_t rcid, uint32_t namelen)
|
|||
TAILQ_INIT(&ch->ch_r_intents);
|
||||
TAILQ_INSERT_TAIL(&sc->sc_glink_channels, ch, ch_q);
|
||||
|
||||
/* Assume we can leave HW dangling if proto init fails */
|
||||
err = proto->init(ch);
|
||||
if (err) {
|
||||
TAILQ_REMOVE(&sc->sc_glink_channels, ch, ch_q);
|
||||
free(ch, M_TEMP, sizeof(*ch));
|
||||
free(name, M_TEMP, namelen);
|
||||
return;
|
||||
}
|
||||
|
||||
msg.cmd = GLINK_CMD_OPEN_ACK;
|
||||
msg.param1 = ch->ch_rcid;
|
||||
msg.param2 = 0;
|
||||
|
@ -1108,7 +1110,7 @@ struct battmgr_bat_status {
|
|||
#define BATTMGR_BAT_STATE_CHARGING (1 << 1)
|
||||
#define BATTMGR_BAT_STATE_CRITICAL_LOW (1 << 2)
|
||||
uint32_t capacity;
|
||||
uint32_t rate;
|
||||
int32_t rate;
|
||||
uint32_t battery_voltage;
|
||||
uint32_t power_state;
|
||||
#define BATTMGR_PWR_STATE_AC_ON (1 << 0)
|
||||
|
@ -1151,7 +1153,7 @@ qcpas_pmic_rtr_battmgr_req_status(void *cookie)
|
|||
|
||||
#if NAPM > 0
|
||||
struct apm_power_info qcpas_pmic_rtr_apm_power_info;
|
||||
uint32_t qcpas_pmic_rtr_last_full_capacity;
|
||||
void *qcpas_pmic_rtr_apm_cookie;
|
||||
#endif
|
||||
|
||||
int
|
||||
|
@ -1166,6 +1168,7 @@ qcpas_pmic_rtr_init(void *cookie)
|
|||
info->battery_life = 0;
|
||||
info->minutes_left = -1;
|
||||
|
||||
qcpas_pmic_rtr_apm_cookie = cookie;
|
||||
apm_setinfohook(qcpas_pmic_rtr_apminfo);
|
||||
#endif
|
||||
return 0;
|
||||
|
@ -1174,6 +1177,9 @@ qcpas_pmic_rtr_init(void *cookie)
|
|||
int
|
||||
qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
||||
{
|
||||
#if NAPM > 0
|
||||
static uint32_t last_full_capacity;
|
||||
#endif
|
||||
struct pmic_glink_hdr hdr;
|
||||
uint32_t notification;
|
||||
extern int hw_power;
|
||||
|
@ -1221,8 +1227,7 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
bat = malloc(sizeof(*bat), M_TEMP, M_WAITOK);
|
||||
memcpy((void *)bat, buf + sizeof(hdr), sizeof(*bat));
|
||||
#if NAPM > 0
|
||||
qcpas_pmic_rtr_last_full_capacity =
|
||||
bat->last_full_capacity;
|
||||
last_full_capacity = bat->last_full_capacity;
|
||||
#endif
|
||||
free(bat, M_TEMP, sizeof(*bat));
|
||||
break;
|
||||
|
@ -1231,6 +1236,7 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
struct battmgr_bat_status *bat;
|
||||
#if NAPM > 0
|
||||
struct apm_power_info *info;
|
||||
uint32_t delta;
|
||||
#endif
|
||||
if (len - sizeof(hdr) != sizeof(*bat)) {
|
||||
printf("%s: invalid battgmr bat status\n",
|
||||
|
@ -1239,15 +1245,17 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
}
|
||||
#if NAPM > 0
|
||||
/* Needs BAT_INFO fist */
|
||||
if (!qcpas_pmic_rtr_last_full_capacity)
|
||||
if (last_full_capacity == 0) {
|
||||
wakeup(&qcpas_pmic_rtr_apm_power_info);
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
bat = malloc(sizeof(*bat), M_TEMP, M_WAITOK);
|
||||
memcpy((void *)bat, buf + sizeof(hdr), sizeof(*bat));
|
||||
#if NAPM > 0
|
||||
info = &qcpas_pmic_rtr_apm_power_info;
|
||||
info->battery_life = ((bat->capacity * 100) /
|
||||
qcpas_pmic_rtr_last_full_capacity);
|
||||
last_full_capacity);
|
||||
if (info->battery_life > 50)
|
||||
info->battery_state = APM_BATT_HIGH;
|
||||
else if (info->battery_life > 25)
|
||||
|
@ -1259,6 +1267,16 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
else if (bat->battery_state & BATTMGR_BAT_STATE_CRITICAL_LOW)
|
||||
info->battery_state = APM_BATT_CRITICAL;
|
||||
|
||||
if (bat->rate < 0)
|
||||
delta = bat->capacity;
|
||||
else
|
||||
delta = last_full_capacity - bat->capacity;
|
||||
if (bat->rate == 0)
|
||||
info->minutes_left = -1;
|
||||
else
|
||||
info->minutes_left =
|
||||
(60 * delta) / abs(bat->rate);
|
||||
|
||||
if (bat->power_state & BATTMGR_PWR_STATE_AC_ON) {
|
||||
info->ac_state = APM_AC_ON;
|
||||
hw_power = 1;
|
||||
|
@ -1266,6 +1284,7 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
info->ac_state = APM_AC_OFF;
|
||||
hw_power = 0;
|
||||
}
|
||||
wakeup(&qcpas_pmic_rtr_apm_power_info);
|
||||
#endif
|
||||
free(bat, M_TEMP, sizeof(*bat));
|
||||
break;
|
||||
|
@ -1289,8 +1308,15 @@ qcpas_pmic_rtr_recv(void *cookie, uint8_t *buf, int len)
|
|||
int
|
||||
qcpas_pmic_rtr_apminfo(struct apm_power_info *info)
|
||||
{
|
||||
memcpy(info, &qcpas_pmic_rtr_apm_power_info, sizeof(*info));
|
||||
int error;
|
||||
|
||||
qcpas_pmic_rtr_battmgr_req_status(qcpas_pmic_rtr_apm_cookie);
|
||||
error = tsleep_nsec(&qcpas_pmic_rtr_apm_power_info, PWAIT | PCATCH,
|
||||
"qcapm", SEC_TO_NSEC(5));
|
||||
if (error)
|
||||
return error;
|
||||
|
||||
memcpy(info, &qcpas_pmic_rtr_apm_power_info, sizeof(*info));
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
|
|
@ -1,4 +1,4 @@
|
|||
/* $OpenBSD: virtio.c,v 1.26 2024/07/23 19:14:05 sf Exp $ */
|
||||
/* $OpenBSD: virtio.c,v 1.27 2024/07/25 08:35:40 sf Exp $ */
|
||||
/* $NetBSD: virtio.c,v 1.3 2011/11/02 23:05:52 njoly Exp $ */
|
||||
|
||||
/*
|
||||
|
@ -946,21 +946,43 @@ virtio_nused(struct virtqueue *vq)
|
|||
void
|
||||
virtio_vq_dump(struct virtqueue *vq)
|
||||
{
|
||||
#if VIRTIO_DEBUG >= 2
|
||||
int i;
|
||||
#endif
|
||||
/* Common fields */
|
||||
printf(" + addr: %p\n", vq);
|
||||
printf(" + vq num: %d\n", vq->vq_num);
|
||||
printf(" + vq mask: 0x%X\n", vq->vq_mask);
|
||||
printf(" + vq index: %d\n", vq->vq_index);
|
||||
printf(" + vq used idx: %d\n", vq->vq_used_idx);
|
||||
printf(" + vq avail idx: %d\n", vq->vq_avail_idx);
|
||||
printf(" + vq queued: %d\n",vq->vq_queued);
|
||||
#if VIRTIO_DEBUG >= 2
|
||||
for (i = 0; i < vq->vq_num; i++) {
|
||||
struct vring_desc *desc = &vq->vq_desc[i];
|
||||
printf(" D%-3d len:%d flags:%d next:%d\n", i, desc->len,
|
||||
desc->flags, desc->next);
|
||||
}
|
||||
#endif
|
||||
/* Avail ring fields */
|
||||
printf(" + avail flags: 0x%X\n", vq->vq_avail->flags);
|
||||
printf(" + avail idx: %d\n", vq->vq_avail->idx);
|
||||
printf(" + avail event: %d\n", VQ_AVAIL_EVENT(vq));
|
||||
#if VIRTIO_DEBUG >= 2
|
||||
for (i = 0; i < vq->vq_num; i++)
|
||||
printf(" A%-3d idx:%d\n", i, vq->vq_avail->ring[i]);
|
||||
#endif
|
||||
/* Used ring fields */
|
||||
printf(" + used flags: 0x%X\n",vq->vq_used->flags);
|
||||
printf(" + used idx: %d\n",vq->vq_used->idx);
|
||||
printf(" + used event: %d\n", VQ_USED_EVENT(vq));
|
||||
#if VIRTIO_DEBUG >= 2
|
||||
for (i = 0; i < vq->vq_num; i++) {
|
||||
printf(" U%-3d id:%d len:%d\n", i,
|
||||
vq->vq_used->ring[i].id,
|
||||
vq->vq_used->ring[i].len);
|
||||
}
|
||||
#endif
|
||||
printf(" +++++++++++++++++++++++++++\n");
|
||||
}
|
||||
#endif
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue