162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* BPF JIT compiler for RV64G 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Copyright(c) 2019 Björn Töpel <bjorn.topel@gmail.com> 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/bitfield.h> 962306a36Sopenharmony_ci#include <linux/bpf.h> 1062306a36Sopenharmony_ci#include <linux/filter.h> 1162306a36Sopenharmony_ci#include <linux/memory.h> 1262306a36Sopenharmony_ci#include <linux/stop_machine.h> 1362306a36Sopenharmony_ci#include <asm/patch.h> 1462306a36Sopenharmony_ci#include "bpf_jit.h" 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#define RV_FENTRY_NINSNS 2 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#define RV_REG_TCC RV_REG_A6 1962306a36Sopenharmony_ci#define RV_REG_TCC_SAVED RV_REG_S6 /* Store A6 in S6 if program do calls */ 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic const int regmap[] = { 2262306a36Sopenharmony_ci [BPF_REG_0] = RV_REG_A5, 2362306a36Sopenharmony_ci [BPF_REG_1] = RV_REG_A0, 2462306a36Sopenharmony_ci [BPF_REG_2] = RV_REG_A1, 2562306a36Sopenharmony_ci [BPF_REG_3] = RV_REG_A2, 2662306a36Sopenharmony_ci [BPF_REG_4] = RV_REG_A3, 2762306a36Sopenharmony_ci [BPF_REG_5] = RV_REG_A4, 2862306a36Sopenharmony_ci [BPF_REG_6] = RV_REG_S1, 2962306a36Sopenharmony_ci [BPF_REG_7] = RV_REG_S2, 3062306a36Sopenharmony_ci [BPF_REG_8] = RV_REG_S3, 3162306a36Sopenharmony_ci [BPF_REG_9] = RV_REG_S4, 3262306a36Sopenharmony_ci [BPF_REG_FP] = RV_REG_S5, 3362306a36Sopenharmony_ci [BPF_REG_AX] = RV_REG_T0, 3462306a36Sopenharmony_ci}; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_cistatic const int pt_regmap[] = { 3762306a36Sopenharmony_ci [RV_REG_A0] = offsetof(struct pt_regs, a0), 3862306a36Sopenharmony_ci [RV_REG_A1] = offsetof(struct pt_regs, a1), 3962306a36Sopenharmony_ci [RV_REG_A2] = offsetof(struct pt_regs, a2), 4062306a36Sopenharmony_ci [RV_REG_A3] = offsetof(struct pt_regs, a3), 4162306a36Sopenharmony_ci [RV_REG_A4] = offsetof(struct pt_regs, a4), 4262306a36Sopenharmony_ci [RV_REG_A5] = offsetof(struct pt_regs, a5), 4362306a36Sopenharmony_ci [RV_REG_S1] = offsetof(struct pt_regs, s1), 4462306a36Sopenharmony_ci [RV_REG_S2] = offsetof(struct pt_regs, s2), 4562306a36Sopenharmony_ci [RV_REG_S3] = offsetof(struct pt_regs, s3), 4662306a36Sopenharmony_ci [RV_REG_S4] = offsetof(struct pt_regs, s4), 4762306a36Sopenharmony_ci [RV_REG_S5] = offsetof(struct pt_regs, s5), 4862306a36Sopenharmony_ci [RV_REG_T0] = offsetof(struct pt_regs, t0), 4962306a36Sopenharmony_ci}; 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_cienum { 5262306a36Sopenharmony_ci RV_CTX_F_SEEN_TAIL_CALL = 0, 5362306a36Sopenharmony_ci RV_CTX_F_SEEN_CALL = RV_REG_RA, 5462306a36Sopenharmony_ci RV_CTX_F_SEEN_S1 = RV_REG_S1, 5562306a36Sopenharmony_ci RV_CTX_F_SEEN_S2 = RV_REG_S2, 5662306a36Sopenharmony_ci RV_CTX_F_SEEN_S3 = RV_REG_S3, 5762306a36Sopenharmony_ci RV_CTX_F_SEEN_S4 = RV_REG_S4, 5862306a36Sopenharmony_ci RV_CTX_F_SEEN_S5 = RV_REG_S5, 5962306a36Sopenharmony_ci RV_CTX_F_SEEN_S6 = RV_REG_S6, 6062306a36Sopenharmony_ci}; 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_cistatic u8 bpf_to_rv_reg(int bpf_reg, struct rv_jit_context *ctx) 6362306a36Sopenharmony_ci{ 6462306a36Sopenharmony_ci u8 reg = regmap[bpf_reg]; 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci switch (reg) { 6762306a36Sopenharmony_ci case RV_CTX_F_SEEN_S1: 6862306a36Sopenharmony_ci case RV_CTX_F_SEEN_S2: 6962306a36Sopenharmony_ci case RV_CTX_F_SEEN_S3: 7062306a36Sopenharmony_ci case RV_CTX_F_SEEN_S4: 7162306a36Sopenharmony_ci case RV_CTX_F_SEEN_S5: 7262306a36Sopenharmony_ci case RV_CTX_F_SEEN_S6: 7362306a36Sopenharmony_ci __set_bit(reg, &ctx->flags); 7462306a36Sopenharmony_ci } 7562306a36Sopenharmony_ci return reg; 7662306a36Sopenharmony_ci}; 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cistatic bool seen_reg(int reg, struct rv_jit_context *ctx) 7962306a36Sopenharmony_ci{ 8062306a36Sopenharmony_ci switch (reg) { 8162306a36Sopenharmony_ci case RV_CTX_F_SEEN_CALL: 8262306a36Sopenharmony_ci case RV_CTX_F_SEEN_S1: 8362306a36Sopenharmony_ci case RV_CTX_F_SEEN_S2: 8462306a36Sopenharmony_ci case RV_CTX_F_SEEN_S3: 8562306a36Sopenharmony_ci case RV_CTX_F_SEEN_S4: 8662306a36Sopenharmony_ci case RV_CTX_F_SEEN_S5: 8762306a36Sopenharmony_ci case RV_CTX_F_SEEN_S6: 8862306a36Sopenharmony_ci return test_bit(reg, &ctx->flags); 8962306a36Sopenharmony_ci } 9062306a36Sopenharmony_ci return false; 9162306a36Sopenharmony_ci} 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_cistatic void mark_fp(struct rv_jit_context *ctx) 9462306a36Sopenharmony_ci{ 9562306a36Sopenharmony_ci __set_bit(RV_CTX_F_SEEN_S5, &ctx->flags); 9662306a36Sopenharmony_ci} 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_cistatic void mark_call(struct rv_jit_context *ctx) 9962306a36Sopenharmony_ci{ 10062306a36Sopenharmony_ci __set_bit(RV_CTX_F_SEEN_CALL, &ctx->flags); 10162306a36Sopenharmony_ci} 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_cistatic bool seen_call(struct rv_jit_context *ctx) 10462306a36Sopenharmony_ci{ 10562306a36Sopenharmony_ci return test_bit(RV_CTX_F_SEEN_CALL, &ctx->flags); 10662306a36Sopenharmony_ci} 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_cistatic void mark_tail_call(struct rv_jit_context *ctx) 10962306a36Sopenharmony_ci{ 11062306a36Sopenharmony_ci __set_bit(RV_CTX_F_SEEN_TAIL_CALL, &ctx->flags); 11162306a36Sopenharmony_ci} 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_cistatic bool seen_tail_call(struct rv_jit_context *ctx) 11462306a36Sopenharmony_ci{ 11562306a36Sopenharmony_ci return test_bit(RV_CTX_F_SEEN_TAIL_CALL, &ctx->flags); 11662306a36Sopenharmony_ci} 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_cistatic u8 rv_tail_call_reg(struct rv_jit_context *ctx) 11962306a36Sopenharmony_ci{ 12062306a36Sopenharmony_ci mark_tail_call(ctx); 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_ci if (seen_call(ctx)) { 12362306a36Sopenharmony_ci __set_bit(RV_CTX_F_SEEN_S6, &ctx->flags); 12462306a36Sopenharmony_ci return RV_REG_S6; 12562306a36Sopenharmony_ci } 12662306a36Sopenharmony_ci return RV_REG_A6; 12762306a36Sopenharmony_ci} 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_cistatic bool is_32b_int(s64 val) 13062306a36Sopenharmony_ci{ 13162306a36Sopenharmony_ci return -(1L << 31) <= val && val < (1L << 31); 13262306a36Sopenharmony_ci} 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_cistatic bool in_auipc_jalr_range(s64 val) 13562306a36Sopenharmony_ci{ 13662306a36Sopenharmony_ci /* 13762306a36Sopenharmony_ci * auipc+jalr can reach any signed PC-relative offset in the range 13862306a36Sopenharmony_ci * [-2^31 - 2^11, 2^31 - 2^11). 13962306a36Sopenharmony_ci */ 14062306a36Sopenharmony_ci return (-(1L << 31) - (1L << 11)) <= val && 14162306a36Sopenharmony_ci val < ((1L << 31) - (1L << 11)); 14262306a36Sopenharmony_ci} 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_ci/* Emit fixed-length instructions for address */ 14562306a36Sopenharmony_cistatic int emit_addr(u8 rd, u64 addr, bool extra_pass, struct rv_jit_context *ctx) 14662306a36Sopenharmony_ci{ 14762306a36Sopenharmony_ci /* 14862306a36Sopenharmony_ci * Use the ro_insns(RX) to calculate the offset as the BPF program will 14962306a36Sopenharmony_ci * finally run from this memory region. 15062306a36Sopenharmony_ci */ 15162306a36Sopenharmony_ci u64 ip = (u64)(ctx->ro_insns + ctx->ninsns); 15262306a36Sopenharmony_ci s64 off = addr - ip; 15362306a36Sopenharmony_ci s64 upper = (off + (1 << 11)) >> 12; 15462306a36Sopenharmony_ci s64 lower = off & 0xfff; 15562306a36Sopenharmony_ci 15662306a36Sopenharmony_ci if (extra_pass && !in_auipc_jalr_range(off)) { 15762306a36Sopenharmony_ci pr_err("bpf-jit: target offset 0x%llx is out of range\n", off); 15862306a36Sopenharmony_ci return -ERANGE; 15962306a36Sopenharmony_ci } 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci emit(rv_auipc(rd, upper), ctx); 16262306a36Sopenharmony_ci emit(rv_addi(rd, rd, lower), ctx); 16362306a36Sopenharmony_ci return 0; 16462306a36Sopenharmony_ci} 16562306a36Sopenharmony_ci 16662306a36Sopenharmony_ci/* Emit variable-length instructions for 32-bit and 64-bit imm */ 16762306a36Sopenharmony_cistatic void emit_imm(u8 rd, s64 val, struct rv_jit_context *ctx) 16862306a36Sopenharmony_ci{ 16962306a36Sopenharmony_ci /* Note that the immediate from the add is sign-extended, 17062306a36Sopenharmony_ci * which means that we need to compensate this by adding 2^12, 17162306a36Sopenharmony_ci * when the 12th bit is set. A simpler way of doing this, and 17262306a36Sopenharmony_ci * getting rid of the check, is to just add 2**11 before the 17362306a36Sopenharmony_ci * shift. The "Loading a 32-Bit constant" example from the 17462306a36Sopenharmony_ci * "Computer Organization and Design, RISC-V edition" book by 17562306a36Sopenharmony_ci * Patterson/Hennessy highlights this fact. 17662306a36Sopenharmony_ci * 17762306a36Sopenharmony_ci * This also means that we need to process LSB to MSB. 17862306a36Sopenharmony_ci */ 17962306a36Sopenharmony_ci s64 upper = (val + (1 << 11)) >> 12; 18062306a36Sopenharmony_ci /* Sign-extend lower 12 bits to 64 bits since immediates for li, addiw, 18162306a36Sopenharmony_ci * and addi are signed and RVC checks will perform signed comparisons. 18262306a36Sopenharmony_ci */ 18362306a36Sopenharmony_ci s64 lower = ((val & 0xfff) << 52) >> 52; 18462306a36Sopenharmony_ci int shift; 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci if (is_32b_int(val)) { 18762306a36Sopenharmony_ci if (upper) 18862306a36Sopenharmony_ci emit_lui(rd, upper, ctx); 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ci if (!upper) { 19162306a36Sopenharmony_ci emit_li(rd, lower, ctx); 19262306a36Sopenharmony_ci return; 19362306a36Sopenharmony_ci } 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_ci emit_addiw(rd, rd, lower, ctx); 19662306a36Sopenharmony_ci return; 19762306a36Sopenharmony_ci } 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci shift = __ffs(upper); 20062306a36Sopenharmony_ci upper >>= shift; 20162306a36Sopenharmony_ci shift += 12; 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci emit_imm(rd, upper, ctx); 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci emit_slli(rd, rd, shift, ctx); 20662306a36Sopenharmony_ci if (lower) 20762306a36Sopenharmony_ci emit_addi(rd, rd, lower, ctx); 20862306a36Sopenharmony_ci} 20962306a36Sopenharmony_ci 21062306a36Sopenharmony_cistatic void __build_epilogue(bool is_tail_call, struct rv_jit_context *ctx) 21162306a36Sopenharmony_ci{ 21262306a36Sopenharmony_ci int stack_adjust = ctx->stack_size, store_offset = stack_adjust - 8; 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_ci if (seen_reg(RV_REG_RA, ctx)) { 21562306a36Sopenharmony_ci emit_ld(RV_REG_RA, store_offset, RV_REG_SP, ctx); 21662306a36Sopenharmony_ci store_offset -= 8; 21762306a36Sopenharmony_ci } 21862306a36Sopenharmony_ci emit_ld(RV_REG_FP, store_offset, RV_REG_SP, ctx); 21962306a36Sopenharmony_ci store_offset -= 8; 22062306a36Sopenharmony_ci if (seen_reg(RV_REG_S1, ctx)) { 22162306a36Sopenharmony_ci emit_ld(RV_REG_S1, store_offset, RV_REG_SP, ctx); 22262306a36Sopenharmony_ci store_offset -= 8; 22362306a36Sopenharmony_ci } 22462306a36Sopenharmony_ci if (seen_reg(RV_REG_S2, ctx)) { 22562306a36Sopenharmony_ci emit_ld(RV_REG_S2, store_offset, RV_REG_SP, ctx); 22662306a36Sopenharmony_ci store_offset -= 8; 22762306a36Sopenharmony_ci } 22862306a36Sopenharmony_ci if (seen_reg(RV_REG_S3, ctx)) { 22962306a36Sopenharmony_ci emit_ld(RV_REG_S3, store_offset, RV_REG_SP, ctx); 23062306a36Sopenharmony_ci store_offset -= 8; 23162306a36Sopenharmony_ci } 23262306a36Sopenharmony_ci if (seen_reg(RV_REG_S4, ctx)) { 23362306a36Sopenharmony_ci emit_ld(RV_REG_S4, store_offset, RV_REG_SP, ctx); 23462306a36Sopenharmony_ci store_offset -= 8; 23562306a36Sopenharmony_ci } 23662306a36Sopenharmony_ci if (seen_reg(RV_REG_S5, ctx)) { 23762306a36Sopenharmony_ci emit_ld(RV_REG_S5, store_offset, RV_REG_SP, ctx); 23862306a36Sopenharmony_ci store_offset -= 8; 23962306a36Sopenharmony_ci } 24062306a36Sopenharmony_ci if (seen_reg(RV_REG_S6, ctx)) { 24162306a36Sopenharmony_ci emit_ld(RV_REG_S6, store_offset, RV_REG_SP, ctx); 24262306a36Sopenharmony_ci store_offset -= 8; 24362306a36Sopenharmony_ci } 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, stack_adjust, ctx); 24662306a36Sopenharmony_ci /* Set return value. */ 24762306a36Sopenharmony_ci if (!is_tail_call) 24862306a36Sopenharmony_ci emit_addiw(RV_REG_A0, RV_REG_A5, 0, ctx); 24962306a36Sopenharmony_ci emit_jalr(RV_REG_ZERO, is_tail_call ? RV_REG_T3 : RV_REG_RA, 25062306a36Sopenharmony_ci is_tail_call ? (RV_FENTRY_NINSNS + 1) * 4 : 0, /* skip reserved nops and TCC init */ 25162306a36Sopenharmony_ci ctx); 25262306a36Sopenharmony_ci} 25362306a36Sopenharmony_ci 25462306a36Sopenharmony_cistatic void emit_bcc(u8 cond, u8 rd, u8 rs, int rvoff, 25562306a36Sopenharmony_ci struct rv_jit_context *ctx) 25662306a36Sopenharmony_ci{ 25762306a36Sopenharmony_ci switch (cond) { 25862306a36Sopenharmony_ci case BPF_JEQ: 25962306a36Sopenharmony_ci emit(rv_beq(rd, rs, rvoff >> 1), ctx); 26062306a36Sopenharmony_ci return; 26162306a36Sopenharmony_ci case BPF_JGT: 26262306a36Sopenharmony_ci emit(rv_bltu(rs, rd, rvoff >> 1), ctx); 26362306a36Sopenharmony_ci return; 26462306a36Sopenharmony_ci case BPF_JLT: 26562306a36Sopenharmony_ci emit(rv_bltu(rd, rs, rvoff >> 1), ctx); 26662306a36Sopenharmony_ci return; 26762306a36Sopenharmony_ci case BPF_JGE: 26862306a36Sopenharmony_ci emit(rv_bgeu(rd, rs, rvoff >> 1), ctx); 26962306a36Sopenharmony_ci return; 27062306a36Sopenharmony_ci case BPF_JLE: 27162306a36Sopenharmony_ci emit(rv_bgeu(rs, rd, rvoff >> 1), ctx); 27262306a36Sopenharmony_ci return; 27362306a36Sopenharmony_ci case BPF_JNE: 27462306a36Sopenharmony_ci emit(rv_bne(rd, rs, rvoff >> 1), ctx); 27562306a36Sopenharmony_ci return; 27662306a36Sopenharmony_ci case BPF_JSGT: 27762306a36Sopenharmony_ci emit(rv_blt(rs, rd, rvoff >> 1), ctx); 27862306a36Sopenharmony_ci return; 27962306a36Sopenharmony_ci case BPF_JSLT: 28062306a36Sopenharmony_ci emit(rv_blt(rd, rs, rvoff >> 1), ctx); 28162306a36Sopenharmony_ci return; 28262306a36Sopenharmony_ci case BPF_JSGE: 28362306a36Sopenharmony_ci emit(rv_bge(rd, rs, rvoff >> 1), ctx); 28462306a36Sopenharmony_ci return; 28562306a36Sopenharmony_ci case BPF_JSLE: 28662306a36Sopenharmony_ci emit(rv_bge(rs, rd, rvoff >> 1), ctx); 28762306a36Sopenharmony_ci } 28862306a36Sopenharmony_ci} 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_cistatic void emit_branch(u8 cond, u8 rd, u8 rs, int rvoff, 29162306a36Sopenharmony_ci struct rv_jit_context *ctx) 29262306a36Sopenharmony_ci{ 29362306a36Sopenharmony_ci s64 upper, lower; 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci if (is_13b_int(rvoff)) { 29662306a36Sopenharmony_ci emit_bcc(cond, rd, rs, rvoff, ctx); 29762306a36Sopenharmony_ci return; 29862306a36Sopenharmony_ci } 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci /* Adjust for jal */ 30162306a36Sopenharmony_ci rvoff -= 4; 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ci /* Transform, e.g.: 30462306a36Sopenharmony_ci * bne rd,rs,foo 30562306a36Sopenharmony_ci * to 30662306a36Sopenharmony_ci * beq rd,rs,<.L1> 30762306a36Sopenharmony_ci * (auipc foo) 30862306a36Sopenharmony_ci * jal(r) foo 30962306a36Sopenharmony_ci * .L1 31062306a36Sopenharmony_ci */ 31162306a36Sopenharmony_ci cond = invert_bpf_cond(cond); 31262306a36Sopenharmony_ci if (is_21b_int(rvoff)) { 31362306a36Sopenharmony_ci emit_bcc(cond, rd, rs, 8, ctx); 31462306a36Sopenharmony_ci emit(rv_jal(RV_REG_ZERO, rvoff >> 1), ctx); 31562306a36Sopenharmony_ci return; 31662306a36Sopenharmony_ci } 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_ci /* 32b No need for an additional rvoff adjustment, since we 31962306a36Sopenharmony_ci * get that from the auipc at PC', where PC = PC' + 4. 32062306a36Sopenharmony_ci */ 32162306a36Sopenharmony_ci upper = (rvoff + (1 << 11)) >> 12; 32262306a36Sopenharmony_ci lower = rvoff & 0xfff; 32362306a36Sopenharmony_ci 32462306a36Sopenharmony_ci emit_bcc(cond, rd, rs, 12, ctx); 32562306a36Sopenharmony_ci emit(rv_auipc(RV_REG_T1, upper), ctx); 32662306a36Sopenharmony_ci emit(rv_jalr(RV_REG_ZERO, RV_REG_T1, lower), ctx); 32762306a36Sopenharmony_ci} 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_cistatic void emit_zext_32(u8 reg, struct rv_jit_context *ctx) 33062306a36Sopenharmony_ci{ 33162306a36Sopenharmony_ci emit_slli(reg, reg, 32, ctx); 33262306a36Sopenharmony_ci emit_srli(reg, reg, 32, ctx); 33362306a36Sopenharmony_ci} 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_cistatic int emit_bpf_tail_call(int insn, struct rv_jit_context *ctx) 33662306a36Sopenharmony_ci{ 33762306a36Sopenharmony_ci int tc_ninsn, off, start_insn = ctx->ninsns; 33862306a36Sopenharmony_ci u8 tcc = rv_tail_call_reg(ctx); 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_ci /* a0: &ctx 34162306a36Sopenharmony_ci * a1: &array 34262306a36Sopenharmony_ci * a2: index 34362306a36Sopenharmony_ci * 34462306a36Sopenharmony_ci * if (index >= array->map.max_entries) 34562306a36Sopenharmony_ci * goto out; 34662306a36Sopenharmony_ci */ 34762306a36Sopenharmony_ci tc_ninsn = insn ? ctx->offset[insn] - ctx->offset[insn - 1] : 34862306a36Sopenharmony_ci ctx->offset[0]; 34962306a36Sopenharmony_ci emit_zext_32(RV_REG_A2, ctx); 35062306a36Sopenharmony_ci 35162306a36Sopenharmony_ci off = offsetof(struct bpf_array, map.max_entries); 35262306a36Sopenharmony_ci if (is_12b_check(off, insn)) 35362306a36Sopenharmony_ci return -1; 35462306a36Sopenharmony_ci emit(rv_lwu(RV_REG_T1, off, RV_REG_A1), ctx); 35562306a36Sopenharmony_ci off = ninsns_rvoff(tc_ninsn - (ctx->ninsns - start_insn)); 35662306a36Sopenharmony_ci emit_branch(BPF_JGE, RV_REG_A2, RV_REG_T1, off, ctx); 35762306a36Sopenharmony_ci 35862306a36Sopenharmony_ci /* if (--TCC < 0) 35962306a36Sopenharmony_ci * goto out; 36062306a36Sopenharmony_ci */ 36162306a36Sopenharmony_ci emit_addi(RV_REG_TCC, tcc, -1, ctx); 36262306a36Sopenharmony_ci off = ninsns_rvoff(tc_ninsn - (ctx->ninsns - start_insn)); 36362306a36Sopenharmony_ci emit_branch(BPF_JSLT, RV_REG_TCC, RV_REG_ZERO, off, ctx); 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci /* prog = array->ptrs[index]; 36662306a36Sopenharmony_ci * if (!prog) 36762306a36Sopenharmony_ci * goto out; 36862306a36Sopenharmony_ci */ 36962306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_A2, 3, ctx); 37062306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_A1, ctx); 37162306a36Sopenharmony_ci off = offsetof(struct bpf_array, ptrs); 37262306a36Sopenharmony_ci if (is_12b_check(off, insn)) 37362306a36Sopenharmony_ci return -1; 37462306a36Sopenharmony_ci emit_ld(RV_REG_T2, off, RV_REG_T2, ctx); 37562306a36Sopenharmony_ci off = ninsns_rvoff(tc_ninsn - (ctx->ninsns - start_insn)); 37662306a36Sopenharmony_ci emit_branch(BPF_JEQ, RV_REG_T2, RV_REG_ZERO, off, ctx); 37762306a36Sopenharmony_ci 37862306a36Sopenharmony_ci /* goto *(prog->bpf_func + 4); */ 37962306a36Sopenharmony_ci off = offsetof(struct bpf_prog, bpf_func); 38062306a36Sopenharmony_ci if (is_12b_check(off, insn)) 38162306a36Sopenharmony_ci return -1; 38262306a36Sopenharmony_ci emit_ld(RV_REG_T3, off, RV_REG_T2, ctx); 38362306a36Sopenharmony_ci __build_epilogue(true, ctx); 38462306a36Sopenharmony_ci return 0; 38562306a36Sopenharmony_ci} 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_cistatic void init_regs(u8 *rd, u8 *rs, const struct bpf_insn *insn, 38862306a36Sopenharmony_ci struct rv_jit_context *ctx) 38962306a36Sopenharmony_ci{ 39062306a36Sopenharmony_ci u8 code = insn->code; 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci switch (code) { 39362306a36Sopenharmony_ci case BPF_JMP | BPF_JA: 39462306a36Sopenharmony_ci case BPF_JMP | BPF_CALL: 39562306a36Sopenharmony_ci case BPF_JMP | BPF_EXIT: 39662306a36Sopenharmony_ci case BPF_JMP | BPF_TAIL_CALL: 39762306a36Sopenharmony_ci break; 39862306a36Sopenharmony_ci default: 39962306a36Sopenharmony_ci *rd = bpf_to_rv_reg(insn->dst_reg, ctx); 40062306a36Sopenharmony_ci } 40162306a36Sopenharmony_ci 40262306a36Sopenharmony_ci if (code & (BPF_ALU | BPF_X) || code & (BPF_ALU64 | BPF_X) || 40362306a36Sopenharmony_ci code & (BPF_JMP | BPF_X) || code & (BPF_JMP32 | BPF_X) || 40462306a36Sopenharmony_ci code & BPF_LDX || code & BPF_STX) 40562306a36Sopenharmony_ci *rs = bpf_to_rv_reg(insn->src_reg, ctx); 40662306a36Sopenharmony_ci} 40762306a36Sopenharmony_ci 40862306a36Sopenharmony_cistatic void emit_zext_32_rd_rs(u8 *rd, u8 *rs, struct rv_jit_context *ctx) 40962306a36Sopenharmony_ci{ 41062306a36Sopenharmony_ci emit_mv(RV_REG_T2, *rd, ctx); 41162306a36Sopenharmony_ci emit_zext_32(RV_REG_T2, ctx); 41262306a36Sopenharmony_ci emit_mv(RV_REG_T1, *rs, ctx); 41362306a36Sopenharmony_ci emit_zext_32(RV_REG_T1, ctx); 41462306a36Sopenharmony_ci *rd = RV_REG_T2; 41562306a36Sopenharmony_ci *rs = RV_REG_T1; 41662306a36Sopenharmony_ci} 41762306a36Sopenharmony_ci 41862306a36Sopenharmony_cistatic void emit_sext_32_rd_rs(u8 *rd, u8 *rs, struct rv_jit_context *ctx) 41962306a36Sopenharmony_ci{ 42062306a36Sopenharmony_ci emit_addiw(RV_REG_T2, *rd, 0, ctx); 42162306a36Sopenharmony_ci emit_addiw(RV_REG_T1, *rs, 0, ctx); 42262306a36Sopenharmony_ci *rd = RV_REG_T2; 42362306a36Sopenharmony_ci *rs = RV_REG_T1; 42462306a36Sopenharmony_ci} 42562306a36Sopenharmony_ci 42662306a36Sopenharmony_cistatic void emit_zext_32_rd_t1(u8 *rd, struct rv_jit_context *ctx) 42762306a36Sopenharmony_ci{ 42862306a36Sopenharmony_ci emit_mv(RV_REG_T2, *rd, ctx); 42962306a36Sopenharmony_ci emit_zext_32(RV_REG_T2, ctx); 43062306a36Sopenharmony_ci emit_zext_32(RV_REG_T1, ctx); 43162306a36Sopenharmony_ci *rd = RV_REG_T2; 43262306a36Sopenharmony_ci} 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_cistatic void emit_sext_32_rd(u8 *rd, struct rv_jit_context *ctx) 43562306a36Sopenharmony_ci{ 43662306a36Sopenharmony_ci emit_addiw(RV_REG_T2, *rd, 0, ctx); 43762306a36Sopenharmony_ci *rd = RV_REG_T2; 43862306a36Sopenharmony_ci} 43962306a36Sopenharmony_ci 44062306a36Sopenharmony_cistatic int emit_jump_and_link(u8 rd, s64 rvoff, bool fixed_addr, 44162306a36Sopenharmony_ci struct rv_jit_context *ctx) 44262306a36Sopenharmony_ci{ 44362306a36Sopenharmony_ci s64 upper, lower; 44462306a36Sopenharmony_ci 44562306a36Sopenharmony_ci if (rvoff && fixed_addr && is_21b_int(rvoff)) { 44662306a36Sopenharmony_ci emit(rv_jal(rd, rvoff >> 1), ctx); 44762306a36Sopenharmony_ci return 0; 44862306a36Sopenharmony_ci } else if (in_auipc_jalr_range(rvoff)) { 44962306a36Sopenharmony_ci upper = (rvoff + (1 << 11)) >> 12; 45062306a36Sopenharmony_ci lower = rvoff & 0xfff; 45162306a36Sopenharmony_ci emit(rv_auipc(RV_REG_T1, upper), ctx); 45262306a36Sopenharmony_ci emit(rv_jalr(rd, RV_REG_T1, lower), ctx); 45362306a36Sopenharmony_ci return 0; 45462306a36Sopenharmony_ci } 45562306a36Sopenharmony_ci 45662306a36Sopenharmony_ci pr_err("bpf-jit: target offset 0x%llx is out of range\n", rvoff); 45762306a36Sopenharmony_ci return -ERANGE; 45862306a36Sopenharmony_ci} 45962306a36Sopenharmony_ci 46062306a36Sopenharmony_cistatic bool is_signed_bpf_cond(u8 cond) 46162306a36Sopenharmony_ci{ 46262306a36Sopenharmony_ci return cond == BPF_JSGT || cond == BPF_JSLT || 46362306a36Sopenharmony_ci cond == BPF_JSGE || cond == BPF_JSLE; 46462306a36Sopenharmony_ci} 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_cistatic int emit_call(u64 addr, bool fixed_addr, struct rv_jit_context *ctx) 46762306a36Sopenharmony_ci{ 46862306a36Sopenharmony_ci s64 off = 0; 46962306a36Sopenharmony_ci u64 ip; 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_ci if (addr && ctx->insns && ctx->ro_insns) { 47262306a36Sopenharmony_ci /* 47362306a36Sopenharmony_ci * Use the ro_insns(RX) to calculate the offset as the BPF 47462306a36Sopenharmony_ci * program will finally run from this memory region. 47562306a36Sopenharmony_ci */ 47662306a36Sopenharmony_ci ip = (u64)(long)(ctx->ro_insns + ctx->ninsns); 47762306a36Sopenharmony_ci off = addr - ip; 47862306a36Sopenharmony_ci } 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_ci return emit_jump_and_link(RV_REG_RA, off, fixed_addr, ctx); 48162306a36Sopenharmony_ci} 48262306a36Sopenharmony_ci 48362306a36Sopenharmony_cistatic void emit_atomic(u8 rd, u8 rs, s16 off, s32 imm, bool is64, 48462306a36Sopenharmony_ci struct rv_jit_context *ctx) 48562306a36Sopenharmony_ci{ 48662306a36Sopenharmony_ci u8 r0; 48762306a36Sopenharmony_ci int jmp_offset; 48862306a36Sopenharmony_ci 48962306a36Sopenharmony_ci if (off) { 49062306a36Sopenharmony_ci if (is_12b_int(off)) { 49162306a36Sopenharmony_ci emit_addi(RV_REG_T1, rd, off, ctx); 49262306a36Sopenharmony_ci } else { 49362306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 49462306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rd, ctx); 49562306a36Sopenharmony_ci } 49662306a36Sopenharmony_ci rd = RV_REG_T1; 49762306a36Sopenharmony_ci } 49862306a36Sopenharmony_ci 49962306a36Sopenharmony_ci switch (imm) { 50062306a36Sopenharmony_ci /* lock *(u32/u64 *)(dst_reg + off16) <op>= src_reg */ 50162306a36Sopenharmony_ci case BPF_ADD: 50262306a36Sopenharmony_ci emit(is64 ? rv_amoadd_d(RV_REG_ZERO, rs, rd, 0, 0) : 50362306a36Sopenharmony_ci rv_amoadd_w(RV_REG_ZERO, rs, rd, 0, 0), ctx); 50462306a36Sopenharmony_ci break; 50562306a36Sopenharmony_ci case BPF_AND: 50662306a36Sopenharmony_ci emit(is64 ? rv_amoand_d(RV_REG_ZERO, rs, rd, 0, 0) : 50762306a36Sopenharmony_ci rv_amoand_w(RV_REG_ZERO, rs, rd, 0, 0), ctx); 50862306a36Sopenharmony_ci break; 50962306a36Sopenharmony_ci case BPF_OR: 51062306a36Sopenharmony_ci emit(is64 ? rv_amoor_d(RV_REG_ZERO, rs, rd, 0, 0) : 51162306a36Sopenharmony_ci rv_amoor_w(RV_REG_ZERO, rs, rd, 0, 0), ctx); 51262306a36Sopenharmony_ci break; 51362306a36Sopenharmony_ci case BPF_XOR: 51462306a36Sopenharmony_ci emit(is64 ? rv_amoxor_d(RV_REG_ZERO, rs, rd, 0, 0) : 51562306a36Sopenharmony_ci rv_amoxor_w(RV_REG_ZERO, rs, rd, 0, 0), ctx); 51662306a36Sopenharmony_ci break; 51762306a36Sopenharmony_ci /* src_reg = atomic_fetch_<op>(dst_reg + off16, src_reg) */ 51862306a36Sopenharmony_ci case BPF_ADD | BPF_FETCH: 51962306a36Sopenharmony_ci emit(is64 ? rv_amoadd_d(rs, rs, rd, 0, 0) : 52062306a36Sopenharmony_ci rv_amoadd_w(rs, rs, rd, 0, 0), ctx); 52162306a36Sopenharmony_ci if (!is64) 52262306a36Sopenharmony_ci emit_zext_32(rs, ctx); 52362306a36Sopenharmony_ci break; 52462306a36Sopenharmony_ci case BPF_AND | BPF_FETCH: 52562306a36Sopenharmony_ci emit(is64 ? rv_amoand_d(rs, rs, rd, 0, 0) : 52662306a36Sopenharmony_ci rv_amoand_w(rs, rs, rd, 0, 0), ctx); 52762306a36Sopenharmony_ci if (!is64) 52862306a36Sopenharmony_ci emit_zext_32(rs, ctx); 52962306a36Sopenharmony_ci break; 53062306a36Sopenharmony_ci case BPF_OR | BPF_FETCH: 53162306a36Sopenharmony_ci emit(is64 ? rv_amoor_d(rs, rs, rd, 0, 0) : 53262306a36Sopenharmony_ci rv_amoor_w(rs, rs, rd, 0, 0), ctx); 53362306a36Sopenharmony_ci if (!is64) 53462306a36Sopenharmony_ci emit_zext_32(rs, ctx); 53562306a36Sopenharmony_ci break; 53662306a36Sopenharmony_ci case BPF_XOR | BPF_FETCH: 53762306a36Sopenharmony_ci emit(is64 ? rv_amoxor_d(rs, rs, rd, 0, 0) : 53862306a36Sopenharmony_ci rv_amoxor_w(rs, rs, rd, 0, 0), ctx); 53962306a36Sopenharmony_ci if (!is64) 54062306a36Sopenharmony_ci emit_zext_32(rs, ctx); 54162306a36Sopenharmony_ci break; 54262306a36Sopenharmony_ci /* src_reg = atomic_xchg(dst_reg + off16, src_reg); */ 54362306a36Sopenharmony_ci case BPF_XCHG: 54462306a36Sopenharmony_ci emit(is64 ? rv_amoswap_d(rs, rs, rd, 0, 0) : 54562306a36Sopenharmony_ci rv_amoswap_w(rs, rs, rd, 0, 0), ctx); 54662306a36Sopenharmony_ci if (!is64) 54762306a36Sopenharmony_ci emit_zext_32(rs, ctx); 54862306a36Sopenharmony_ci break; 54962306a36Sopenharmony_ci /* r0 = atomic_cmpxchg(dst_reg + off16, r0, src_reg); */ 55062306a36Sopenharmony_ci case BPF_CMPXCHG: 55162306a36Sopenharmony_ci r0 = bpf_to_rv_reg(BPF_REG_0, ctx); 55262306a36Sopenharmony_ci emit(is64 ? rv_addi(RV_REG_T2, r0, 0) : 55362306a36Sopenharmony_ci rv_addiw(RV_REG_T2, r0, 0), ctx); 55462306a36Sopenharmony_ci emit(is64 ? rv_lr_d(r0, 0, rd, 0, 0) : 55562306a36Sopenharmony_ci rv_lr_w(r0, 0, rd, 0, 0), ctx); 55662306a36Sopenharmony_ci jmp_offset = ninsns_rvoff(8); 55762306a36Sopenharmony_ci emit(rv_bne(RV_REG_T2, r0, jmp_offset >> 1), ctx); 55862306a36Sopenharmony_ci emit(is64 ? rv_sc_d(RV_REG_T3, rs, rd, 0, 0) : 55962306a36Sopenharmony_ci rv_sc_w(RV_REG_T3, rs, rd, 0, 0), ctx); 56062306a36Sopenharmony_ci jmp_offset = ninsns_rvoff(-6); 56162306a36Sopenharmony_ci emit(rv_bne(RV_REG_T3, 0, jmp_offset >> 1), ctx); 56262306a36Sopenharmony_ci emit(rv_fence(0x3, 0x3), ctx); 56362306a36Sopenharmony_ci break; 56462306a36Sopenharmony_ci } 56562306a36Sopenharmony_ci} 56662306a36Sopenharmony_ci 56762306a36Sopenharmony_ci#define BPF_FIXUP_OFFSET_MASK GENMASK(26, 0) 56862306a36Sopenharmony_ci#define BPF_FIXUP_REG_MASK GENMASK(31, 27) 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_cibool ex_handler_bpf(const struct exception_table_entry *ex, 57162306a36Sopenharmony_ci struct pt_regs *regs) 57262306a36Sopenharmony_ci{ 57362306a36Sopenharmony_ci off_t offset = FIELD_GET(BPF_FIXUP_OFFSET_MASK, ex->fixup); 57462306a36Sopenharmony_ci int regs_offset = FIELD_GET(BPF_FIXUP_REG_MASK, ex->fixup); 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_ci *(unsigned long *)((void *)regs + pt_regmap[regs_offset]) = 0; 57762306a36Sopenharmony_ci regs->epc = (unsigned long)&ex->fixup - offset; 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci return true; 58062306a36Sopenharmony_ci} 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci/* For accesses to BTF pointers, add an entry to the exception table */ 58362306a36Sopenharmony_cistatic int add_exception_handler(const struct bpf_insn *insn, 58462306a36Sopenharmony_ci struct rv_jit_context *ctx, 58562306a36Sopenharmony_ci int dst_reg, int insn_len) 58662306a36Sopenharmony_ci{ 58762306a36Sopenharmony_ci struct exception_table_entry *ex; 58862306a36Sopenharmony_ci unsigned long pc; 58962306a36Sopenharmony_ci off_t ins_offset; 59062306a36Sopenharmony_ci off_t fixup_offset; 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_ci if (!ctx->insns || !ctx->ro_insns || !ctx->prog->aux->extable || 59362306a36Sopenharmony_ci (BPF_MODE(insn->code) != BPF_PROBE_MEM && BPF_MODE(insn->code) != BPF_PROBE_MEMSX)) 59462306a36Sopenharmony_ci return 0; 59562306a36Sopenharmony_ci 59662306a36Sopenharmony_ci if (WARN_ON_ONCE(ctx->nexentries >= ctx->prog->aux->num_exentries)) 59762306a36Sopenharmony_ci return -EINVAL; 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci if (WARN_ON_ONCE(insn_len > ctx->ninsns)) 60062306a36Sopenharmony_ci return -EINVAL; 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_ci if (WARN_ON_ONCE(!rvc_enabled() && insn_len == 1)) 60362306a36Sopenharmony_ci return -EINVAL; 60462306a36Sopenharmony_ci 60562306a36Sopenharmony_ci ex = &ctx->prog->aux->extable[ctx->nexentries]; 60662306a36Sopenharmony_ci pc = (unsigned long)&ctx->ro_insns[ctx->ninsns - insn_len]; 60762306a36Sopenharmony_ci 60862306a36Sopenharmony_ci /* 60962306a36Sopenharmony_ci * This is the relative offset of the instruction that may fault from 61062306a36Sopenharmony_ci * the exception table itself. This will be written to the exception 61162306a36Sopenharmony_ci * table and if this instruction faults, the destination register will 61262306a36Sopenharmony_ci * be set to '0' and the execution will jump to the next instruction. 61362306a36Sopenharmony_ci */ 61462306a36Sopenharmony_ci ins_offset = pc - (long)&ex->insn; 61562306a36Sopenharmony_ci if (WARN_ON_ONCE(ins_offset >= 0 || ins_offset < INT_MIN)) 61662306a36Sopenharmony_ci return -ERANGE; 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci /* 61962306a36Sopenharmony_ci * Since the extable follows the program, the fixup offset is always 62062306a36Sopenharmony_ci * negative and limited to BPF_JIT_REGION_SIZE. Store a positive value 62162306a36Sopenharmony_ci * to keep things simple, and put the destination register in the upper 62262306a36Sopenharmony_ci * bits. We don't need to worry about buildtime or runtime sort 62362306a36Sopenharmony_ci * modifying the upper bits because the table is already sorted, and 62462306a36Sopenharmony_ci * isn't part of the main exception table. 62562306a36Sopenharmony_ci * 62662306a36Sopenharmony_ci * The fixup_offset is set to the next instruction from the instruction 62762306a36Sopenharmony_ci * that may fault. The execution will jump to this after handling the 62862306a36Sopenharmony_ci * fault. 62962306a36Sopenharmony_ci */ 63062306a36Sopenharmony_ci fixup_offset = (long)&ex->fixup - (pc + insn_len * sizeof(u16)); 63162306a36Sopenharmony_ci if (!FIELD_FIT(BPF_FIXUP_OFFSET_MASK, fixup_offset)) 63262306a36Sopenharmony_ci return -ERANGE; 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_ci /* 63562306a36Sopenharmony_ci * The offsets above have been calculated using the RO buffer but we 63662306a36Sopenharmony_ci * need to use the R/W buffer for writes. 63762306a36Sopenharmony_ci * switch ex to rw buffer for writing. 63862306a36Sopenharmony_ci */ 63962306a36Sopenharmony_ci ex = (void *)ctx->insns + ((void *)ex - (void *)ctx->ro_insns); 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_ci ex->insn = ins_offset; 64262306a36Sopenharmony_ci 64362306a36Sopenharmony_ci ex->fixup = FIELD_PREP(BPF_FIXUP_OFFSET_MASK, fixup_offset) | 64462306a36Sopenharmony_ci FIELD_PREP(BPF_FIXUP_REG_MASK, dst_reg); 64562306a36Sopenharmony_ci ex->type = EX_TYPE_BPF; 64662306a36Sopenharmony_ci 64762306a36Sopenharmony_ci ctx->nexentries++; 64862306a36Sopenharmony_ci return 0; 64962306a36Sopenharmony_ci} 65062306a36Sopenharmony_ci 65162306a36Sopenharmony_cistatic int gen_jump_or_nops(void *target, void *ip, u32 *insns, bool is_call) 65262306a36Sopenharmony_ci{ 65362306a36Sopenharmony_ci s64 rvoff; 65462306a36Sopenharmony_ci struct rv_jit_context ctx; 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci ctx.ninsns = 0; 65762306a36Sopenharmony_ci ctx.insns = (u16 *)insns; 65862306a36Sopenharmony_ci 65962306a36Sopenharmony_ci if (!target) { 66062306a36Sopenharmony_ci emit(rv_nop(), &ctx); 66162306a36Sopenharmony_ci emit(rv_nop(), &ctx); 66262306a36Sopenharmony_ci return 0; 66362306a36Sopenharmony_ci } 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci rvoff = (s64)(target - ip); 66662306a36Sopenharmony_ci return emit_jump_and_link(is_call ? RV_REG_T0 : RV_REG_ZERO, rvoff, false, &ctx); 66762306a36Sopenharmony_ci} 66862306a36Sopenharmony_ci 66962306a36Sopenharmony_ciint bpf_arch_text_poke(void *ip, enum bpf_text_poke_type poke_type, 67062306a36Sopenharmony_ci void *old_addr, void *new_addr) 67162306a36Sopenharmony_ci{ 67262306a36Sopenharmony_ci u32 old_insns[RV_FENTRY_NINSNS], new_insns[RV_FENTRY_NINSNS]; 67362306a36Sopenharmony_ci bool is_call = poke_type == BPF_MOD_CALL; 67462306a36Sopenharmony_ci int ret; 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_ci if (!is_kernel_text((unsigned long)ip) && 67762306a36Sopenharmony_ci !is_bpf_text_address((unsigned long)ip)) 67862306a36Sopenharmony_ci return -ENOTSUPP; 67962306a36Sopenharmony_ci 68062306a36Sopenharmony_ci ret = gen_jump_or_nops(old_addr, ip, old_insns, is_call); 68162306a36Sopenharmony_ci if (ret) 68262306a36Sopenharmony_ci return ret; 68362306a36Sopenharmony_ci 68462306a36Sopenharmony_ci if (memcmp(ip, old_insns, RV_FENTRY_NINSNS * 4)) 68562306a36Sopenharmony_ci return -EFAULT; 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci ret = gen_jump_or_nops(new_addr, ip, new_insns, is_call); 68862306a36Sopenharmony_ci if (ret) 68962306a36Sopenharmony_ci return ret; 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_ci cpus_read_lock(); 69262306a36Sopenharmony_ci mutex_lock(&text_mutex); 69362306a36Sopenharmony_ci if (memcmp(ip, new_insns, RV_FENTRY_NINSNS * 4)) 69462306a36Sopenharmony_ci ret = patch_text(ip, new_insns, RV_FENTRY_NINSNS); 69562306a36Sopenharmony_ci mutex_unlock(&text_mutex); 69662306a36Sopenharmony_ci cpus_read_unlock(); 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci return ret; 69962306a36Sopenharmony_ci} 70062306a36Sopenharmony_ci 70162306a36Sopenharmony_cistatic void store_args(int nregs, int args_off, struct rv_jit_context *ctx) 70262306a36Sopenharmony_ci{ 70362306a36Sopenharmony_ci int i; 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci for (i = 0; i < nregs; i++) { 70662306a36Sopenharmony_ci emit_sd(RV_REG_FP, -args_off, RV_REG_A0 + i, ctx); 70762306a36Sopenharmony_ci args_off -= 8; 70862306a36Sopenharmony_ci } 70962306a36Sopenharmony_ci} 71062306a36Sopenharmony_ci 71162306a36Sopenharmony_cistatic void restore_args(int nregs, int args_off, struct rv_jit_context *ctx) 71262306a36Sopenharmony_ci{ 71362306a36Sopenharmony_ci int i; 71462306a36Sopenharmony_ci 71562306a36Sopenharmony_ci for (i = 0; i < nregs; i++) { 71662306a36Sopenharmony_ci emit_ld(RV_REG_A0 + i, -args_off, RV_REG_FP, ctx); 71762306a36Sopenharmony_ci args_off -= 8; 71862306a36Sopenharmony_ci } 71962306a36Sopenharmony_ci} 72062306a36Sopenharmony_ci 72162306a36Sopenharmony_cistatic int invoke_bpf_prog(struct bpf_tramp_link *l, int args_off, int retval_off, 72262306a36Sopenharmony_ci int run_ctx_off, bool save_ret, struct rv_jit_context *ctx) 72362306a36Sopenharmony_ci{ 72462306a36Sopenharmony_ci int ret, branch_off; 72562306a36Sopenharmony_ci struct bpf_prog *p = l->link.prog; 72662306a36Sopenharmony_ci int cookie_off = offsetof(struct bpf_tramp_run_ctx, bpf_cookie); 72762306a36Sopenharmony_ci 72862306a36Sopenharmony_ci if (l->cookie) { 72962306a36Sopenharmony_ci emit_imm(RV_REG_T1, l->cookie, ctx); 73062306a36Sopenharmony_ci emit_sd(RV_REG_FP, -run_ctx_off + cookie_off, RV_REG_T1, ctx); 73162306a36Sopenharmony_ci } else { 73262306a36Sopenharmony_ci emit_sd(RV_REG_FP, -run_ctx_off + cookie_off, RV_REG_ZERO, ctx); 73362306a36Sopenharmony_ci } 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci /* arg1: prog */ 73662306a36Sopenharmony_ci emit_imm(RV_REG_A0, (const s64)p, ctx); 73762306a36Sopenharmony_ci /* arg2: &run_ctx */ 73862306a36Sopenharmony_ci emit_addi(RV_REG_A1, RV_REG_FP, -run_ctx_off, ctx); 73962306a36Sopenharmony_ci ret = emit_call((const u64)bpf_trampoline_enter(p), true, ctx); 74062306a36Sopenharmony_ci if (ret) 74162306a36Sopenharmony_ci return ret; 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_ci /* if (__bpf_prog_enter(prog) == 0) 74462306a36Sopenharmony_ci * goto skip_exec_of_prog; 74562306a36Sopenharmony_ci */ 74662306a36Sopenharmony_ci branch_off = ctx->ninsns; 74762306a36Sopenharmony_ci /* nop reserved for conditional jump */ 74862306a36Sopenharmony_ci emit(rv_nop(), ctx); 74962306a36Sopenharmony_ci 75062306a36Sopenharmony_ci /* store prog start time */ 75162306a36Sopenharmony_ci emit_mv(RV_REG_S1, RV_REG_A0, ctx); 75262306a36Sopenharmony_ci 75362306a36Sopenharmony_ci /* arg1: &args_off */ 75462306a36Sopenharmony_ci emit_addi(RV_REG_A0, RV_REG_FP, -args_off, ctx); 75562306a36Sopenharmony_ci if (!p->jited) 75662306a36Sopenharmony_ci /* arg2: progs[i]->insnsi for interpreter */ 75762306a36Sopenharmony_ci emit_imm(RV_REG_A1, (const s64)p->insnsi, ctx); 75862306a36Sopenharmony_ci ret = emit_call((const u64)p->bpf_func, true, ctx); 75962306a36Sopenharmony_ci if (ret) 76062306a36Sopenharmony_ci return ret; 76162306a36Sopenharmony_ci 76262306a36Sopenharmony_ci if (save_ret) { 76362306a36Sopenharmony_ci emit_sd(RV_REG_FP, -retval_off, RV_REG_A0, ctx); 76462306a36Sopenharmony_ci emit_sd(RV_REG_FP, -(retval_off - 8), regmap[BPF_REG_0], ctx); 76562306a36Sopenharmony_ci } 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci /* update branch with beqz */ 76862306a36Sopenharmony_ci if (ctx->insns) { 76962306a36Sopenharmony_ci int offset = ninsns_rvoff(ctx->ninsns - branch_off); 77062306a36Sopenharmony_ci u32 insn = rv_beq(RV_REG_A0, RV_REG_ZERO, offset >> 1); 77162306a36Sopenharmony_ci *(u32 *)(ctx->insns + branch_off) = insn; 77262306a36Sopenharmony_ci } 77362306a36Sopenharmony_ci 77462306a36Sopenharmony_ci /* arg1: prog */ 77562306a36Sopenharmony_ci emit_imm(RV_REG_A0, (const s64)p, ctx); 77662306a36Sopenharmony_ci /* arg2: prog start time */ 77762306a36Sopenharmony_ci emit_mv(RV_REG_A1, RV_REG_S1, ctx); 77862306a36Sopenharmony_ci /* arg3: &run_ctx */ 77962306a36Sopenharmony_ci emit_addi(RV_REG_A2, RV_REG_FP, -run_ctx_off, ctx); 78062306a36Sopenharmony_ci ret = emit_call((const u64)bpf_trampoline_exit(p), true, ctx); 78162306a36Sopenharmony_ci 78262306a36Sopenharmony_ci return ret; 78362306a36Sopenharmony_ci} 78462306a36Sopenharmony_ci 78562306a36Sopenharmony_cistatic int __arch_prepare_bpf_trampoline(struct bpf_tramp_image *im, 78662306a36Sopenharmony_ci const struct btf_func_model *m, 78762306a36Sopenharmony_ci struct bpf_tramp_links *tlinks, 78862306a36Sopenharmony_ci void *func_addr, u32 flags, 78962306a36Sopenharmony_ci struct rv_jit_context *ctx) 79062306a36Sopenharmony_ci{ 79162306a36Sopenharmony_ci int i, ret, offset; 79262306a36Sopenharmony_ci int *branches_off = NULL; 79362306a36Sopenharmony_ci int stack_size = 0, nregs = m->nr_args; 79462306a36Sopenharmony_ci int retval_off, args_off, nregs_off, ip_off, run_ctx_off, sreg_off; 79562306a36Sopenharmony_ci struct bpf_tramp_links *fentry = &tlinks[BPF_TRAMP_FENTRY]; 79662306a36Sopenharmony_ci struct bpf_tramp_links *fexit = &tlinks[BPF_TRAMP_FEXIT]; 79762306a36Sopenharmony_ci struct bpf_tramp_links *fmod_ret = &tlinks[BPF_TRAMP_MODIFY_RETURN]; 79862306a36Sopenharmony_ci void *orig_call = func_addr; 79962306a36Sopenharmony_ci bool save_ret; 80062306a36Sopenharmony_ci u32 insn; 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_ci /* Two types of generated trampoline stack layout: 80362306a36Sopenharmony_ci * 80462306a36Sopenharmony_ci * 1. trampoline called from function entry 80562306a36Sopenharmony_ci * -------------------------------------- 80662306a36Sopenharmony_ci * FP + 8 [ RA to parent func ] return address to parent 80762306a36Sopenharmony_ci * function 80862306a36Sopenharmony_ci * FP + 0 [ FP of parent func ] frame pointer of parent 80962306a36Sopenharmony_ci * function 81062306a36Sopenharmony_ci * FP - 8 [ T0 to traced func ] return address of traced 81162306a36Sopenharmony_ci * function 81262306a36Sopenharmony_ci * FP - 16 [ FP of traced func ] frame pointer of traced 81362306a36Sopenharmony_ci * function 81462306a36Sopenharmony_ci * -------------------------------------- 81562306a36Sopenharmony_ci * 81662306a36Sopenharmony_ci * 2. trampoline called directly 81762306a36Sopenharmony_ci * -------------------------------------- 81862306a36Sopenharmony_ci * FP - 8 [ RA to caller func ] return address to caller 81962306a36Sopenharmony_ci * function 82062306a36Sopenharmony_ci * FP - 16 [ FP of caller func ] frame pointer of caller 82162306a36Sopenharmony_ci * function 82262306a36Sopenharmony_ci * -------------------------------------- 82362306a36Sopenharmony_ci * 82462306a36Sopenharmony_ci * FP - retval_off [ return value ] BPF_TRAMP_F_CALL_ORIG or 82562306a36Sopenharmony_ci * BPF_TRAMP_F_RET_FENTRY_RET 82662306a36Sopenharmony_ci * [ argN ] 82762306a36Sopenharmony_ci * [ ... ] 82862306a36Sopenharmony_ci * FP - args_off [ arg1 ] 82962306a36Sopenharmony_ci * 83062306a36Sopenharmony_ci * FP - nregs_off [ regs count ] 83162306a36Sopenharmony_ci * 83262306a36Sopenharmony_ci * FP - ip_off [ traced func ] BPF_TRAMP_F_IP_ARG 83362306a36Sopenharmony_ci * 83462306a36Sopenharmony_ci * FP - run_ctx_off [ bpf_tramp_run_ctx ] 83562306a36Sopenharmony_ci * 83662306a36Sopenharmony_ci * FP - sreg_off [ callee saved reg ] 83762306a36Sopenharmony_ci * 83862306a36Sopenharmony_ci * [ pads ] pads for 16 bytes alignment 83962306a36Sopenharmony_ci */ 84062306a36Sopenharmony_ci 84162306a36Sopenharmony_ci if (flags & (BPF_TRAMP_F_ORIG_STACK | BPF_TRAMP_F_SHARE_IPMODIFY)) 84262306a36Sopenharmony_ci return -ENOTSUPP; 84362306a36Sopenharmony_ci 84462306a36Sopenharmony_ci /* extra regiters for struct arguments */ 84562306a36Sopenharmony_ci for (i = 0; i < m->nr_args; i++) 84662306a36Sopenharmony_ci if (m->arg_flags[i] & BTF_FMODEL_STRUCT_ARG) 84762306a36Sopenharmony_ci nregs += round_up(m->arg_size[i], 8) / 8 - 1; 84862306a36Sopenharmony_ci 84962306a36Sopenharmony_ci /* 8 arguments passed by registers */ 85062306a36Sopenharmony_ci if (nregs > 8) 85162306a36Sopenharmony_ci return -ENOTSUPP; 85262306a36Sopenharmony_ci 85362306a36Sopenharmony_ci /* room of trampoline frame to store return address and frame pointer */ 85462306a36Sopenharmony_ci stack_size += 16; 85562306a36Sopenharmony_ci 85662306a36Sopenharmony_ci save_ret = flags & (BPF_TRAMP_F_CALL_ORIG | BPF_TRAMP_F_RET_FENTRY_RET); 85762306a36Sopenharmony_ci if (save_ret) { 85862306a36Sopenharmony_ci stack_size += 16; /* Save both A5 (BPF R0) and A0 */ 85962306a36Sopenharmony_ci retval_off = stack_size; 86062306a36Sopenharmony_ci } 86162306a36Sopenharmony_ci 86262306a36Sopenharmony_ci stack_size += nregs * 8; 86362306a36Sopenharmony_ci args_off = stack_size; 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci stack_size += 8; 86662306a36Sopenharmony_ci nregs_off = stack_size; 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_IP_ARG) { 86962306a36Sopenharmony_ci stack_size += 8; 87062306a36Sopenharmony_ci ip_off = stack_size; 87162306a36Sopenharmony_ci } 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_ci stack_size += round_up(sizeof(struct bpf_tramp_run_ctx), 8); 87462306a36Sopenharmony_ci run_ctx_off = stack_size; 87562306a36Sopenharmony_ci 87662306a36Sopenharmony_ci stack_size += 8; 87762306a36Sopenharmony_ci sreg_off = stack_size; 87862306a36Sopenharmony_ci 87962306a36Sopenharmony_ci stack_size = round_up(stack_size, 16); 88062306a36Sopenharmony_ci 88162306a36Sopenharmony_ci if (func_addr) { 88262306a36Sopenharmony_ci /* For the trampoline called from function entry, 88362306a36Sopenharmony_ci * the frame of traced function and the frame of 88462306a36Sopenharmony_ci * trampoline need to be considered. 88562306a36Sopenharmony_ci */ 88662306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, -16, ctx); 88762306a36Sopenharmony_ci emit_sd(RV_REG_SP, 8, RV_REG_RA, ctx); 88862306a36Sopenharmony_ci emit_sd(RV_REG_SP, 0, RV_REG_FP, ctx); 88962306a36Sopenharmony_ci emit_addi(RV_REG_FP, RV_REG_SP, 16, ctx); 89062306a36Sopenharmony_ci 89162306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, -stack_size, ctx); 89262306a36Sopenharmony_ci emit_sd(RV_REG_SP, stack_size - 8, RV_REG_T0, ctx); 89362306a36Sopenharmony_ci emit_sd(RV_REG_SP, stack_size - 16, RV_REG_FP, ctx); 89462306a36Sopenharmony_ci emit_addi(RV_REG_FP, RV_REG_SP, stack_size, ctx); 89562306a36Sopenharmony_ci } else { 89662306a36Sopenharmony_ci /* For the trampoline called directly, just handle 89762306a36Sopenharmony_ci * the frame of trampoline. 89862306a36Sopenharmony_ci */ 89962306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, -stack_size, ctx); 90062306a36Sopenharmony_ci emit_sd(RV_REG_SP, stack_size - 8, RV_REG_RA, ctx); 90162306a36Sopenharmony_ci emit_sd(RV_REG_SP, stack_size - 16, RV_REG_FP, ctx); 90262306a36Sopenharmony_ci emit_addi(RV_REG_FP, RV_REG_SP, stack_size, ctx); 90362306a36Sopenharmony_ci } 90462306a36Sopenharmony_ci 90562306a36Sopenharmony_ci /* callee saved register S1 to pass start time */ 90662306a36Sopenharmony_ci emit_sd(RV_REG_FP, -sreg_off, RV_REG_S1, ctx); 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ci /* store ip address of the traced function */ 90962306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_IP_ARG) { 91062306a36Sopenharmony_ci emit_imm(RV_REG_T1, (const s64)func_addr, ctx); 91162306a36Sopenharmony_ci emit_sd(RV_REG_FP, -ip_off, RV_REG_T1, ctx); 91262306a36Sopenharmony_ci } 91362306a36Sopenharmony_ci 91462306a36Sopenharmony_ci emit_li(RV_REG_T1, nregs, ctx); 91562306a36Sopenharmony_ci emit_sd(RV_REG_FP, -nregs_off, RV_REG_T1, ctx); 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_ci store_args(nregs, args_off, ctx); 91862306a36Sopenharmony_ci 91962306a36Sopenharmony_ci /* skip to actual body of traced function */ 92062306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_SKIP_FRAME) 92162306a36Sopenharmony_ci orig_call += RV_FENTRY_NINSNS * 4; 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_CALL_ORIG) { 92462306a36Sopenharmony_ci emit_imm(RV_REG_A0, (const s64)im, ctx); 92562306a36Sopenharmony_ci ret = emit_call((const u64)__bpf_tramp_enter, true, ctx); 92662306a36Sopenharmony_ci if (ret) 92762306a36Sopenharmony_ci return ret; 92862306a36Sopenharmony_ci } 92962306a36Sopenharmony_ci 93062306a36Sopenharmony_ci for (i = 0; i < fentry->nr_links; i++) { 93162306a36Sopenharmony_ci ret = invoke_bpf_prog(fentry->links[i], args_off, retval_off, run_ctx_off, 93262306a36Sopenharmony_ci flags & BPF_TRAMP_F_RET_FENTRY_RET, ctx); 93362306a36Sopenharmony_ci if (ret) 93462306a36Sopenharmony_ci return ret; 93562306a36Sopenharmony_ci } 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci if (fmod_ret->nr_links) { 93862306a36Sopenharmony_ci branches_off = kcalloc(fmod_ret->nr_links, sizeof(int), GFP_KERNEL); 93962306a36Sopenharmony_ci if (!branches_off) 94062306a36Sopenharmony_ci return -ENOMEM; 94162306a36Sopenharmony_ci 94262306a36Sopenharmony_ci /* cleanup to avoid garbage return value confusion */ 94362306a36Sopenharmony_ci emit_sd(RV_REG_FP, -retval_off, RV_REG_ZERO, ctx); 94462306a36Sopenharmony_ci for (i = 0; i < fmod_ret->nr_links; i++) { 94562306a36Sopenharmony_ci ret = invoke_bpf_prog(fmod_ret->links[i], args_off, retval_off, 94662306a36Sopenharmony_ci run_ctx_off, true, ctx); 94762306a36Sopenharmony_ci if (ret) 94862306a36Sopenharmony_ci goto out; 94962306a36Sopenharmony_ci emit_ld(RV_REG_T1, -retval_off, RV_REG_FP, ctx); 95062306a36Sopenharmony_ci branches_off[i] = ctx->ninsns; 95162306a36Sopenharmony_ci /* nop reserved for conditional jump */ 95262306a36Sopenharmony_ci emit(rv_nop(), ctx); 95362306a36Sopenharmony_ci } 95462306a36Sopenharmony_ci } 95562306a36Sopenharmony_ci 95662306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_CALL_ORIG) { 95762306a36Sopenharmony_ci restore_args(nregs, args_off, ctx); 95862306a36Sopenharmony_ci ret = emit_call((const u64)orig_call, true, ctx); 95962306a36Sopenharmony_ci if (ret) 96062306a36Sopenharmony_ci goto out; 96162306a36Sopenharmony_ci emit_sd(RV_REG_FP, -retval_off, RV_REG_A0, ctx); 96262306a36Sopenharmony_ci emit_sd(RV_REG_FP, -(retval_off - 8), regmap[BPF_REG_0], ctx); 96362306a36Sopenharmony_ci im->ip_after_call = ctx->insns + ctx->ninsns; 96462306a36Sopenharmony_ci /* 2 nops reserved for auipc+jalr pair */ 96562306a36Sopenharmony_ci emit(rv_nop(), ctx); 96662306a36Sopenharmony_ci emit(rv_nop(), ctx); 96762306a36Sopenharmony_ci } 96862306a36Sopenharmony_ci 96962306a36Sopenharmony_ci /* update branches saved in invoke_bpf_mod_ret with bnez */ 97062306a36Sopenharmony_ci for (i = 0; ctx->insns && i < fmod_ret->nr_links; i++) { 97162306a36Sopenharmony_ci offset = ninsns_rvoff(ctx->ninsns - branches_off[i]); 97262306a36Sopenharmony_ci insn = rv_bne(RV_REG_T1, RV_REG_ZERO, offset >> 1); 97362306a36Sopenharmony_ci *(u32 *)(ctx->insns + branches_off[i]) = insn; 97462306a36Sopenharmony_ci } 97562306a36Sopenharmony_ci 97662306a36Sopenharmony_ci for (i = 0; i < fexit->nr_links; i++) { 97762306a36Sopenharmony_ci ret = invoke_bpf_prog(fexit->links[i], args_off, retval_off, 97862306a36Sopenharmony_ci run_ctx_off, false, ctx); 97962306a36Sopenharmony_ci if (ret) 98062306a36Sopenharmony_ci goto out; 98162306a36Sopenharmony_ci } 98262306a36Sopenharmony_ci 98362306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_CALL_ORIG) { 98462306a36Sopenharmony_ci im->ip_epilogue = ctx->insns + ctx->ninsns; 98562306a36Sopenharmony_ci emit_imm(RV_REG_A0, (const s64)im, ctx); 98662306a36Sopenharmony_ci ret = emit_call((const u64)__bpf_tramp_exit, true, ctx); 98762306a36Sopenharmony_ci if (ret) 98862306a36Sopenharmony_ci goto out; 98962306a36Sopenharmony_ci } 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_RESTORE_REGS) 99262306a36Sopenharmony_ci restore_args(nregs, args_off, ctx); 99362306a36Sopenharmony_ci 99462306a36Sopenharmony_ci if (save_ret) { 99562306a36Sopenharmony_ci emit_ld(RV_REG_A0, -retval_off, RV_REG_FP, ctx); 99662306a36Sopenharmony_ci emit_ld(regmap[BPF_REG_0], -(retval_off - 8), RV_REG_FP, ctx); 99762306a36Sopenharmony_ci } 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_ci emit_ld(RV_REG_S1, -sreg_off, RV_REG_FP, ctx); 100062306a36Sopenharmony_ci 100162306a36Sopenharmony_ci if (func_addr) { 100262306a36Sopenharmony_ci /* trampoline called from function entry */ 100362306a36Sopenharmony_ci emit_ld(RV_REG_T0, stack_size - 8, RV_REG_SP, ctx); 100462306a36Sopenharmony_ci emit_ld(RV_REG_FP, stack_size - 16, RV_REG_SP, ctx); 100562306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, stack_size, ctx); 100662306a36Sopenharmony_ci 100762306a36Sopenharmony_ci emit_ld(RV_REG_RA, 8, RV_REG_SP, ctx); 100862306a36Sopenharmony_ci emit_ld(RV_REG_FP, 0, RV_REG_SP, ctx); 100962306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, 16, ctx); 101062306a36Sopenharmony_ci 101162306a36Sopenharmony_ci if (flags & BPF_TRAMP_F_SKIP_FRAME) 101262306a36Sopenharmony_ci /* return to parent function */ 101362306a36Sopenharmony_ci emit_jalr(RV_REG_ZERO, RV_REG_RA, 0, ctx); 101462306a36Sopenharmony_ci else 101562306a36Sopenharmony_ci /* return to traced function */ 101662306a36Sopenharmony_ci emit_jalr(RV_REG_ZERO, RV_REG_T0, 0, ctx); 101762306a36Sopenharmony_ci } else { 101862306a36Sopenharmony_ci /* trampoline called directly */ 101962306a36Sopenharmony_ci emit_ld(RV_REG_RA, stack_size - 8, RV_REG_SP, ctx); 102062306a36Sopenharmony_ci emit_ld(RV_REG_FP, stack_size - 16, RV_REG_SP, ctx); 102162306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, stack_size, ctx); 102262306a36Sopenharmony_ci 102362306a36Sopenharmony_ci emit_jalr(RV_REG_ZERO, RV_REG_RA, 0, ctx); 102462306a36Sopenharmony_ci } 102562306a36Sopenharmony_ci 102662306a36Sopenharmony_ci ret = ctx->ninsns; 102762306a36Sopenharmony_ciout: 102862306a36Sopenharmony_ci kfree(branches_off); 102962306a36Sopenharmony_ci return ret; 103062306a36Sopenharmony_ci} 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_ciint arch_prepare_bpf_trampoline(struct bpf_tramp_image *im, void *image, 103362306a36Sopenharmony_ci void *image_end, const struct btf_func_model *m, 103462306a36Sopenharmony_ci u32 flags, struct bpf_tramp_links *tlinks, 103562306a36Sopenharmony_ci void *func_addr) 103662306a36Sopenharmony_ci{ 103762306a36Sopenharmony_ci int ret; 103862306a36Sopenharmony_ci struct rv_jit_context ctx; 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci ctx.ninsns = 0; 104162306a36Sopenharmony_ci ctx.insns = NULL; 104262306a36Sopenharmony_ci ctx.ro_insns = NULL; 104362306a36Sopenharmony_ci ret = __arch_prepare_bpf_trampoline(im, m, tlinks, func_addr, flags, &ctx); 104462306a36Sopenharmony_ci if (ret < 0) 104562306a36Sopenharmony_ci return ret; 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci if (ninsns_rvoff(ret) > (long)image_end - (long)image) 104862306a36Sopenharmony_ci return -EFBIG; 104962306a36Sopenharmony_ci 105062306a36Sopenharmony_ci ctx.ninsns = 0; 105162306a36Sopenharmony_ci /* 105262306a36Sopenharmony_ci * The bpf_int_jit_compile() uses a RW buffer (ctx.insns) to write the 105362306a36Sopenharmony_ci * JITed instructions and later copies it to a RX region (ctx.ro_insns). 105462306a36Sopenharmony_ci * It also uses ctx.ro_insns to calculate offsets for jumps etc. As the 105562306a36Sopenharmony_ci * trampoline image uses the same memory area for writing and execution, 105662306a36Sopenharmony_ci * both ctx.insns and ctx.ro_insns can be set to image. 105762306a36Sopenharmony_ci */ 105862306a36Sopenharmony_ci ctx.insns = image; 105962306a36Sopenharmony_ci ctx.ro_insns = image; 106062306a36Sopenharmony_ci ret = __arch_prepare_bpf_trampoline(im, m, tlinks, func_addr, flags, &ctx); 106162306a36Sopenharmony_ci if (ret < 0) 106262306a36Sopenharmony_ci return ret; 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_ci bpf_flush_icache(ctx.insns, ctx.insns + ctx.ninsns); 106562306a36Sopenharmony_ci 106662306a36Sopenharmony_ci return ninsns_rvoff(ret); 106762306a36Sopenharmony_ci} 106862306a36Sopenharmony_ci 106962306a36Sopenharmony_ciint bpf_jit_emit_insn(const struct bpf_insn *insn, struct rv_jit_context *ctx, 107062306a36Sopenharmony_ci bool extra_pass) 107162306a36Sopenharmony_ci{ 107262306a36Sopenharmony_ci bool is64 = BPF_CLASS(insn->code) == BPF_ALU64 || 107362306a36Sopenharmony_ci BPF_CLASS(insn->code) == BPF_JMP; 107462306a36Sopenharmony_ci int s, e, rvoff, ret, i = insn - ctx->prog->insnsi; 107562306a36Sopenharmony_ci struct bpf_prog_aux *aux = ctx->prog->aux; 107662306a36Sopenharmony_ci u8 rd = -1, rs = -1, code = insn->code; 107762306a36Sopenharmony_ci s16 off = insn->off; 107862306a36Sopenharmony_ci s32 imm = insn->imm; 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_ci init_regs(&rd, &rs, insn, ctx); 108162306a36Sopenharmony_ci 108262306a36Sopenharmony_ci switch (code) { 108362306a36Sopenharmony_ci /* dst = src */ 108462306a36Sopenharmony_ci case BPF_ALU | BPF_MOV | BPF_X: 108562306a36Sopenharmony_ci case BPF_ALU64 | BPF_MOV | BPF_X: 108662306a36Sopenharmony_ci if (imm == 1) { 108762306a36Sopenharmony_ci /* Special mov32 for zext */ 108862306a36Sopenharmony_ci emit_zext_32(rd, ctx); 108962306a36Sopenharmony_ci break; 109062306a36Sopenharmony_ci } 109162306a36Sopenharmony_ci switch (insn->off) { 109262306a36Sopenharmony_ci case 0: 109362306a36Sopenharmony_ci emit_mv(rd, rs, ctx); 109462306a36Sopenharmony_ci break; 109562306a36Sopenharmony_ci case 8: 109662306a36Sopenharmony_ci case 16: 109762306a36Sopenharmony_ci emit_slli(RV_REG_T1, rs, 64 - insn->off, ctx); 109862306a36Sopenharmony_ci emit_srai(rd, RV_REG_T1, 64 - insn->off, ctx); 109962306a36Sopenharmony_ci break; 110062306a36Sopenharmony_ci case 32: 110162306a36Sopenharmony_ci emit_addiw(rd, rs, 0, ctx); 110262306a36Sopenharmony_ci break; 110362306a36Sopenharmony_ci } 110462306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 110562306a36Sopenharmony_ci emit_zext_32(rd, ctx); 110662306a36Sopenharmony_ci break; 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci /* dst = dst OP src */ 110962306a36Sopenharmony_ci case BPF_ALU | BPF_ADD | BPF_X: 111062306a36Sopenharmony_ci case BPF_ALU64 | BPF_ADD | BPF_X: 111162306a36Sopenharmony_ci emit_add(rd, rd, rs, ctx); 111262306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 111362306a36Sopenharmony_ci emit_zext_32(rd, ctx); 111462306a36Sopenharmony_ci break; 111562306a36Sopenharmony_ci case BPF_ALU | BPF_SUB | BPF_X: 111662306a36Sopenharmony_ci case BPF_ALU64 | BPF_SUB | BPF_X: 111762306a36Sopenharmony_ci if (is64) 111862306a36Sopenharmony_ci emit_sub(rd, rd, rs, ctx); 111962306a36Sopenharmony_ci else 112062306a36Sopenharmony_ci emit_subw(rd, rd, rs, ctx); 112162306a36Sopenharmony_ci 112262306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 112362306a36Sopenharmony_ci emit_zext_32(rd, ctx); 112462306a36Sopenharmony_ci break; 112562306a36Sopenharmony_ci case BPF_ALU | BPF_AND | BPF_X: 112662306a36Sopenharmony_ci case BPF_ALU64 | BPF_AND | BPF_X: 112762306a36Sopenharmony_ci emit_and(rd, rd, rs, ctx); 112862306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 112962306a36Sopenharmony_ci emit_zext_32(rd, ctx); 113062306a36Sopenharmony_ci break; 113162306a36Sopenharmony_ci case BPF_ALU | BPF_OR | BPF_X: 113262306a36Sopenharmony_ci case BPF_ALU64 | BPF_OR | BPF_X: 113362306a36Sopenharmony_ci emit_or(rd, rd, rs, ctx); 113462306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 113562306a36Sopenharmony_ci emit_zext_32(rd, ctx); 113662306a36Sopenharmony_ci break; 113762306a36Sopenharmony_ci case BPF_ALU | BPF_XOR | BPF_X: 113862306a36Sopenharmony_ci case BPF_ALU64 | BPF_XOR | BPF_X: 113962306a36Sopenharmony_ci emit_xor(rd, rd, rs, ctx); 114062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 114162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 114262306a36Sopenharmony_ci break; 114362306a36Sopenharmony_ci case BPF_ALU | BPF_MUL | BPF_X: 114462306a36Sopenharmony_ci case BPF_ALU64 | BPF_MUL | BPF_X: 114562306a36Sopenharmony_ci emit(is64 ? rv_mul(rd, rd, rs) : rv_mulw(rd, rd, rs), ctx); 114662306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 114762306a36Sopenharmony_ci emit_zext_32(rd, ctx); 114862306a36Sopenharmony_ci break; 114962306a36Sopenharmony_ci case BPF_ALU | BPF_DIV | BPF_X: 115062306a36Sopenharmony_ci case BPF_ALU64 | BPF_DIV | BPF_X: 115162306a36Sopenharmony_ci if (off) 115262306a36Sopenharmony_ci emit(is64 ? rv_div(rd, rd, rs) : rv_divw(rd, rd, rs), ctx); 115362306a36Sopenharmony_ci else 115462306a36Sopenharmony_ci emit(is64 ? rv_divu(rd, rd, rs) : rv_divuw(rd, rd, rs), ctx); 115562306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 115662306a36Sopenharmony_ci emit_zext_32(rd, ctx); 115762306a36Sopenharmony_ci break; 115862306a36Sopenharmony_ci case BPF_ALU | BPF_MOD | BPF_X: 115962306a36Sopenharmony_ci case BPF_ALU64 | BPF_MOD | BPF_X: 116062306a36Sopenharmony_ci if (off) 116162306a36Sopenharmony_ci emit(is64 ? rv_rem(rd, rd, rs) : rv_remw(rd, rd, rs), ctx); 116262306a36Sopenharmony_ci else 116362306a36Sopenharmony_ci emit(is64 ? rv_remu(rd, rd, rs) : rv_remuw(rd, rd, rs), ctx); 116462306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 116562306a36Sopenharmony_ci emit_zext_32(rd, ctx); 116662306a36Sopenharmony_ci break; 116762306a36Sopenharmony_ci case BPF_ALU | BPF_LSH | BPF_X: 116862306a36Sopenharmony_ci case BPF_ALU64 | BPF_LSH | BPF_X: 116962306a36Sopenharmony_ci emit(is64 ? rv_sll(rd, rd, rs) : rv_sllw(rd, rd, rs), ctx); 117062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 117162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 117262306a36Sopenharmony_ci break; 117362306a36Sopenharmony_ci case BPF_ALU | BPF_RSH | BPF_X: 117462306a36Sopenharmony_ci case BPF_ALU64 | BPF_RSH | BPF_X: 117562306a36Sopenharmony_ci emit(is64 ? rv_srl(rd, rd, rs) : rv_srlw(rd, rd, rs), ctx); 117662306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 117762306a36Sopenharmony_ci emit_zext_32(rd, ctx); 117862306a36Sopenharmony_ci break; 117962306a36Sopenharmony_ci case BPF_ALU | BPF_ARSH | BPF_X: 118062306a36Sopenharmony_ci case BPF_ALU64 | BPF_ARSH | BPF_X: 118162306a36Sopenharmony_ci emit(is64 ? rv_sra(rd, rd, rs) : rv_sraw(rd, rd, rs), ctx); 118262306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 118362306a36Sopenharmony_ci emit_zext_32(rd, ctx); 118462306a36Sopenharmony_ci break; 118562306a36Sopenharmony_ci 118662306a36Sopenharmony_ci /* dst = -dst */ 118762306a36Sopenharmony_ci case BPF_ALU | BPF_NEG: 118862306a36Sopenharmony_ci case BPF_ALU64 | BPF_NEG: 118962306a36Sopenharmony_ci emit_sub(rd, RV_REG_ZERO, rd, ctx); 119062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 119162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 119262306a36Sopenharmony_ci break; 119362306a36Sopenharmony_ci 119462306a36Sopenharmony_ci /* dst = BSWAP##imm(dst) */ 119562306a36Sopenharmony_ci case BPF_ALU | BPF_END | BPF_FROM_LE: 119662306a36Sopenharmony_ci switch (imm) { 119762306a36Sopenharmony_ci case 16: 119862306a36Sopenharmony_ci emit_slli(rd, rd, 48, ctx); 119962306a36Sopenharmony_ci emit_srli(rd, rd, 48, ctx); 120062306a36Sopenharmony_ci break; 120162306a36Sopenharmony_ci case 32: 120262306a36Sopenharmony_ci if (!aux->verifier_zext) 120362306a36Sopenharmony_ci emit_zext_32(rd, ctx); 120462306a36Sopenharmony_ci break; 120562306a36Sopenharmony_ci case 64: 120662306a36Sopenharmony_ci /* Do nothing */ 120762306a36Sopenharmony_ci break; 120862306a36Sopenharmony_ci } 120962306a36Sopenharmony_ci break; 121062306a36Sopenharmony_ci 121162306a36Sopenharmony_ci case BPF_ALU | BPF_END | BPF_FROM_BE: 121262306a36Sopenharmony_ci case BPF_ALU64 | BPF_END | BPF_FROM_LE: 121362306a36Sopenharmony_ci emit_li(RV_REG_T2, 0, ctx); 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 121662306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 121762306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 121862306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 121962306a36Sopenharmony_ci if (imm == 16) 122062306a36Sopenharmony_ci goto out_be; 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 122362306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 122462306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 122562306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 122862306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 122962306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 123062306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 123162306a36Sopenharmony_ci if (imm == 32) 123262306a36Sopenharmony_ci goto out_be; 123362306a36Sopenharmony_ci 123462306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 123562306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 123662306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 123762306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 123862306a36Sopenharmony_ci 123962306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 124062306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 124162306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 124262306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 124362306a36Sopenharmony_ci 124462306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 124562306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 124662306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 124762306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 124862306a36Sopenharmony_ci 124962306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 125062306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 125162306a36Sopenharmony_ci emit_slli(RV_REG_T2, RV_REG_T2, 8, ctx); 125262306a36Sopenharmony_ci emit_srli(rd, rd, 8, ctx); 125362306a36Sopenharmony_ciout_be: 125462306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, 0xff, ctx); 125562306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, RV_REG_T1, ctx); 125662306a36Sopenharmony_ci 125762306a36Sopenharmony_ci emit_mv(rd, RV_REG_T2, ctx); 125862306a36Sopenharmony_ci break; 125962306a36Sopenharmony_ci 126062306a36Sopenharmony_ci /* dst = imm */ 126162306a36Sopenharmony_ci case BPF_ALU | BPF_MOV | BPF_K: 126262306a36Sopenharmony_ci case BPF_ALU64 | BPF_MOV | BPF_K: 126362306a36Sopenharmony_ci emit_imm(rd, imm, ctx); 126462306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 126562306a36Sopenharmony_ci emit_zext_32(rd, ctx); 126662306a36Sopenharmony_ci break; 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci /* dst = dst OP imm */ 126962306a36Sopenharmony_ci case BPF_ALU | BPF_ADD | BPF_K: 127062306a36Sopenharmony_ci case BPF_ALU64 | BPF_ADD | BPF_K: 127162306a36Sopenharmony_ci if (is_12b_int(imm)) { 127262306a36Sopenharmony_ci emit_addi(rd, rd, imm, ctx); 127362306a36Sopenharmony_ci } else { 127462306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 127562306a36Sopenharmony_ci emit_add(rd, rd, RV_REG_T1, ctx); 127662306a36Sopenharmony_ci } 127762306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 127862306a36Sopenharmony_ci emit_zext_32(rd, ctx); 127962306a36Sopenharmony_ci break; 128062306a36Sopenharmony_ci case BPF_ALU | BPF_SUB | BPF_K: 128162306a36Sopenharmony_ci case BPF_ALU64 | BPF_SUB | BPF_K: 128262306a36Sopenharmony_ci if (is_12b_int(-imm)) { 128362306a36Sopenharmony_ci emit_addi(rd, rd, -imm, ctx); 128462306a36Sopenharmony_ci } else { 128562306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 128662306a36Sopenharmony_ci emit_sub(rd, rd, RV_REG_T1, ctx); 128762306a36Sopenharmony_ci } 128862306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 128962306a36Sopenharmony_ci emit_zext_32(rd, ctx); 129062306a36Sopenharmony_ci break; 129162306a36Sopenharmony_ci case BPF_ALU | BPF_AND | BPF_K: 129262306a36Sopenharmony_ci case BPF_ALU64 | BPF_AND | BPF_K: 129362306a36Sopenharmony_ci if (is_12b_int(imm)) { 129462306a36Sopenharmony_ci emit_andi(rd, rd, imm, ctx); 129562306a36Sopenharmony_ci } else { 129662306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 129762306a36Sopenharmony_ci emit_and(rd, rd, RV_REG_T1, ctx); 129862306a36Sopenharmony_ci } 129962306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 130062306a36Sopenharmony_ci emit_zext_32(rd, ctx); 130162306a36Sopenharmony_ci break; 130262306a36Sopenharmony_ci case BPF_ALU | BPF_OR | BPF_K: 130362306a36Sopenharmony_ci case BPF_ALU64 | BPF_OR | BPF_K: 130462306a36Sopenharmony_ci if (is_12b_int(imm)) { 130562306a36Sopenharmony_ci emit(rv_ori(rd, rd, imm), ctx); 130662306a36Sopenharmony_ci } else { 130762306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 130862306a36Sopenharmony_ci emit_or(rd, rd, RV_REG_T1, ctx); 130962306a36Sopenharmony_ci } 131062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 131162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 131262306a36Sopenharmony_ci break; 131362306a36Sopenharmony_ci case BPF_ALU | BPF_XOR | BPF_K: 131462306a36Sopenharmony_ci case BPF_ALU64 | BPF_XOR | BPF_K: 131562306a36Sopenharmony_ci if (is_12b_int(imm)) { 131662306a36Sopenharmony_ci emit(rv_xori(rd, rd, imm), ctx); 131762306a36Sopenharmony_ci } else { 131862306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 131962306a36Sopenharmony_ci emit_xor(rd, rd, RV_REG_T1, ctx); 132062306a36Sopenharmony_ci } 132162306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 132262306a36Sopenharmony_ci emit_zext_32(rd, ctx); 132362306a36Sopenharmony_ci break; 132462306a36Sopenharmony_ci case BPF_ALU | BPF_MUL | BPF_K: 132562306a36Sopenharmony_ci case BPF_ALU64 | BPF_MUL | BPF_K: 132662306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 132762306a36Sopenharmony_ci emit(is64 ? rv_mul(rd, rd, RV_REG_T1) : 132862306a36Sopenharmony_ci rv_mulw(rd, rd, RV_REG_T1), ctx); 132962306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 133062306a36Sopenharmony_ci emit_zext_32(rd, ctx); 133162306a36Sopenharmony_ci break; 133262306a36Sopenharmony_ci case BPF_ALU | BPF_DIV | BPF_K: 133362306a36Sopenharmony_ci case BPF_ALU64 | BPF_DIV | BPF_K: 133462306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 133562306a36Sopenharmony_ci if (off) 133662306a36Sopenharmony_ci emit(is64 ? rv_div(rd, rd, RV_REG_T1) : 133762306a36Sopenharmony_ci rv_divw(rd, rd, RV_REG_T1), ctx); 133862306a36Sopenharmony_ci else 133962306a36Sopenharmony_ci emit(is64 ? rv_divu(rd, rd, RV_REG_T1) : 134062306a36Sopenharmony_ci rv_divuw(rd, rd, RV_REG_T1), ctx); 134162306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 134262306a36Sopenharmony_ci emit_zext_32(rd, ctx); 134362306a36Sopenharmony_ci break; 134462306a36Sopenharmony_ci case BPF_ALU | BPF_MOD | BPF_K: 134562306a36Sopenharmony_ci case BPF_ALU64 | BPF_MOD | BPF_K: 134662306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 134762306a36Sopenharmony_ci if (off) 134862306a36Sopenharmony_ci emit(is64 ? rv_rem(rd, rd, RV_REG_T1) : 134962306a36Sopenharmony_ci rv_remw(rd, rd, RV_REG_T1), ctx); 135062306a36Sopenharmony_ci else 135162306a36Sopenharmony_ci emit(is64 ? rv_remu(rd, rd, RV_REG_T1) : 135262306a36Sopenharmony_ci rv_remuw(rd, rd, RV_REG_T1), ctx); 135362306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 135462306a36Sopenharmony_ci emit_zext_32(rd, ctx); 135562306a36Sopenharmony_ci break; 135662306a36Sopenharmony_ci case BPF_ALU | BPF_LSH | BPF_K: 135762306a36Sopenharmony_ci case BPF_ALU64 | BPF_LSH | BPF_K: 135862306a36Sopenharmony_ci emit_slli(rd, rd, imm, ctx); 135962306a36Sopenharmony_ci 136062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 136162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 136262306a36Sopenharmony_ci break; 136362306a36Sopenharmony_ci case BPF_ALU | BPF_RSH | BPF_K: 136462306a36Sopenharmony_ci case BPF_ALU64 | BPF_RSH | BPF_K: 136562306a36Sopenharmony_ci if (is64) 136662306a36Sopenharmony_ci emit_srli(rd, rd, imm, ctx); 136762306a36Sopenharmony_ci else 136862306a36Sopenharmony_ci emit(rv_srliw(rd, rd, imm), ctx); 136962306a36Sopenharmony_ci 137062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 137162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 137262306a36Sopenharmony_ci break; 137362306a36Sopenharmony_ci case BPF_ALU | BPF_ARSH | BPF_K: 137462306a36Sopenharmony_ci case BPF_ALU64 | BPF_ARSH | BPF_K: 137562306a36Sopenharmony_ci if (is64) 137662306a36Sopenharmony_ci emit_srai(rd, rd, imm, ctx); 137762306a36Sopenharmony_ci else 137862306a36Sopenharmony_ci emit(rv_sraiw(rd, rd, imm), ctx); 137962306a36Sopenharmony_ci 138062306a36Sopenharmony_ci if (!is64 && !aux->verifier_zext) 138162306a36Sopenharmony_ci emit_zext_32(rd, ctx); 138262306a36Sopenharmony_ci break; 138362306a36Sopenharmony_ci 138462306a36Sopenharmony_ci /* JUMP off */ 138562306a36Sopenharmony_ci case BPF_JMP | BPF_JA: 138662306a36Sopenharmony_ci case BPF_JMP32 | BPF_JA: 138762306a36Sopenharmony_ci if (BPF_CLASS(code) == BPF_JMP) 138862306a36Sopenharmony_ci rvoff = rv_offset(i, off, ctx); 138962306a36Sopenharmony_ci else 139062306a36Sopenharmony_ci rvoff = rv_offset(i, imm, ctx); 139162306a36Sopenharmony_ci ret = emit_jump_and_link(RV_REG_ZERO, rvoff, true, ctx); 139262306a36Sopenharmony_ci if (ret) 139362306a36Sopenharmony_ci return ret; 139462306a36Sopenharmony_ci break; 139562306a36Sopenharmony_ci 139662306a36Sopenharmony_ci /* IF (dst COND src) JUMP off */ 139762306a36Sopenharmony_ci case BPF_JMP | BPF_JEQ | BPF_X: 139862306a36Sopenharmony_ci case BPF_JMP32 | BPF_JEQ | BPF_X: 139962306a36Sopenharmony_ci case BPF_JMP | BPF_JGT | BPF_X: 140062306a36Sopenharmony_ci case BPF_JMP32 | BPF_JGT | BPF_X: 140162306a36Sopenharmony_ci case BPF_JMP | BPF_JLT | BPF_X: 140262306a36Sopenharmony_ci case BPF_JMP32 | BPF_JLT | BPF_X: 140362306a36Sopenharmony_ci case BPF_JMP | BPF_JGE | BPF_X: 140462306a36Sopenharmony_ci case BPF_JMP32 | BPF_JGE | BPF_X: 140562306a36Sopenharmony_ci case BPF_JMP | BPF_JLE | BPF_X: 140662306a36Sopenharmony_ci case BPF_JMP32 | BPF_JLE | BPF_X: 140762306a36Sopenharmony_ci case BPF_JMP | BPF_JNE | BPF_X: 140862306a36Sopenharmony_ci case BPF_JMP32 | BPF_JNE | BPF_X: 140962306a36Sopenharmony_ci case BPF_JMP | BPF_JSGT | BPF_X: 141062306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSGT | BPF_X: 141162306a36Sopenharmony_ci case BPF_JMP | BPF_JSLT | BPF_X: 141262306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSLT | BPF_X: 141362306a36Sopenharmony_ci case BPF_JMP | BPF_JSGE | BPF_X: 141462306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSGE | BPF_X: 141562306a36Sopenharmony_ci case BPF_JMP | BPF_JSLE | BPF_X: 141662306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSLE | BPF_X: 141762306a36Sopenharmony_ci case BPF_JMP | BPF_JSET | BPF_X: 141862306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSET | BPF_X: 141962306a36Sopenharmony_ci rvoff = rv_offset(i, off, ctx); 142062306a36Sopenharmony_ci if (!is64) { 142162306a36Sopenharmony_ci s = ctx->ninsns; 142262306a36Sopenharmony_ci if (is_signed_bpf_cond(BPF_OP(code))) 142362306a36Sopenharmony_ci emit_sext_32_rd_rs(&rd, &rs, ctx); 142462306a36Sopenharmony_ci else 142562306a36Sopenharmony_ci emit_zext_32_rd_rs(&rd, &rs, ctx); 142662306a36Sopenharmony_ci e = ctx->ninsns; 142762306a36Sopenharmony_ci 142862306a36Sopenharmony_ci /* Adjust for extra insns */ 142962306a36Sopenharmony_ci rvoff -= ninsns_rvoff(e - s); 143062306a36Sopenharmony_ci } 143162306a36Sopenharmony_ci 143262306a36Sopenharmony_ci if (BPF_OP(code) == BPF_JSET) { 143362306a36Sopenharmony_ci /* Adjust for and */ 143462306a36Sopenharmony_ci rvoff -= 4; 143562306a36Sopenharmony_ci emit_and(RV_REG_T1, rd, rs, ctx); 143662306a36Sopenharmony_ci emit_branch(BPF_JNE, RV_REG_T1, RV_REG_ZERO, rvoff, 143762306a36Sopenharmony_ci ctx); 143862306a36Sopenharmony_ci } else { 143962306a36Sopenharmony_ci emit_branch(BPF_OP(code), rd, rs, rvoff, ctx); 144062306a36Sopenharmony_ci } 144162306a36Sopenharmony_ci break; 144262306a36Sopenharmony_ci 144362306a36Sopenharmony_ci /* IF (dst COND imm) JUMP off */ 144462306a36Sopenharmony_ci case BPF_JMP | BPF_JEQ | BPF_K: 144562306a36Sopenharmony_ci case BPF_JMP32 | BPF_JEQ | BPF_K: 144662306a36Sopenharmony_ci case BPF_JMP | BPF_JGT | BPF_K: 144762306a36Sopenharmony_ci case BPF_JMP32 | BPF_JGT | BPF_K: 144862306a36Sopenharmony_ci case BPF_JMP | BPF_JLT | BPF_K: 144962306a36Sopenharmony_ci case BPF_JMP32 | BPF_JLT | BPF_K: 145062306a36Sopenharmony_ci case BPF_JMP | BPF_JGE | BPF_K: 145162306a36Sopenharmony_ci case BPF_JMP32 | BPF_JGE | BPF_K: 145262306a36Sopenharmony_ci case BPF_JMP | BPF_JLE | BPF_K: 145362306a36Sopenharmony_ci case BPF_JMP32 | BPF_JLE | BPF_K: 145462306a36Sopenharmony_ci case BPF_JMP | BPF_JNE | BPF_K: 145562306a36Sopenharmony_ci case BPF_JMP32 | BPF_JNE | BPF_K: 145662306a36Sopenharmony_ci case BPF_JMP | BPF_JSGT | BPF_K: 145762306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSGT | BPF_K: 145862306a36Sopenharmony_ci case BPF_JMP | BPF_JSLT | BPF_K: 145962306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSLT | BPF_K: 146062306a36Sopenharmony_ci case BPF_JMP | BPF_JSGE | BPF_K: 146162306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSGE | BPF_K: 146262306a36Sopenharmony_ci case BPF_JMP | BPF_JSLE | BPF_K: 146362306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSLE | BPF_K: 146462306a36Sopenharmony_ci rvoff = rv_offset(i, off, ctx); 146562306a36Sopenharmony_ci s = ctx->ninsns; 146662306a36Sopenharmony_ci if (imm) { 146762306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 146862306a36Sopenharmony_ci rs = RV_REG_T1; 146962306a36Sopenharmony_ci } else { 147062306a36Sopenharmony_ci /* If imm is 0, simply use zero register. */ 147162306a36Sopenharmony_ci rs = RV_REG_ZERO; 147262306a36Sopenharmony_ci } 147362306a36Sopenharmony_ci if (!is64) { 147462306a36Sopenharmony_ci if (is_signed_bpf_cond(BPF_OP(code))) 147562306a36Sopenharmony_ci emit_sext_32_rd(&rd, ctx); 147662306a36Sopenharmony_ci else 147762306a36Sopenharmony_ci emit_zext_32_rd_t1(&rd, ctx); 147862306a36Sopenharmony_ci } 147962306a36Sopenharmony_ci e = ctx->ninsns; 148062306a36Sopenharmony_ci 148162306a36Sopenharmony_ci /* Adjust for extra insns */ 148262306a36Sopenharmony_ci rvoff -= ninsns_rvoff(e - s); 148362306a36Sopenharmony_ci emit_branch(BPF_OP(code), rd, rs, rvoff, ctx); 148462306a36Sopenharmony_ci break; 148562306a36Sopenharmony_ci 148662306a36Sopenharmony_ci case BPF_JMP | BPF_JSET | BPF_K: 148762306a36Sopenharmony_ci case BPF_JMP32 | BPF_JSET | BPF_K: 148862306a36Sopenharmony_ci rvoff = rv_offset(i, off, ctx); 148962306a36Sopenharmony_ci s = ctx->ninsns; 149062306a36Sopenharmony_ci if (is_12b_int(imm)) { 149162306a36Sopenharmony_ci emit_andi(RV_REG_T1, rd, imm, ctx); 149262306a36Sopenharmony_ci } else { 149362306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 149462306a36Sopenharmony_ci emit_and(RV_REG_T1, rd, RV_REG_T1, ctx); 149562306a36Sopenharmony_ci } 149662306a36Sopenharmony_ci /* For jset32, we should clear the upper 32 bits of t1, but 149762306a36Sopenharmony_ci * sign-extension is sufficient here and saves one instruction, 149862306a36Sopenharmony_ci * as t1 is used only in comparison against zero. 149962306a36Sopenharmony_ci */ 150062306a36Sopenharmony_ci if (!is64 && imm < 0) 150162306a36Sopenharmony_ci emit_addiw(RV_REG_T1, RV_REG_T1, 0, ctx); 150262306a36Sopenharmony_ci e = ctx->ninsns; 150362306a36Sopenharmony_ci rvoff -= ninsns_rvoff(e - s); 150462306a36Sopenharmony_ci emit_branch(BPF_JNE, RV_REG_T1, RV_REG_ZERO, rvoff, ctx); 150562306a36Sopenharmony_ci break; 150662306a36Sopenharmony_ci 150762306a36Sopenharmony_ci /* function call */ 150862306a36Sopenharmony_ci case BPF_JMP | BPF_CALL: 150962306a36Sopenharmony_ci { 151062306a36Sopenharmony_ci bool fixed_addr; 151162306a36Sopenharmony_ci u64 addr; 151262306a36Sopenharmony_ci 151362306a36Sopenharmony_ci mark_call(ctx); 151462306a36Sopenharmony_ci ret = bpf_jit_get_func_addr(ctx->prog, insn, extra_pass, 151562306a36Sopenharmony_ci &addr, &fixed_addr); 151662306a36Sopenharmony_ci if (ret < 0) 151762306a36Sopenharmony_ci return ret; 151862306a36Sopenharmony_ci 151962306a36Sopenharmony_ci ret = emit_call(addr, fixed_addr, ctx); 152062306a36Sopenharmony_ci if (ret) 152162306a36Sopenharmony_ci return ret; 152262306a36Sopenharmony_ci 152362306a36Sopenharmony_ci if (insn->src_reg != BPF_PSEUDO_CALL) 152462306a36Sopenharmony_ci emit_mv(bpf_to_rv_reg(BPF_REG_0, ctx), RV_REG_A0, ctx); 152562306a36Sopenharmony_ci break; 152662306a36Sopenharmony_ci } 152762306a36Sopenharmony_ci /* tail call */ 152862306a36Sopenharmony_ci case BPF_JMP | BPF_TAIL_CALL: 152962306a36Sopenharmony_ci if (emit_bpf_tail_call(i, ctx)) 153062306a36Sopenharmony_ci return -1; 153162306a36Sopenharmony_ci break; 153262306a36Sopenharmony_ci 153362306a36Sopenharmony_ci /* function return */ 153462306a36Sopenharmony_ci case BPF_JMP | BPF_EXIT: 153562306a36Sopenharmony_ci if (i == ctx->prog->len - 1) 153662306a36Sopenharmony_ci break; 153762306a36Sopenharmony_ci 153862306a36Sopenharmony_ci rvoff = epilogue_offset(ctx); 153962306a36Sopenharmony_ci ret = emit_jump_and_link(RV_REG_ZERO, rvoff, true, ctx); 154062306a36Sopenharmony_ci if (ret) 154162306a36Sopenharmony_ci return ret; 154262306a36Sopenharmony_ci break; 154362306a36Sopenharmony_ci 154462306a36Sopenharmony_ci /* dst = imm64 */ 154562306a36Sopenharmony_ci case BPF_LD | BPF_IMM | BPF_DW: 154662306a36Sopenharmony_ci { 154762306a36Sopenharmony_ci struct bpf_insn insn1 = insn[1]; 154862306a36Sopenharmony_ci u64 imm64; 154962306a36Sopenharmony_ci 155062306a36Sopenharmony_ci imm64 = (u64)insn1.imm << 32 | (u32)imm; 155162306a36Sopenharmony_ci if (bpf_pseudo_func(insn)) { 155262306a36Sopenharmony_ci /* fixed-length insns for extra jit pass */ 155362306a36Sopenharmony_ci ret = emit_addr(rd, imm64, extra_pass, ctx); 155462306a36Sopenharmony_ci if (ret) 155562306a36Sopenharmony_ci return ret; 155662306a36Sopenharmony_ci } else { 155762306a36Sopenharmony_ci emit_imm(rd, imm64, ctx); 155862306a36Sopenharmony_ci } 155962306a36Sopenharmony_ci 156062306a36Sopenharmony_ci return 1; 156162306a36Sopenharmony_ci } 156262306a36Sopenharmony_ci 156362306a36Sopenharmony_ci /* LDX: dst = *(unsigned size *)(src + off) */ 156462306a36Sopenharmony_ci case BPF_LDX | BPF_MEM | BPF_B: 156562306a36Sopenharmony_ci case BPF_LDX | BPF_MEM | BPF_H: 156662306a36Sopenharmony_ci case BPF_LDX | BPF_MEM | BPF_W: 156762306a36Sopenharmony_ci case BPF_LDX | BPF_MEM | BPF_DW: 156862306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEM | BPF_B: 156962306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEM | BPF_H: 157062306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEM | BPF_W: 157162306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEM | BPF_DW: 157262306a36Sopenharmony_ci /* LDSX: dst = *(signed size *)(src + off) */ 157362306a36Sopenharmony_ci case BPF_LDX | BPF_MEMSX | BPF_B: 157462306a36Sopenharmony_ci case BPF_LDX | BPF_MEMSX | BPF_H: 157562306a36Sopenharmony_ci case BPF_LDX | BPF_MEMSX | BPF_W: 157662306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEMSX | BPF_B: 157762306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEMSX | BPF_H: 157862306a36Sopenharmony_ci case BPF_LDX | BPF_PROBE_MEMSX | BPF_W: 157962306a36Sopenharmony_ci { 158062306a36Sopenharmony_ci int insn_len, insns_start; 158162306a36Sopenharmony_ci bool sign_ext; 158262306a36Sopenharmony_ci 158362306a36Sopenharmony_ci sign_ext = BPF_MODE(insn->code) == BPF_MEMSX || 158462306a36Sopenharmony_ci BPF_MODE(insn->code) == BPF_PROBE_MEMSX; 158562306a36Sopenharmony_ci 158662306a36Sopenharmony_ci switch (BPF_SIZE(code)) { 158762306a36Sopenharmony_ci case BPF_B: 158862306a36Sopenharmony_ci if (is_12b_int(off)) { 158962306a36Sopenharmony_ci insns_start = ctx->ninsns; 159062306a36Sopenharmony_ci if (sign_ext) 159162306a36Sopenharmony_ci emit(rv_lb(rd, off, rs), ctx); 159262306a36Sopenharmony_ci else 159362306a36Sopenharmony_ci emit(rv_lbu(rd, off, rs), ctx); 159462306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 159562306a36Sopenharmony_ci break; 159662306a36Sopenharmony_ci } 159762306a36Sopenharmony_ci 159862306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 159962306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rs, ctx); 160062306a36Sopenharmony_ci insns_start = ctx->ninsns; 160162306a36Sopenharmony_ci if (sign_ext) 160262306a36Sopenharmony_ci emit(rv_lb(rd, 0, RV_REG_T1), ctx); 160362306a36Sopenharmony_ci else 160462306a36Sopenharmony_ci emit(rv_lbu(rd, 0, RV_REG_T1), ctx); 160562306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 160662306a36Sopenharmony_ci break; 160762306a36Sopenharmony_ci case BPF_H: 160862306a36Sopenharmony_ci if (is_12b_int(off)) { 160962306a36Sopenharmony_ci insns_start = ctx->ninsns; 161062306a36Sopenharmony_ci if (sign_ext) 161162306a36Sopenharmony_ci emit(rv_lh(rd, off, rs), ctx); 161262306a36Sopenharmony_ci else 161362306a36Sopenharmony_ci emit(rv_lhu(rd, off, rs), ctx); 161462306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 161562306a36Sopenharmony_ci break; 161662306a36Sopenharmony_ci } 161762306a36Sopenharmony_ci 161862306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 161962306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rs, ctx); 162062306a36Sopenharmony_ci insns_start = ctx->ninsns; 162162306a36Sopenharmony_ci if (sign_ext) 162262306a36Sopenharmony_ci emit(rv_lh(rd, 0, RV_REG_T1), ctx); 162362306a36Sopenharmony_ci else 162462306a36Sopenharmony_ci emit(rv_lhu(rd, 0, RV_REG_T1), ctx); 162562306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 162662306a36Sopenharmony_ci break; 162762306a36Sopenharmony_ci case BPF_W: 162862306a36Sopenharmony_ci if (is_12b_int(off)) { 162962306a36Sopenharmony_ci insns_start = ctx->ninsns; 163062306a36Sopenharmony_ci if (sign_ext) 163162306a36Sopenharmony_ci emit(rv_lw(rd, off, rs), ctx); 163262306a36Sopenharmony_ci else 163362306a36Sopenharmony_ci emit(rv_lwu(rd, off, rs), ctx); 163462306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 163562306a36Sopenharmony_ci break; 163662306a36Sopenharmony_ci } 163762306a36Sopenharmony_ci 163862306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 163962306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rs, ctx); 164062306a36Sopenharmony_ci insns_start = ctx->ninsns; 164162306a36Sopenharmony_ci if (sign_ext) 164262306a36Sopenharmony_ci emit(rv_lw(rd, 0, RV_REG_T1), ctx); 164362306a36Sopenharmony_ci else 164462306a36Sopenharmony_ci emit(rv_lwu(rd, 0, RV_REG_T1), ctx); 164562306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 164662306a36Sopenharmony_ci break; 164762306a36Sopenharmony_ci case BPF_DW: 164862306a36Sopenharmony_ci if (is_12b_int(off)) { 164962306a36Sopenharmony_ci insns_start = ctx->ninsns; 165062306a36Sopenharmony_ci emit_ld(rd, off, rs, ctx); 165162306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 165262306a36Sopenharmony_ci break; 165362306a36Sopenharmony_ci } 165462306a36Sopenharmony_ci 165562306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 165662306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rs, ctx); 165762306a36Sopenharmony_ci insns_start = ctx->ninsns; 165862306a36Sopenharmony_ci emit_ld(rd, 0, RV_REG_T1, ctx); 165962306a36Sopenharmony_ci insn_len = ctx->ninsns - insns_start; 166062306a36Sopenharmony_ci break; 166162306a36Sopenharmony_ci } 166262306a36Sopenharmony_ci 166362306a36Sopenharmony_ci ret = add_exception_handler(insn, ctx, rd, insn_len); 166462306a36Sopenharmony_ci if (ret) 166562306a36Sopenharmony_ci return ret; 166662306a36Sopenharmony_ci 166762306a36Sopenharmony_ci if (BPF_SIZE(code) != BPF_DW && insn_is_zext(&insn[1])) 166862306a36Sopenharmony_ci return 1; 166962306a36Sopenharmony_ci break; 167062306a36Sopenharmony_ci } 167162306a36Sopenharmony_ci /* speculation barrier */ 167262306a36Sopenharmony_ci case BPF_ST | BPF_NOSPEC: 167362306a36Sopenharmony_ci break; 167462306a36Sopenharmony_ci 167562306a36Sopenharmony_ci /* ST: *(size *)(dst + off) = imm */ 167662306a36Sopenharmony_ci case BPF_ST | BPF_MEM | BPF_B: 167762306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 167862306a36Sopenharmony_ci if (is_12b_int(off)) { 167962306a36Sopenharmony_ci emit(rv_sb(rd, off, RV_REG_T1), ctx); 168062306a36Sopenharmony_ci break; 168162306a36Sopenharmony_ci } 168262306a36Sopenharmony_ci 168362306a36Sopenharmony_ci emit_imm(RV_REG_T2, off, ctx); 168462306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, rd, ctx); 168562306a36Sopenharmony_ci emit(rv_sb(RV_REG_T2, 0, RV_REG_T1), ctx); 168662306a36Sopenharmony_ci break; 168762306a36Sopenharmony_ci 168862306a36Sopenharmony_ci case BPF_ST | BPF_MEM | BPF_H: 168962306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 169062306a36Sopenharmony_ci if (is_12b_int(off)) { 169162306a36Sopenharmony_ci emit(rv_sh(rd, off, RV_REG_T1), ctx); 169262306a36Sopenharmony_ci break; 169362306a36Sopenharmony_ci } 169462306a36Sopenharmony_ci 169562306a36Sopenharmony_ci emit_imm(RV_REG_T2, off, ctx); 169662306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, rd, ctx); 169762306a36Sopenharmony_ci emit(rv_sh(RV_REG_T2, 0, RV_REG_T1), ctx); 169862306a36Sopenharmony_ci break; 169962306a36Sopenharmony_ci case BPF_ST | BPF_MEM | BPF_W: 170062306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 170162306a36Sopenharmony_ci if (is_12b_int(off)) { 170262306a36Sopenharmony_ci emit_sw(rd, off, RV_REG_T1, ctx); 170362306a36Sopenharmony_ci break; 170462306a36Sopenharmony_ci } 170562306a36Sopenharmony_ci 170662306a36Sopenharmony_ci emit_imm(RV_REG_T2, off, ctx); 170762306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, rd, ctx); 170862306a36Sopenharmony_ci emit_sw(RV_REG_T2, 0, RV_REG_T1, ctx); 170962306a36Sopenharmony_ci break; 171062306a36Sopenharmony_ci case BPF_ST | BPF_MEM | BPF_DW: 171162306a36Sopenharmony_ci emit_imm(RV_REG_T1, imm, ctx); 171262306a36Sopenharmony_ci if (is_12b_int(off)) { 171362306a36Sopenharmony_ci emit_sd(rd, off, RV_REG_T1, ctx); 171462306a36Sopenharmony_ci break; 171562306a36Sopenharmony_ci } 171662306a36Sopenharmony_ci 171762306a36Sopenharmony_ci emit_imm(RV_REG_T2, off, ctx); 171862306a36Sopenharmony_ci emit_add(RV_REG_T2, RV_REG_T2, rd, ctx); 171962306a36Sopenharmony_ci emit_sd(RV_REG_T2, 0, RV_REG_T1, ctx); 172062306a36Sopenharmony_ci break; 172162306a36Sopenharmony_ci 172262306a36Sopenharmony_ci /* STX: *(size *)(dst + off) = src */ 172362306a36Sopenharmony_ci case BPF_STX | BPF_MEM | BPF_B: 172462306a36Sopenharmony_ci if (is_12b_int(off)) { 172562306a36Sopenharmony_ci emit(rv_sb(rd, off, rs), ctx); 172662306a36Sopenharmony_ci break; 172762306a36Sopenharmony_ci } 172862306a36Sopenharmony_ci 172962306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 173062306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rd, ctx); 173162306a36Sopenharmony_ci emit(rv_sb(RV_REG_T1, 0, rs), ctx); 173262306a36Sopenharmony_ci break; 173362306a36Sopenharmony_ci case BPF_STX | BPF_MEM | BPF_H: 173462306a36Sopenharmony_ci if (is_12b_int(off)) { 173562306a36Sopenharmony_ci emit(rv_sh(rd, off, rs), ctx); 173662306a36Sopenharmony_ci break; 173762306a36Sopenharmony_ci } 173862306a36Sopenharmony_ci 173962306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 174062306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rd, ctx); 174162306a36Sopenharmony_ci emit(rv_sh(RV_REG_T1, 0, rs), ctx); 174262306a36Sopenharmony_ci break; 174362306a36Sopenharmony_ci case BPF_STX | BPF_MEM | BPF_W: 174462306a36Sopenharmony_ci if (is_12b_int(off)) { 174562306a36Sopenharmony_ci emit_sw(rd, off, rs, ctx); 174662306a36Sopenharmony_ci break; 174762306a36Sopenharmony_ci } 174862306a36Sopenharmony_ci 174962306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 175062306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rd, ctx); 175162306a36Sopenharmony_ci emit_sw(RV_REG_T1, 0, rs, ctx); 175262306a36Sopenharmony_ci break; 175362306a36Sopenharmony_ci case BPF_STX | BPF_MEM | BPF_DW: 175462306a36Sopenharmony_ci if (is_12b_int(off)) { 175562306a36Sopenharmony_ci emit_sd(rd, off, rs, ctx); 175662306a36Sopenharmony_ci break; 175762306a36Sopenharmony_ci } 175862306a36Sopenharmony_ci 175962306a36Sopenharmony_ci emit_imm(RV_REG_T1, off, ctx); 176062306a36Sopenharmony_ci emit_add(RV_REG_T1, RV_REG_T1, rd, ctx); 176162306a36Sopenharmony_ci emit_sd(RV_REG_T1, 0, rs, ctx); 176262306a36Sopenharmony_ci break; 176362306a36Sopenharmony_ci case BPF_STX | BPF_ATOMIC | BPF_W: 176462306a36Sopenharmony_ci case BPF_STX | BPF_ATOMIC | BPF_DW: 176562306a36Sopenharmony_ci emit_atomic(rd, rs, off, imm, 176662306a36Sopenharmony_ci BPF_SIZE(code) == BPF_DW, ctx); 176762306a36Sopenharmony_ci break; 176862306a36Sopenharmony_ci default: 176962306a36Sopenharmony_ci pr_err("bpf-jit: unknown opcode %02x\n", code); 177062306a36Sopenharmony_ci return -EINVAL; 177162306a36Sopenharmony_ci } 177262306a36Sopenharmony_ci 177362306a36Sopenharmony_ci return 0; 177462306a36Sopenharmony_ci} 177562306a36Sopenharmony_ci 177662306a36Sopenharmony_civoid bpf_jit_build_prologue(struct rv_jit_context *ctx) 177762306a36Sopenharmony_ci{ 177862306a36Sopenharmony_ci int i, stack_adjust = 0, store_offset, bpf_stack_adjust; 177962306a36Sopenharmony_ci 178062306a36Sopenharmony_ci bpf_stack_adjust = round_up(ctx->prog->aux->stack_depth, 16); 178162306a36Sopenharmony_ci if (bpf_stack_adjust) 178262306a36Sopenharmony_ci mark_fp(ctx); 178362306a36Sopenharmony_ci 178462306a36Sopenharmony_ci if (seen_reg(RV_REG_RA, ctx)) 178562306a36Sopenharmony_ci stack_adjust += 8; 178662306a36Sopenharmony_ci stack_adjust += 8; /* RV_REG_FP */ 178762306a36Sopenharmony_ci if (seen_reg(RV_REG_S1, ctx)) 178862306a36Sopenharmony_ci stack_adjust += 8; 178962306a36Sopenharmony_ci if (seen_reg(RV_REG_S2, ctx)) 179062306a36Sopenharmony_ci stack_adjust += 8; 179162306a36Sopenharmony_ci if (seen_reg(RV_REG_S3, ctx)) 179262306a36Sopenharmony_ci stack_adjust += 8; 179362306a36Sopenharmony_ci if (seen_reg(RV_REG_S4, ctx)) 179462306a36Sopenharmony_ci stack_adjust += 8; 179562306a36Sopenharmony_ci if (seen_reg(RV_REG_S5, ctx)) 179662306a36Sopenharmony_ci stack_adjust += 8; 179762306a36Sopenharmony_ci if (seen_reg(RV_REG_S6, ctx)) 179862306a36Sopenharmony_ci stack_adjust += 8; 179962306a36Sopenharmony_ci 180062306a36Sopenharmony_ci stack_adjust = round_up(stack_adjust, 16); 180162306a36Sopenharmony_ci stack_adjust += bpf_stack_adjust; 180262306a36Sopenharmony_ci 180362306a36Sopenharmony_ci store_offset = stack_adjust - 8; 180462306a36Sopenharmony_ci 180562306a36Sopenharmony_ci /* nops reserved for auipc+jalr pair */ 180662306a36Sopenharmony_ci for (i = 0; i < RV_FENTRY_NINSNS; i++) 180762306a36Sopenharmony_ci emit(rv_nop(), ctx); 180862306a36Sopenharmony_ci 180962306a36Sopenharmony_ci /* First instruction is always setting the tail-call-counter 181062306a36Sopenharmony_ci * (TCC) register. This instruction is skipped for tail calls. 181162306a36Sopenharmony_ci * Force using a 4-byte (non-compressed) instruction. 181262306a36Sopenharmony_ci */ 181362306a36Sopenharmony_ci emit(rv_addi(RV_REG_TCC, RV_REG_ZERO, MAX_TAIL_CALL_CNT), ctx); 181462306a36Sopenharmony_ci 181562306a36Sopenharmony_ci emit_addi(RV_REG_SP, RV_REG_SP, -stack_adjust, ctx); 181662306a36Sopenharmony_ci 181762306a36Sopenharmony_ci if (seen_reg(RV_REG_RA, ctx)) { 181862306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_RA, ctx); 181962306a36Sopenharmony_ci store_offset -= 8; 182062306a36Sopenharmony_ci } 182162306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_FP, ctx); 182262306a36Sopenharmony_ci store_offset -= 8; 182362306a36Sopenharmony_ci if (seen_reg(RV_REG_S1, ctx)) { 182462306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S1, ctx); 182562306a36Sopenharmony_ci store_offset -= 8; 182662306a36Sopenharmony_ci } 182762306a36Sopenharmony_ci if (seen_reg(RV_REG_S2, ctx)) { 182862306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S2, ctx); 182962306a36Sopenharmony_ci store_offset -= 8; 183062306a36Sopenharmony_ci } 183162306a36Sopenharmony_ci if (seen_reg(RV_REG_S3, ctx)) { 183262306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S3, ctx); 183362306a36Sopenharmony_ci store_offset -= 8; 183462306a36Sopenharmony_ci } 183562306a36Sopenharmony_ci if (seen_reg(RV_REG_S4, ctx)) { 183662306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S4, ctx); 183762306a36Sopenharmony_ci store_offset -= 8; 183862306a36Sopenharmony_ci } 183962306a36Sopenharmony_ci if (seen_reg(RV_REG_S5, ctx)) { 184062306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S5, ctx); 184162306a36Sopenharmony_ci store_offset -= 8; 184262306a36Sopenharmony_ci } 184362306a36Sopenharmony_ci if (seen_reg(RV_REG_S6, ctx)) { 184462306a36Sopenharmony_ci emit_sd(RV_REG_SP, store_offset, RV_REG_S6, ctx); 184562306a36Sopenharmony_ci store_offset -= 8; 184662306a36Sopenharmony_ci } 184762306a36Sopenharmony_ci 184862306a36Sopenharmony_ci emit_addi(RV_REG_FP, RV_REG_SP, stack_adjust, ctx); 184962306a36Sopenharmony_ci 185062306a36Sopenharmony_ci if (bpf_stack_adjust) 185162306a36Sopenharmony_ci emit_addi(RV_REG_S5, RV_REG_SP, bpf_stack_adjust, ctx); 185262306a36Sopenharmony_ci 185362306a36Sopenharmony_ci /* Program contains calls and tail calls, so RV_REG_TCC need 185462306a36Sopenharmony_ci * to be saved across calls. 185562306a36Sopenharmony_ci */ 185662306a36Sopenharmony_ci if (seen_tail_call(ctx) && seen_call(ctx)) 185762306a36Sopenharmony_ci emit_mv(RV_REG_TCC_SAVED, RV_REG_TCC, ctx); 185862306a36Sopenharmony_ci 185962306a36Sopenharmony_ci ctx->stack_size = stack_adjust; 186062306a36Sopenharmony_ci} 186162306a36Sopenharmony_ci 186262306a36Sopenharmony_civoid bpf_jit_build_epilogue(struct rv_jit_context *ctx) 186362306a36Sopenharmony_ci{ 186462306a36Sopenharmony_ci __build_epilogue(false, ctx); 186562306a36Sopenharmony_ci} 186662306a36Sopenharmony_ci 186762306a36Sopenharmony_cibool bpf_jit_supports_kfunc_call(void) 186862306a36Sopenharmony_ci{ 186962306a36Sopenharmony_ci return true; 187062306a36Sopenharmony_ci} 1871