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