mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2026-11-19 18:21:41 +00:00
mask_len counts mask bits: it is derived from vlenb * 8, and the mask
indexing below divides by 8 to turn a bit index into a byte index.
get_vreg() counts bytes: its size argument feeds "vsetvli x0, %0, e8,
m8" and a vse8.v, both of which operate on 8-bit elements.
Both emulators pass mask_len directly as get_vreg()'s size, so the
firmware writes eight times more than intended into mask[], a
MASK_BUFFLEN / 8 == 128 byte stack buffer. The write stays in bounds
only while vlenb * 8 <= 128, that is VLEN <= 128. Above that it runs
past the end of the buffer and corrupts the M-mode stack, including the
saved return address.
The pre-rework code passed vlenb, a byte count, which was correct; the
chunked version replaced it with a bit count.
Reachable from S-mode or U-mode with a single masked, misaligned vector
load or store on a hart whose VLEN exceeds 128 bits. Observed on
qemu-system-riscv64 with -cpu rv64,v=true,vlen=256,zicclsm=false: the
firmware takes an instruction access fault in M-mode with mepc and ra
both zero. The same payload at vlen=128 enters the emulator and
completes normally.
Convert pos and size to bytes at both call sites. mask_len is a power of
two and at least 8, and pos is already a multiple of mask_len, so both
divisions are exact.
Fixes: a8be5e94 ("lib: sbi: Rework misaligned vector load/store")
Signed-off-by: Sebastian Alba Vives <sebasjosue84@gmail.com>
Reviewed-by: Anup Patel <anup@brainfault.org>
Link: https://lore.kernel.org/r/20260922030633.10886-1-sebasjosue84@gmail.com
Signed-off-by: Anup Patel <anup@brainfault.org>
397 lines
9.6 KiB
C
397 lines
9.6 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2024 SiFive Inc.
|
|
*
|
|
* Authors:
|
|
* Andrew Waterman <andrew@sifive.com>
|
|
* Nylon Chen <nylon.chen@sifive.com>
|
|
* Zong Li <nylon.chen@sifive.com>
|
|
*/
|
|
|
|
#include <sbi/riscv_asm.h>
|
|
#include <sbi/riscv_encoding.h>
|
|
#include <sbi/sbi_bitops.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_trap_ldst.h>
|
|
#include <sbi/sbi_trap.h>
|
|
#include <sbi/sbi_unpriv.h>
|
|
#include <sbi/sbi_vector.h>
|
|
|
|
#ifdef OPENSBI_CC_SUPPORT_VECTOR
|
|
|
|
#define MASK_BUFFLEN 1024
|
|
|
|
static inline void set_vreg(ulong vlenb, ulong which,
|
|
ulong pos, ulong size, const uint8_t *bytes)
|
|
{
|
|
pos += (which % 8) * vlenb;
|
|
bytes -= pos;
|
|
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vsetvli x0, %0, e8, m8, tu, ma\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (pos + size));
|
|
|
|
csr_write(CSR_VSTART, pos);
|
|
|
|
switch (which / 8) {
|
|
case 0:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vle8.v v0, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 1:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vle8.v v8, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 2:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vle8.v v16, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 3:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vle8.v v24, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static inline void get_vreg(ulong vlenb, ulong which,
|
|
ulong pos, ulong size, uint8_t *bytes)
|
|
{
|
|
pos += (which % 8) * vlenb;
|
|
bytes -= pos;
|
|
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vsetvli x0, %0, e8, m8, tu, ma\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (pos + size));
|
|
|
|
csr_write(CSR_VSTART, pos);
|
|
|
|
switch (which / 8) {
|
|
case 0:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vse8.v v0, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 1:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vse8.v v8, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 2:
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vse8.v v16, (%0)\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
case 3:
|
|
asm volatile (
|
|
".option push\n\t"
|
|
".option arch, +v\n\t"
|
|
"vse8.v v24, (%0)\n\t"
|
|
".option pop\n\t"
|
|
:: "r" (bytes) : "memory");
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static inline void vsetvl(ulong vl, ulong vtype)
|
|
{
|
|
asm volatile (
|
|
" .option push\n\t"
|
|
" .option arch, +v\n\t"
|
|
" vsetvl x0, %0, %1\n\t"
|
|
" .option pop\n\t"
|
|
:: "r" (vl), "r" (vtype));
|
|
}
|
|
|
|
/**
|
|
* Handling of misaligned fault is done by a collection of smaller, but
|
|
* aligned load/store(s). Another fault (load/store, page fault...) can
|
|
* arise from any of them, then the handling gets aborted. We must fixup
|
|
* the tinst to pretend the fault was rised from the original insn. For
|
|
* vector insn, simply null out tinst if it's not a guest-page fault, as
|
|
* there's no transformed insn for vector load/store
|
|
*/
|
|
static inline void sbi_misaligned_v_tinst_fixup(struct sbi_trap_info *uptrap)
|
|
{
|
|
/*
|
|
* The function is called in code path for handling a vector
|
|
* load/store misaligned fault, thus the new uptrap can't have
|
|
* custom value of tinst
|
|
*/
|
|
if (uptrap->tinst == INSN_PSEUDO_VS_LOAD ||
|
|
uptrap->tinst == INSN_PSEUDO_VS_STORE)
|
|
/* Use uptrap as-is for guest-page faults */
|
|
return;
|
|
|
|
uptrap->tinst = 0;
|
|
}
|
|
|
|
int sbi_misaligned_v_ld_emulator(ulong insn, struct sbi_trap_context *tcntx)
|
|
{
|
|
struct sbi_trap_regs *regs = &tcntx->regs;
|
|
struct sbi_trap_info uptrap;
|
|
ulong vl = csr_read(CSR_VL);
|
|
ulong vtype = csr_read(CSR_VTYPE);
|
|
ulong vlenb = csr_read(CSR_VLENB);
|
|
ulong vstart = csr_read(CSR_VSTART), orig_vstart = vstart;
|
|
ulong base = GET_RS1(insn, regs);
|
|
ulong stride = GET_RS2(insn, regs);
|
|
ulong vd = GET_VD(insn);
|
|
ulong vs2 = GET_VS2(insn);
|
|
ulong view = GET_VIEW(insn);
|
|
ulong vsew = GET_VSEW(vtype);
|
|
ulong vlmul = GET_VLMUL(vtype);
|
|
bool illegal = GET_MEW(insn);
|
|
bool masked = IS_MASKED(insn);
|
|
uint8_t mask[MASK_BUFFLEN / 8];
|
|
uint8_t bytes[8 * sizeof(uint64_t)];
|
|
ulong mask_len = MASK_BUFFLEN < vlenb * 8 ? MASK_BUFFLEN : vlenb * 8;
|
|
ulong len = GET_LEN(view);
|
|
ulong nf = GET_NF(insn);
|
|
ulong vemul = GET_VEMUL(vlmul, view, vsew);
|
|
ulong emul = GET_EMUL(vemul);
|
|
|
|
if (IS_UNIT_STRIDE_LOAD(insn) || IS_FAULT_ONLY_FIRST_LOAD(insn)) {
|
|
stride = nf * len;
|
|
} else if (IS_WHOLE_REG_LOAD(insn)) {
|
|
vl = (nf * vlenb) >> view;
|
|
nf = 1;
|
|
vemul = 0;
|
|
emul = 1;
|
|
stride = nf * len;
|
|
} else if (IS_INDEXED_LOAD(insn)) {
|
|
len = 1 << vsew;
|
|
vemul = (vlmul + vsew - vsew) & 7;
|
|
emul = 1 << ((vemul & 4) ? 0 : vemul);
|
|
stride = nf * len;
|
|
}
|
|
|
|
if (illegal) {
|
|
struct sbi_trap_info trap = {
|
|
uptrap.cause = CAUSE_ILLEGAL_INSTRUCTION,
|
|
uptrap.tval = insn,
|
|
};
|
|
return sbi_trap_redirect(regs, &trap);
|
|
}
|
|
|
|
do {
|
|
if (masked) {
|
|
if (vstart == orig_vstart || vstart % mask_len == 0)
|
|
/* Fetch a mask_len chunk of mask */
|
|
get_vreg(vlenb, 0,
|
|
vstart / mask_len * mask_len / 8,
|
|
mask_len / 8, mask);
|
|
|
|
if (~mask[vstart % mask_len / 8] & BIT(vstart % 8))
|
|
continue;
|
|
}
|
|
|
|
/* compute element address */
|
|
ulong addr = base + vstart * stride;
|
|
|
|
if (IS_INDEXED_LOAD(insn)) {
|
|
ulong offset = 0;
|
|
|
|
get_vreg(vlenb, vs2, vstart << view, 1 << view, (uint8_t *)&offset);
|
|
addr = base + offset;
|
|
}
|
|
|
|
csr_write(CSR_VSTART, vstart);
|
|
|
|
/* obtain load data from memory */
|
|
for (ulong seg = 0; seg < nf; seg++) {
|
|
sbi_load_loop(bytes + seg * len,
|
|
addr + seg * len, len, &uptrap);
|
|
|
|
if (!uptrap.cause)
|
|
continue;
|
|
|
|
if (IS_FAULT_ONLY_FIRST_LOAD(insn) && vstart != 0) {
|
|
vl = vstart;
|
|
goto done;
|
|
}
|
|
|
|
vsetvl(vl, vtype);
|
|
csr_write(CSR_VSTART, vstart);
|
|
/* Don't forget to set dirty if vstart has changed */
|
|
if (vstart != orig_vstart)
|
|
SET_VS_DIRTY(regs);
|
|
sbi_misaligned_v_tinst_fixup(&uptrap);
|
|
return sbi_trap_redirect(regs, &uptrap);
|
|
}
|
|
|
|
/* write load data to regfile */
|
|
for (ulong seg = 0; seg < nf; seg++)
|
|
set_vreg(vlenb, vd + seg * emul, vstart * len,
|
|
len, &bytes[seg * len]);
|
|
} while (++vstart < vl);
|
|
|
|
done:
|
|
/* restore clobbered vl/vtype */
|
|
vsetvl(vl, vtype); // VSTART resets to 0
|
|
|
|
/*
|
|
* At least 1 element is processed, or vl is changed above in
|
|
* the FAULT_ONLY_FIRST_LOAD path, thus set dirty.
|
|
*/
|
|
SET_VS_DIRTY(regs);
|
|
|
|
/* Return a >0 value for the caller to advance mepc */
|
|
return 1;
|
|
}
|
|
|
|
int sbi_misaligned_v_st_emulator(ulong insn, struct sbi_trap_context *tcntx)
|
|
{
|
|
struct sbi_trap_regs *regs = &tcntx->regs;
|
|
struct sbi_trap_info uptrap;
|
|
ulong vl = csr_read(CSR_VL);
|
|
ulong vtype = csr_read(CSR_VTYPE);
|
|
ulong vlenb = csr_read(CSR_VLENB);
|
|
ulong vstart = csr_read(CSR_VSTART), orig_vstart = vstart;
|
|
ulong base = GET_RS1(insn, regs);
|
|
ulong stride = GET_RS2(insn, regs);
|
|
ulong vd = GET_VD(insn);
|
|
ulong vs2 = GET_VS2(insn);
|
|
ulong view = GET_VIEW(insn);
|
|
ulong vsew = GET_VSEW(vtype);
|
|
ulong vlmul = GET_VLMUL(vtype);
|
|
bool illegal = GET_MEW(insn);
|
|
bool masked = IS_MASKED(insn);
|
|
uint8_t mask[MASK_BUFFLEN / 8];
|
|
uint8_t bytes[8 * sizeof(uint64_t)];
|
|
ulong mask_len = MASK_BUFFLEN < vlenb * 8 ? MASK_BUFFLEN : vlenb * 8;
|
|
ulong len = GET_LEN(view);
|
|
ulong nf = GET_NF(insn);
|
|
ulong vemul = GET_VEMUL(vlmul, view, vsew);
|
|
ulong emul = GET_EMUL(vemul);
|
|
|
|
if (IS_UNIT_STRIDE_STORE(insn)) {
|
|
stride = nf * len;
|
|
} else if (IS_WHOLE_REG_STORE(insn)) {
|
|
vl = (nf * vlenb) >> view;
|
|
nf = 1;
|
|
vemul = 0;
|
|
emul = 1;
|
|
stride = nf * len;
|
|
} else if (IS_INDEXED_STORE(insn)) {
|
|
len = 1 << vsew;
|
|
vemul = (vlmul + vsew - vsew) & 7;
|
|
emul = 1 << ((vemul & 4) ? 0 : vemul);
|
|
stride = nf * len;
|
|
}
|
|
|
|
if (illegal) {
|
|
struct sbi_trap_info trap = {
|
|
uptrap.cause = CAUSE_ILLEGAL_INSTRUCTION,
|
|
uptrap.tval = insn,
|
|
};
|
|
return sbi_trap_redirect(regs, &trap);
|
|
}
|
|
|
|
do {
|
|
if (masked) {
|
|
if (vstart == orig_vstart || vstart % mask_len == 0)
|
|
/* Fetch a mask_len chunk of mask */
|
|
get_vreg(vlenb, 0,
|
|
vstart / mask_len * mask_len / 8,
|
|
mask_len / 8, mask);
|
|
|
|
if (~mask[vstart % mask_len / 8] & BIT(vstart % 8))
|
|
continue;
|
|
}
|
|
|
|
/* compute element address */
|
|
ulong addr = base + vstart * stride;
|
|
|
|
if (IS_INDEXED_STORE(insn)) {
|
|
ulong offset = 0;
|
|
|
|
get_vreg(vlenb, vs2, vstart << view, 1 << view, (uint8_t *)&offset);
|
|
addr = base + offset;
|
|
}
|
|
|
|
/* obtain store data from regfile */
|
|
for (ulong seg = 0; seg < nf; seg++)
|
|
get_vreg(vlenb, vd + seg * emul, vstart * len,
|
|
len, &bytes[seg * len]);
|
|
|
|
/* write store data to memory */
|
|
for (ulong seg = 0; seg < nf; seg++) {
|
|
sbi_store_loop(bytes + seg * len,
|
|
addr + seg * len, len, &uptrap);
|
|
|
|
if (!uptrap.cause)
|
|
continue;
|
|
|
|
vsetvl(vl, vtype);
|
|
csr_write(CSR_VSTART, vstart);
|
|
/* Don't forget to set dirty if vstart has changed */
|
|
if (vstart != orig_vstart)
|
|
SET_VS_DIRTY(regs);
|
|
sbi_misaligned_v_tinst_fixup(&uptrap);
|
|
return sbi_trap_redirect(regs, &uptrap);
|
|
}
|
|
} while (++vstart < vl);
|
|
|
|
/* restore clobbered vl/vtype */
|
|
vsetvl(vl, vtype); // VSTART resets to 0
|
|
|
|
/*
|
|
* No need to set dirty for memory store, but as VSTART resets to
|
|
* 0 above, need to set dirty if it's originally not 0.
|
|
*/
|
|
if (orig_vstart != 0)
|
|
SET_VS_DIRTY(regs);
|
|
|
|
/* Return a >0 value for the caller to advance mepc */
|
|
return 1;
|
|
}
|
|
#else
|
|
int sbi_misaligned_v_ld_emulator(ulong insn, struct sbi_trap_context *tcntx)
|
|
{
|
|
/* Unable to emulate, send trap to previous mode. */
|
|
return sbi_trap_redirect(&tcntx->regs, &tcntx->trap);
|
|
}
|
|
|
|
int sbi_misaligned_v_st_emulator(ulong insn, struct sbi_trap_context *tcntx)
|
|
{
|
|
/* Unable to emulate, send trap to previous mode. */
|
|
return sbi_trap_redirect(&tcntx->regs, &tcntx->trap);
|
|
}
|
|
#endif /* OPENSBI_CC_SUPPORT_VECTOR */
|