bpf_jit_comp.c 29.5 KB
Newer Older
1 2
/* bpf_jit_comp.c : BPF JIT compiler
 *
3
 * Copyright (C) 2011-2013 Eric Dumazet (eric.dumazet@gmail.com)
4
 * Internal BPF Copyright (c) 2011-2014 PLUMgrid, http://plumgrid.com
5 6 7 8 9 10 11 12
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; version 2
 * of the License.
 */
#include <linux/netdevice.h>
#include <linux/filter.h>
13
#include <linux/if_vlan.h>
14
#include <asm/cacheflush.h>
15
#include <linux/bpf.h>
16 17 18 19 20 21

int bpf_jit_enable __read_mostly;

/*
 * assembly code in arch/x86/net/bpf_jit.S
 */
22
extern u8 sk_load_word[], sk_load_half[], sk_load_byte[];
23
extern u8 sk_load_word_positive_offset[], sk_load_half_positive_offset[];
24
extern u8 sk_load_byte_positive_offset[];
25
extern u8 sk_load_word_negative_offset[], sk_load_half_negative_offset[];
26
extern u8 sk_load_byte_negative_offset[];
27

28
static u8 *emit_code(u8 *ptr, u32 bytes, unsigned int len)
29 30 31 32 33 34 35 36 37 38 39 40
{
	if (len == 1)
		*ptr = bytes;
	else if (len == 2)
		*(u16 *)ptr = bytes;
	else {
		*(u32 *)ptr = bytes;
		barrier();
	}
	return ptr + len;
}

41 42
#define EMIT(bytes, len) \
	do { prog = emit_code(prog, bytes, len); cnt += len; } while (0)
43 44 45 46 47

#define EMIT1(b1)		EMIT(b1, 1)
#define EMIT2(b1, b2)		EMIT((b1) + ((b2) << 8), 2)
#define EMIT3(b1, b2, b3)	EMIT((b1) + ((b2) << 8) + ((b3) << 16), 3)
#define EMIT4(b1, b2, b3, b4)   EMIT((b1) + ((b2) << 8) + ((b3) << 16) + ((b4) << 24), 4)
48 49 50 51 52 53 54 55
#define EMIT1_off32(b1, off) \
	do {EMIT1(b1); EMIT(off, 4); } while (0)
#define EMIT2_off32(b1, b2, off) \
	do {EMIT2(b1, b2); EMIT(off, 4); } while (0)
#define EMIT3_off32(b1, b2, b3, off) \
	do {EMIT3(b1, b2, b3); EMIT(off, 4); } while (0)
#define EMIT4_off32(b1, b2, b3, b4, off) \
	do {EMIT4(b1, b2, b3, b4); EMIT(off, 4); } while (0)
56

57
static bool is_imm8(int value)
58 59 60 61
{
	return value <= 127 && value >= -128;
}

62
static bool is_simm32(s64 value)
63
{
64
	return value == (s64) (s32) value;
65 66
}

67 68 69 70
/* mov dst, src */
#define EMIT_mov(DST, SRC) \
	do {if (DST != SRC) \
		EMIT3(add_2mod(0x48, DST, SRC), 0x89, add_2reg(0xC0, DST, SRC)); \
71 72 73 74 75 76 77 78 79 80 81 82 83 84 85
	} while (0)

static int bpf_size_to_x86_bytes(int bpf_size)
{
	if (bpf_size == BPF_W)
		return 4;
	else if (bpf_size == BPF_H)
		return 2;
	else if (bpf_size == BPF_B)
		return 1;
	else if (bpf_size == BPF_DW)
		return 4; /* imm32 */
	else
		return 0;
}
86 87 88 89 90 91 92 93 94 95

/* list of x86 cond jumps opcodes (. + s8)
 * Add 0x10 (and an extra 0x0f) to generate far jumps (. + s32)
 */
#define X86_JB  0x72
#define X86_JAE 0x73
#define X86_JE  0x74
#define X86_JNE 0x75
#define X86_JBE 0x76
#define X86_JA  0x77
96 97
#define X86_JGE 0x7D
#define X86_JG  0x7F
98

99
static void bpf_flush_icache(void *start, void *end)
100 101 102 103 104 105 106 107 108
{
	mm_segment_t old_fs = get_fs();

	set_fs(KERNEL_DS);
	smp_wmb();
	flush_icache_range((unsigned long)start, (unsigned long)end);
	set_fs(old_fs);
}

109 110
#define CHOOSE_LOAD_FUNC(K, func) \
	((int)K < 0 ? ((int)K >= SKF_LL_OFF ? func##_negative_offset : func) : func##_positive_offset)
111

112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
/* pick a register outside of BPF range for JIT internal work */
#define AUX_REG (MAX_BPF_REG + 1)

/* the following table maps BPF registers to x64 registers.
 * x64 register r12 is unused, since if used as base address register
 * in load/store instructions, it always needs an extra byte of encoding
 */
static const int reg2hex[] = {
	[BPF_REG_0] = 0,  /* rax */
	[BPF_REG_1] = 7,  /* rdi */
	[BPF_REG_2] = 6,  /* rsi */
	[BPF_REG_3] = 2,  /* rdx */
	[BPF_REG_4] = 1,  /* rcx */
	[BPF_REG_5] = 0,  /* r8 */
	[BPF_REG_6] = 3,  /* rbx callee saved */
	[BPF_REG_7] = 5,  /* r13 callee saved */
	[BPF_REG_8] = 6,  /* r14 callee saved */
	[BPF_REG_9] = 7,  /* r15 callee saved */
	[BPF_REG_FP] = 5, /* rbp readonly */
	[AUX_REG] = 3,    /* r11 temp register */
};

/* is_ereg() == true if BPF register 'reg' maps to x64 r8..r15
 * which need extra byte of encoding.
 * rax,rcx,...,rbp have simpler encoding
 */
138
static bool is_ereg(u32 reg)
139
{
140 141 142 143 144
	return (1 << reg) & (BIT(BPF_REG_5) |
			     BIT(AUX_REG) |
			     BIT(BPF_REG_7) |
			     BIT(BPF_REG_8) |
			     BIT(BPF_REG_9));
145 146 147
}

/* add modifiers if 'reg' maps to x64 registers r8..r15 */
148
static u8 add_1mod(u8 byte, u32 reg)
149 150 151 152 153 154
{
	if (is_ereg(reg))
		byte |= 1;
	return byte;
}

155
static u8 add_2mod(u8 byte, u32 r1, u32 r2)
156 157 158 159 160 161 162 163
{
	if (is_ereg(r1))
		byte |= 1;
	if (is_ereg(r2))
		byte |= 4;
	return byte;
}

164
/* encode 'dst_reg' register into x64 opcode 'byte' */
165
static u8 add_1reg(u8 byte, u32 dst_reg)
166
{
167
	return byte + reg2hex[dst_reg];
168 169
}

170
/* encode 'dst_reg' and 'src_reg' registers into x64 opcode 'byte' */
171
static u8 add_2reg(u8 byte, u32 dst_reg, u32 src_reg)
172
{
173
	return byte + reg2hex[dst_reg] + (reg2hex[src_reg] << 3);
174 175
}

176 177 178 179 180 181
static void jit_fill_hole(void *area, unsigned int size)
{
	/* fill whole space with int3 instructions */
	memset(area, 0xcc, size);
}

182
struct jit_context {
183
	int cleanup_addr; /* epilogue code offset */
184
	bool seen_ld_abs;
185 186
};

187 188 189 190
/* maximum number of bytes emitted while JITing one eBPF insn */
#define BPF_MAX_INSN_SIZE	128
#define BPF_INSN_SAFETY		64

191 192 193 194 195 196 197 198 199 200 201
#define STACKSIZE \
	(MAX_BPF_STACK + \
	 32 /* space for rbx, r13, r14, r15 */ + \
	 8 /* space for skb_copy_bits() buffer */)

#define PROLOGUE_SIZE 51

/* emit x64 prologue code for BPF program and check it's size.
 * bpf_tail_call helper will skip it while jumping into another program
 */
static void emit_prologue(u8 **pprog)
202
{
203 204
	u8 *prog = *pprog;
	int cnt = 0;
205

206 207
	EMIT1(0x55); /* push rbp */
	EMIT3(0x48, 0x89, 0xE5); /* mov rbp,rsp */
208

209 210
	/* sub rsp, STACKSIZE */
	EMIT3_off32(0x48, 0x81, 0xEC, STACKSIZE);
211 212 213 214

	/* all classic BPF filters use R6(rbx) save it */

	/* mov qword ptr [rbp-X],rbx */
215
	EMIT3_off32(0x48, 0x89, 0x9D, -STACKSIZE);
216

217
	/* bpf_convert_filter() maps classic BPF register X to R7 and uses R8
218 219 220 221 222 223 224 225
	 * as temporary, so all tcpdump filters need to spill/fill R7(r13) and
	 * R8(r14). R9(r15) spill could be made conditional, but there is only
	 * one 'bpf_error' return path out of helper functions inside bpf_jit.S
	 * The overhead of extra spill is negligible for any filter other
	 * than synthetic ones. Therefore not worth adding complexity.
	 */

	/* mov qword ptr [rbp-X],r13 */
226
	EMIT3_off32(0x4C, 0x89, 0xAD, -STACKSIZE + 8);
227
	/* mov qword ptr [rbp-X],r14 */
228
	EMIT3_off32(0x4C, 0x89, 0xB5, -STACKSIZE + 16);
229
	/* mov qword ptr [rbp-X],r15 */
230
	EMIT3_off32(0x4C, 0x89, 0xBD, -STACKSIZE + 24);
231 232 233 234 235

	/* clear A and X registers */
	EMIT2(0x31, 0xc0); /* xor eax, eax */
	EMIT3(0x4D, 0x31, 0xED); /* xor r13, r13 */

236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331
	/* clear tail_cnt: mov qword ptr [rbp-X], rax */
	EMIT3_off32(0x48, 0x89, 0x85, -STACKSIZE + 32);

	BUILD_BUG_ON(cnt != PROLOGUE_SIZE);
	*pprog = prog;
}

/* generate the following code:
 * ... bpf_tail_call(void *ctx, struct bpf_array *array, u64 index) ...
 *   if (index >= array->map.max_entries)
 *     goto out;
 *   if (++tail_call_cnt > MAX_TAIL_CALL_CNT)
 *     goto out;
 *   prog = array->prog[index];
 *   if (prog == NULL)
 *     goto out;
 *   goto *(prog->bpf_func + prologue_size);
 * out:
 */
static void emit_bpf_tail_call(u8 **pprog)
{
	u8 *prog = *pprog;
	int label1, label2, label3;
	int cnt = 0;

	/* rdi - pointer to ctx
	 * rsi - pointer to bpf_array
	 * rdx - index in bpf_array
	 */

	/* if (index >= array->map.max_entries)
	 *   goto out;
	 */
	EMIT4(0x48, 0x8B, 0x46,                   /* mov rax, qword ptr [rsi + 16] */
	      offsetof(struct bpf_array, map.max_entries));
	EMIT3(0x48, 0x39, 0xD0);                  /* cmp rax, rdx */
#define OFFSET1 44 /* number of bytes to jump */
	EMIT2(X86_JBE, OFFSET1);                  /* jbe out */
	label1 = cnt;

	/* if (tail_call_cnt > MAX_TAIL_CALL_CNT)
	 *   goto out;
	 */
	EMIT2_off32(0x8B, 0x85, -STACKSIZE + 36); /* mov eax, dword ptr [rbp - 516] */
	EMIT3(0x83, 0xF8, MAX_TAIL_CALL_CNT);     /* cmp eax, MAX_TAIL_CALL_CNT */
#define OFFSET2 33
	EMIT2(X86_JA, OFFSET2);                   /* ja out */
	label2 = cnt;
	EMIT3(0x83, 0xC0, 0x01);                  /* add eax, 1 */
	EMIT2_off32(0x89, 0x85, -STACKSIZE + 36); /* mov dword ptr [rbp - 516], eax */

	/* prog = array->prog[index]; */
	EMIT4(0x48, 0x8D, 0x44, 0xD6);            /* lea rax, [rsi + rdx * 8 + 0x50] */
	EMIT1(offsetof(struct bpf_array, prog));
	EMIT3(0x48, 0x8B, 0x00);                  /* mov rax, qword ptr [rax] */

	/* if (prog == NULL)
	 *   goto out;
	 */
	EMIT4(0x48, 0x83, 0xF8, 0x00);            /* cmp rax, 0 */
#define OFFSET3 10
	EMIT2(X86_JE, OFFSET3);                   /* je out */
	label3 = cnt;

	/* goto *(prog->bpf_func + prologue_size); */
	EMIT4(0x48, 0x8B, 0x40,                   /* mov rax, qword ptr [rax + 32] */
	      offsetof(struct bpf_prog, bpf_func));
	EMIT4(0x48, 0x83, 0xC0, PROLOGUE_SIZE);   /* add rax, prologue_size */

	/* now we're ready to jump into next BPF program
	 * rdi == ctx (1st arg)
	 * rax == prog->bpf_func + prologue_size
	 */
	EMIT2(0xFF, 0xE0);                        /* jmp rax */

	/* out: */
	BUILD_BUG_ON(cnt - label1 != OFFSET1);
	BUILD_BUG_ON(cnt - label2 != OFFSET2);
	BUILD_BUG_ON(cnt - label3 != OFFSET3);
	*pprog = prog;
}

static int do_jit(struct bpf_prog *bpf_prog, int *addrs, u8 *image,
		  int oldproglen, struct jit_context *ctx)
{
	struct bpf_insn *insn = bpf_prog->insnsi;
	int insn_cnt = bpf_prog->len;
	bool seen_ld_abs = ctx->seen_ld_abs | (oldproglen == 0);
	bool seen_exit = false;
	u8 temp[BPF_MAX_INSN_SIZE + BPF_INSN_SAFETY];
	int i, cnt = 0;
	int proglen = 0;
	u8 *prog = temp;

	emit_prologue(&prog);

332
	if (seen_ld_abs) {
333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363
		/* r9d : skb->len - skb->data_len (headlen)
		 * r10 : skb->data
		 */
		if (is_imm8(offsetof(struct sk_buff, len)))
			/* mov %r9d, off8(%rdi) */
			EMIT4(0x44, 0x8b, 0x4f,
			      offsetof(struct sk_buff, len));
		else
			/* mov %r9d, off32(%rdi) */
			EMIT3_off32(0x44, 0x8b, 0x8f,
				    offsetof(struct sk_buff, len));

		if (is_imm8(offsetof(struct sk_buff, data_len)))
			/* sub %r9d, off8(%rdi) */
			EMIT4(0x44, 0x2b, 0x4f,
			      offsetof(struct sk_buff, data_len));
		else
			EMIT3_off32(0x44, 0x2b, 0x8f,
				    offsetof(struct sk_buff, data_len));

		if (is_imm8(offsetof(struct sk_buff, data)))
			/* mov %r10, off8(%rdi) */
			EMIT4(0x4c, 0x8b, 0x57,
			      offsetof(struct sk_buff, data));
		else
			/* mov %r10, off32(%rdi) */
			EMIT3_off32(0x4c, 0x8b, 0x97,
				    offsetof(struct sk_buff, data));
	}

	for (i = 0; i < insn_cnt; i++, insn++) {
364 365 366
		const s32 imm32 = insn->imm;
		u32 dst_reg = insn->dst_reg;
		u32 src_reg = insn->src_reg;
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390
		u8 b1 = 0, b2 = 0, b3 = 0;
		s64 jmp_offset;
		u8 jmp_cond;
		int ilen;
		u8 *func;

		switch (insn->code) {
			/* ALU */
		case BPF_ALU | BPF_ADD | BPF_X:
		case BPF_ALU | BPF_SUB | BPF_X:
		case BPF_ALU | BPF_AND | BPF_X:
		case BPF_ALU | BPF_OR | BPF_X:
		case BPF_ALU | BPF_XOR | BPF_X:
		case BPF_ALU64 | BPF_ADD | BPF_X:
		case BPF_ALU64 | BPF_SUB | BPF_X:
		case BPF_ALU64 | BPF_AND | BPF_X:
		case BPF_ALU64 | BPF_OR | BPF_X:
		case BPF_ALU64 | BPF_XOR | BPF_X:
			switch (BPF_OP(insn->code)) {
			case BPF_ADD: b2 = 0x01; break;
			case BPF_SUB: b2 = 0x29; break;
			case BPF_AND: b2 = 0x21; break;
			case BPF_OR: b2 = 0x09; break;
			case BPF_XOR: b2 = 0x31; break;
391
			}
392
			if (BPF_CLASS(insn->code) == BPF_ALU64)
393 394 395 396
				EMIT1(add_2mod(0x48, dst_reg, src_reg));
			else if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT1(add_2mod(0x40, dst_reg, src_reg));
			EMIT2(b2, add_2reg(0xC0, dst_reg, src_reg));
397
			break;
398

399
			/* mov dst, src */
400
		case BPF_ALU64 | BPF_MOV | BPF_X:
401
			EMIT_mov(dst_reg, src_reg);
402 403
			break;

404
			/* mov32 dst, src */
405
		case BPF_ALU | BPF_MOV | BPF_X:
406 407 408
			if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT1(add_2mod(0x40, dst_reg, src_reg));
			EMIT2(0x89, add_2reg(0xC0, dst_reg, src_reg));
409
			break;
410

411
			/* neg dst */
412 413 414
		case BPF_ALU | BPF_NEG:
		case BPF_ALU64 | BPF_NEG:
			if (BPF_CLASS(insn->code) == BPF_ALU64)
415 416 417 418
				EMIT1(add_1mod(0x48, dst_reg));
			else if (is_ereg(dst_reg))
				EMIT1(add_1mod(0x40, dst_reg));
			EMIT2(0xF7, add_1reg(0xD8, dst_reg));
419 420 421 422 423 424 425 426 427 428 429 430 431
			break;

		case BPF_ALU | BPF_ADD | BPF_K:
		case BPF_ALU | BPF_SUB | BPF_K:
		case BPF_ALU | BPF_AND | BPF_K:
		case BPF_ALU | BPF_OR | BPF_K:
		case BPF_ALU | BPF_XOR | BPF_K:
		case BPF_ALU64 | BPF_ADD | BPF_K:
		case BPF_ALU64 | BPF_SUB | BPF_K:
		case BPF_ALU64 | BPF_AND | BPF_K:
		case BPF_ALU64 | BPF_OR | BPF_K:
		case BPF_ALU64 | BPF_XOR | BPF_K:
			if (BPF_CLASS(insn->code) == BPF_ALU64)
432 433 434
				EMIT1(add_1mod(0x48, dst_reg));
			else if (is_ereg(dst_reg))
				EMIT1(add_1mod(0x40, dst_reg));
435 436 437 438 439 440 441 442 443

			switch (BPF_OP(insn->code)) {
			case BPF_ADD: b3 = 0xC0; break;
			case BPF_SUB: b3 = 0xE8; break;
			case BPF_AND: b3 = 0xE0; break;
			case BPF_OR: b3 = 0xC8; break;
			case BPF_XOR: b3 = 0xF0; break;
			}

444 445
			if (is_imm8(imm32))
				EMIT3(0x83, add_1reg(b3, dst_reg), imm32);
446
			else
447
				EMIT2_off32(0x81, add_1reg(b3, dst_reg), imm32);
448 449 450 451 452 453 454
			break;

		case BPF_ALU64 | BPF_MOV | BPF_K:
			/* optimization: if imm32 is positive,
			 * use 'mov eax, imm32' (which zero-extends imm32)
			 * to save 2 bytes
			 */
455
			if (imm32 < 0) {
456
				/* 'mov rax, imm32' sign extends imm32 */
457
				b1 = add_1mod(0x48, dst_reg);
458 459
				b2 = 0xC7;
				b3 = 0xC0;
460
				EMIT3_off32(b1, b2, add_1reg(b3, dst_reg), imm32);
461
				break;
462 463 464 465
			}

		case BPF_ALU | BPF_MOV | BPF_K:
			/* mov %eax, imm32 */
466 467 468
			if (is_ereg(dst_reg))
				EMIT1(add_1mod(0x40, dst_reg));
			EMIT1_off32(add_1reg(0xB8, dst_reg), imm32);
469 470
			break;

471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487
		case BPF_LD | BPF_IMM | BPF_DW:
			if (insn[1].code != 0 || insn[1].src_reg != 0 ||
			    insn[1].dst_reg != 0 || insn[1].off != 0) {
				/* verifier must catch invalid insns */
				pr_err("invalid BPF_LD_IMM64 insn\n");
				return -EINVAL;
			}

			/* movabsq %rax, imm64 */
			EMIT2(add_1mod(0x48, dst_reg), add_1reg(0xB8, dst_reg));
			EMIT(insn[0].imm, 4);
			EMIT(insn[1].imm, 4);

			insn++;
			i++;
			break;

488
			/* dst %= src, dst /= src, dst %= imm32, dst /= imm32 */
489 490 491 492 493 494 495 496 497 498 499 500
		case BPF_ALU | BPF_MOD | BPF_X:
		case BPF_ALU | BPF_DIV | BPF_X:
		case BPF_ALU | BPF_MOD | BPF_K:
		case BPF_ALU | BPF_DIV | BPF_K:
		case BPF_ALU64 | BPF_MOD | BPF_X:
		case BPF_ALU64 | BPF_DIV | BPF_X:
		case BPF_ALU64 | BPF_MOD | BPF_K:
		case BPF_ALU64 | BPF_DIV | BPF_K:
			EMIT1(0x50); /* push rax */
			EMIT1(0x52); /* push rdx */

			if (BPF_SRC(insn->code) == BPF_X)
501 502
				/* mov r11, src_reg */
				EMIT_mov(AUX_REG, src_reg);
503
			else
504 505
				/* mov r11, imm32 */
				EMIT3_off32(0x49, 0xC7, 0xC3, imm32);
506

507 508
			/* mov rax, dst_reg */
			EMIT_mov(BPF_REG_0, dst_reg);
509 510 511 512 513 514 515

			/* xor edx, edx
			 * equivalent to 'xor rdx, rdx', but one byte less
			 */
			EMIT2(0x31, 0xd2);

			if (BPF_SRC(insn->code) == BPF_X) {
516
				/* if (src_reg == 0) return 0 */
517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551

				/* cmp r11, 0 */
				EMIT4(0x49, 0x83, 0xFB, 0x00);

				/* jne .+9 (skip over pop, pop, xor and jmp) */
				EMIT2(X86_JNE, 1 + 1 + 2 + 5);
				EMIT1(0x5A); /* pop rdx */
				EMIT1(0x58); /* pop rax */
				EMIT2(0x31, 0xc0); /* xor eax, eax */

				/* jmp cleanup_addr
				 * addrs[i] - 11, because there are 11 bytes
				 * after this insn: div, mov, pop, pop, mov
				 */
				jmp_offset = ctx->cleanup_addr - (addrs[i] - 11);
				EMIT1_off32(0xE9, jmp_offset);
			}

			if (BPF_CLASS(insn->code) == BPF_ALU64)
				/* div r11 */
				EMIT3(0x49, 0xF7, 0xF3);
			else
				/* div r11d */
				EMIT3(0x41, 0xF7, 0xF3);

			if (BPF_OP(insn->code) == BPF_MOD)
				/* mov r11, rdx */
				EMIT3(0x49, 0x89, 0xD3);
			else
				/* mov r11, rax */
				EMIT3(0x49, 0x89, 0xC3);

			EMIT1(0x5A); /* pop rdx */
			EMIT1(0x58); /* pop rax */

552 553
			/* mov dst_reg, r11 */
			EMIT_mov(dst_reg, AUX_REG);
554 555 556 557 558 559 560 561 562
			break;

		case BPF_ALU | BPF_MUL | BPF_K:
		case BPF_ALU | BPF_MUL | BPF_X:
		case BPF_ALU64 | BPF_MUL | BPF_K:
		case BPF_ALU64 | BPF_MUL | BPF_X:
			EMIT1(0x50); /* push rax */
			EMIT1(0x52); /* push rdx */

563 564
			/* mov r11, dst_reg */
			EMIT_mov(AUX_REG, dst_reg);
565 566

			if (BPF_SRC(insn->code) == BPF_X)
567 568
				/* mov rax, src_reg */
				EMIT_mov(BPF_REG_0, src_reg);
569
			else
570 571
				/* mov rax, imm32 */
				EMIT3_off32(0x48, 0xC7, 0xC0, imm32);
572 573 574 575 576 577 578 579 580 581 582 583 584 585

			if (BPF_CLASS(insn->code) == BPF_ALU64)
				EMIT1(add_1mod(0x48, AUX_REG));
			else if (is_ereg(AUX_REG))
				EMIT1(add_1mod(0x40, AUX_REG));
			/* mul(q) r11 */
			EMIT2(0xF7, add_1reg(0xE0, AUX_REG));

			/* mov r11, rax */
			EMIT_mov(AUX_REG, BPF_REG_0);

			EMIT1(0x5A); /* pop rdx */
			EMIT1(0x58); /* pop rax */

586 587
			/* mov dst_reg, r11 */
			EMIT_mov(dst_reg, AUX_REG);
588 589 590 591 592 593 594 595 596 597
			break;

			/* shifts */
		case BPF_ALU | BPF_LSH | BPF_K:
		case BPF_ALU | BPF_RSH | BPF_K:
		case BPF_ALU | BPF_ARSH | BPF_K:
		case BPF_ALU64 | BPF_LSH | BPF_K:
		case BPF_ALU64 | BPF_RSH | BPF_K:
		case BPF_ALU64 | BPF_ARSH | BPF_K:
			if (BPF_CLASS(insn->code) == BPF_ALU64)
598 599 600
				EMIT1(add_1mod(0x48, dst_reg));
			else if (is_ereg(dst_reg))
				EMIT1(add_1mod(0x40, dst_reg));
601 602 603 604 605 606

			switch (BPF_OP(insn->code)) {
			case BPF_LSH: b3 = 0xE0; break;
			case BPF_RSH: b3 = 0xE8; break;
			case BPF_ARSH: b3 = 0xF8; break;
			}
607
			EMIT3(0xC1, add_1reg(b3, dst_reg), imm32);
608 609
			break;

610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651
		case BPF_ALU | BPF_LSH | BPF_X:
		case BPF_ALU | BPF_RSH | BPF_X:
		case BPF_ALU | BPF_ARSH | BPF_X:
		case BPF_ALU64 | BPF_LSH | BPF_X:
		case BPF_ALU64 | BPF_RSH | BPF_X:
		case BPF_ALU64 | BPF_ARSH | BPF_X:

			/* check for bad case when dst_reg == rcx */
			if (dst_reg == BPF_REG_4) {
				/* mov r11, dst_reg */
				EMIT_mov(AUX_REG, dst_reg);
				dst_reg = AUX_REG;
			}

			if (src_reg != BPF_REG_4) { /* common case */
				EMIT1(0x51); /* push rcx */

				/* mov rcx, src_reg */
				EMIT_mov(BPF_REG_4, src_reg);
			}

			/* shl %rax, %cl | shr %rax, %cl | sar %rax, %cl */
			if (BPF_CLASS(insn->code) == BPF_ALU64)
				EMIT1(add_1mod(0x48, dst_reg));
			else if (is_ereg(dst_reg))
				EMIT1(add_1mod(0x40, dst_reg));

			switch (BPF_OP(insn->code)) {
			case BPF_LSH: b3 = 0xE0; break;
			case BPF_RSH: b3 = 0xE8; break;
			case BPF_ARSH: b3 = 0xF8; break;
			}
			EMIT2(0xD3, add_1reg(b3, dst_reg));

			if (src_reg != BPF_REG_4)
				EMIT1(0x59); /* pop rcx */

			if (insn->dst_reg == BPF_REG_4)
				/* mov dst_reg, r11 */
				EMIT_mov(insn->dst_reg, AUX_REG);
			break;

652
		case BPF_ALU | BPF_END | BPF_FROM_BE:
653
			switch (imm32) {
654 655 656
			case 16:
				/* emit 'ror %ax, 8' to swap lower 2 bytes */
				EMIT1(0x66);
657
				if (is_ereg(dst_reg))
658
					EMIT1(0x41);
659
				EMIT3(0xC1, add_1reg(0xC8, dst_reg), 8);
660 661 662 663 664 665 666

				/* emit 'movzwl eax, ax' */
				if (is_ereg(dst_reg))
					EMIT3(0x45, 0x0F, 0xB7);
				else
					EMIT2(0x0F, 0xB7);
				EMIT1(add_2reg(0xC0, dst_reg, dst_reg));
667 668 669
				break;
			case 32:
				/* emit 'bswap eax' to swap lower 4 bytes */
670
				if (is_ereg(dst_reg))
671
					EMIT2(0x41, 0x0F);
672
				else
673
					EMIT1(0x0F);
674
				EMIT1(add_1reg(0xC8, dst_reg));
675
				break;
676 677
			case 64:
				/* emit 'bswap rax' to swap 8 bytes */
678 679
				EMIT3(add_1mod(0x48, dst_reg), 0x0F,
				      add_1reg(0xC8, dst_reg));
680 681
				break;
			}
682 683 684
			break;

		case BPF_ALU | BPF_END | BPF_FROM_LE:
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705
			switch (imm32) {
			case 16:
				/* emit 'movzwl eax, ax' to zero extend 16-bit
				 * into 64 bit
				 */
				if (is_ereg(dst_reg))
					EMIT3(0x45, 0x0F, 0xB7);
				else
					EMIT2(0x0F, 0xB7);
				EMIT1(add_2reg(0xC0, dst_reg, dst_reg));
				break;
			case 32:
				/* emit 'mov eax, eax' to clear upper 32-bits */
				if (is_ereg(dst_reg))
					EMIT1(0x45);
				EMIT2(0x89, add_2reg(0xC0, dst_reg, dst_reg));
				break;
			case 64:
				/* nop */
				break;
			}
706 707
			break;

708
			/* ST: *(u8*)(dst_reg + off) = imm */
709
		case BPF_ST | BPF_MEM | BPF_B:
710
			if (is_ereg(dst_reg))
711 712 713 714 715
				EMIT2(0x41, 0xC6);
			else
				EMIT1(0xC6);
			goto st;
		case BPF_ST | BPF_MEM | BPF_H:
716
			if (is_ereg(dst_reg))
717 718 719 720 721
				EMIT3(0x66, 0x41, 0xC7);
			else
				EMIT2(0x66, 0xC7);
			goto st;
		case BPF_ST | BPF_MEM | BPF_W:
722
			if (is_ereg(dst_reg))
723 724 725 726 727
				EMIT2(0x41, 0xC7);
			else
				EMIT1(0xC7);
			goto st;
		case BPF_ST | BPF_MEM | BPF_DW:
728
			EMIT2(add_1mod(0x48, dst_reg), 0xC7);
729 730

st:			if (is_imm8(insn->off))
731
				EMIT2(add_1reg(0x40, dst_reg), insn->off);
732
			else
733
				EMIT1_off32(add_1reg(0x80, dst_reg), insn->off);
734

735
			EMIT(imm32, bpf_size_to_x86_bytes(BPF_SIZE(insn->code)));
736 737
			break;

738
			/* STX: *(u8*)(dst_reg + off) = src_reg */
739 740
		case BPF_STX | BPF_MEM | BPF_B:
			/* emit 'mov byte ptr [rax + off], al' */
741
			if (is_ereg(dst_reg) || is_ereg(src_reg) ||
742
			    /* have to add extra byte for x86 SIL, DIL regs */
743 744
			    src_reg == BPF_REG_1 || src_reg == BPF_REG_2)
				EMIT2(add_2mod(0x40, dst_reg, src_reg), 0x88);
745 746 747 748
			else
				EMIT1(0x88);
			goto stx;
		case BPF_STX | BPF_MEM | BPF_H:
749 750
			if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT3(0x66, add_2mod(0x40, dst_reg, src_reg), 0x89);
751 752 753 754
			else
				EMIT2(0x66, 0x89);
			goto stx;
		case BPF_STX | BPF_MEM | BPF_W:
755 756
			if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT2(add_2mod(0x40, dst_reg, src_reg), 0x89);
757 758 759 760
			else
				EMIT1(0x89);
			goto stx;
		case BPF_STX | BPF_MEM | BPF_DW:
761
			EMIT2(add_2mod(0x48, dst_reg, src_reg), 0x89);
762
stx:			if (is_imm8(insn->off))
763
				EMIT2(add_2reg(0x40, dst_reg, src_reg), insn->off);
764
			else
765
				EMIT1_off32(add_2reg(0x80, dst_reg, src_reg),
766 767 768
					    insn->off);
			break;

769
			/* LDX: dst_reg = *(u8*)(src_reg + off) */
770 771
		case BPF_LDX | BPF_MEM | BPF_B:
			/* emit 'movzx rax, byte ptr [rax + off]' */
772
			EMIT3(add_2mod(0x48, src_reg, dst_reg), 0x0F, 0xB6);
773 774 775
			goto ldx;
		case BPF_LDX | BPF_MEM | BPF_H:
			/* emit 'movzx rax, word ptr [rax + off]' */
776
			EMIT3(add_2mod(0x48, src_reg, dst_reg), 0x0F, 0xB7);
777 778 779
			goto ldx;
		case BPF_LDX | BPF_MEM | BPF_W:
			/* emit 'mov eax, dword ptr [rax+0x14]' */
780 781
			if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT2(add_2mod(0x40, src_reg, dst_reg), 0x8B);
782 783 784 785 786
			else
				EMIT1(0x8B);
			goto ldx;
		case BPF_LDX | BPF_MEM | BPF_DW:
			/* emit 'mov rax, qword ptr [rax+0x14]' */
787
			EMIT2(add_2mod(0x48, src_reg, dst_reg), 0x8B);
788 789 790 791 792
ldx:			/* if insn->off == 0 we can save one extra byte, but
			 * special case of x86 r13 which always needs an offset
			 * is not worth the hassle
			 */
			if (is_imm8(insn->off))
793
				EMIT2(add_2reg(0x40, src_reg, dst_reg), insn->off);
794
			else
795
				EMIT1_off32(add_2reg(0x80, src_reg, dst_reg),
796 797 798
					    insn->off);
			break;

799
			/* STX XADD: lock *(u32*)(dst_reg + off) += src_reg */
800 801
		case BPF_STX | BPF_XADD | BPF_W:
			/* emit 'lock add dword ptr [rax + off], eax' */
802 803
			if (is_ereg(dst_reg) || is_ereg(src_reg))
				EMIT3(0xF0, add_2mod(0x40, dst_reg, src_reg), 0x01);
804 805 806 807
			else
				EMIT2(0xF0, 0x01);
			goto xadd;
		case BPF_STX | BPF_XADD | BPF_DW:
808
			EMIT3(0xF0, add_2mod(0x48, dst_reg, src_reg), 0x01);
809
xadd:			if (is_imm8(insn->off))
810
				EMIT2(add_2reg(0x40, dst_reg, src_reg), insn->off);
811
			else
812
				EMIT1_off32(add_2reg(0x80, dst_reg, src_reg),
813 814 815 816 817
					    insn->off);
			break;

			/* call */
		case BPF_JMP | BPF_CALL:
818
			func = (u8 *) __bpf_call_base + imm32;
819
			jmp_offset = func - (image + addrs[i]);
820
			if (seen_ld_abs) {
821 822 823 824 825 826 827
				EMIT2(0x41, 0x52); /* push %r10 */
				EMIT2(0x41, 0x51); /* push %r9 */
				/* need to adjust jmp offset, since
				 * pop %r9, pop %r10 take 4 bytes after call insn
				 */
				jmp_offset += 4;
			}
828
			if (!imm32 || !is_simm32(jmp_offset)) {
829
				pr_err("unsupported bpf func %d addr %p image %p\n",
830
				       imm32, func, image);
831 832 833
				return -EINVAL;
			}
			EMIT1_off32(0xE8, jmp_offset);
834
			if (seen_ld_abs) {
835 836 837 838 839
				EMIT2(0x41, 0x59); /* pop %r9 */
				EMIT2(0x41, 0x5A); /* pop %r10 */
			}
			break;

840 841 842 843
		case BPF_JMP | BPF_CALL | BPF_X:
			emit_bpf_tail_call(&prog);
			break;

844 845 846 847 848 849 850
			/* cond jump */
		case BPF_JMP | BPF_JEQ | BPF_X:
		case BPF_JMP | BPF_JNE | BPF_X:
		case BPF_JMP | BPF_JGT | BPF_X:
		case BPF_JMP | BPF_JGE | BPF_X:
		case BPF_JMP | BPF_JSGT | BPF_X:
		case BPF_JMP | BPF_JSGE | BPF_X:
851 852 853
			/* cmp dst_reg, src_reg */
			EMIT3(add_2mod(0x48, dst_reg, src_reg), 0x39,
			      add_2reg(0xC0, dst_reg, src_reg));
854 855 856
			goto emit_cond_jmp;

		case BPF_JMP | BPF_JSET | BPF_X:
857 858 859
			/* test dst_reg, src_reg */
			EMIT3(add_2mod(0x48, dst_reg, src_reg), 0x85,
			      add_2reg(0xC0, dst_reg, src_reg));
860 861 862
			goto emit_cond_jmp;

		case BPF_JMP | BPF_JSET | BPF_K:
863 864 865
			/* test dst_reg, imm32 */
			EMIT1(add_1mod(0x48, dst_reg));
			EMIT2_off32(0xF7, add_1reg(0xC0, dst_reg), imm32);
866 867 868 869 870 871 872 873
			goto emit_cond_jmp;

		case BPF_JMP | BPF_JEQ | BPF_K:
		case BPF_JMP | BPF_JNE | BPF_K:
		case BPF_JMP | BPF_JGT | BPF_K:
		case BPF_JMP | BPF_JGE | BPF_K:
		case BPF_JMP | BPF_JSGT | BPF_K:
		case BPF_JMP | BPF_JSGE | BPF_K:
874 875
			/* cmp dst_reg, imm8/32 */
			EMIT1(add_1mod(0x48, dst_reg));
876

877 878
			if (is_imm8(imm32))
				EMIT3(0x83, add_1reg(0xF8, dst_reg), imm32);
879
			else
880
				EMIT2_off32(0x81, add_1reg(0xF8, dst_reg), imm32);
881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920

emit_cond_jmp:		/* convert BPF opcode to x86 */
			switch (BPF_OP(insn->code)) {
			case BPF_JEQ:
				jmp_cond = X86_JE;
				break;
			case BPF_JSET:
			case BPF_JNE:
				jmp_cond = X86_JNE;
				break;
			case BPF_JGT:
				/* GT is unsigned '>', JA in x86 */
				jmp_cond = X86_JA;
				break;
			case BPF_JGE:
				/* GE is unsigned '>=', JAE in x86 */
				jmp_cond = X86_JAE;
				break;
			case BPF_JSGT:
				/* signed '>', GT in x86 */
				jmp_cond = X86_JG;
				break;
			case BPF_JSGE:
				/* signed '>=', GE in x86 */
				jmp_cond = X86_JGE;
				break;
			default: /* to silence gcc warning */
				return -EFAULT;
			}
			jmp_offset = addrs[i + insn->off] - addrs[i];
			if (is_imm8(jmp_offset)) {
				EMIT2(jmp_cond, jmp_offset);
			} else if (is_simm32(jmp_offset)) {
				EMIT2_off32(0x0F, jmp_cond + 0x10, jmp_offset);
			} else {
				pr_err("cond_jmp gen bug %llx\n", jmp_offset);
				return -EFAULT;
			}

			break;
921

922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941
		case BPF_JMP | BPF_JA:
			jmp_offset = addrs[i + insn->off] - addrs[i];
			if (!jmp_offset)
				/* optimize out nop jumps */
				break;
emit_jmp:
			if (is_imm8(jmp_offset)) {
				EMIT2(0xEB, jmp_offset);
			} else if (is_simm32(jmp_offset)) {
				EMIT1_off32(0xE9, jmp_offset);
			} else {
				pr_err("jmp gen bug %llx\n", jmp_offset);
				return -EFAULT;
			}
			break;

		case BPF_LD | BPF_IND | BPF_W:
			func = sk_load_word;
			goto common_load;
		case BPF_LD | BPF_ABS | BPF_W:
942
			func = CHOOSE_LOAD_FUNC(imm32, sk_load_word);
943 944
common_load:
			ctx->seen_ld_abs = seen_ld_abs = true;
945 946 947
			jmp_offset = func - (image + addrs[i]);
			if (!func || !is_simm32(jmp_offset)) {
				pr_err("unsupported bpf func %d addr %p image %p\n",
948
				       imm32, func, image);
949 950 951 952
				return -EINVAL;
			}
			if (BPF_MODE(insn->code) == BPF_ABS) {
				/* mov %esi, imm32 */
953
				EMIT1_off32(0xBE, imm32);
954
			} else {
955 956 957 958
				/* mov %rsi, src_reg */
				EMIT_mov(BPF_REG_2, src_reg);
				if (imm32) {
					if (is_imm8(imm32))
959
						/* add %esi, imm8 */
960
						EMIT3(0x83, 0xC6, imm32);
961
					else
962
						/* add %esi, imm32 */
963
						EMIT2_off32(0x81, 0xC6, imm32);
964
				}
965 966 967 968 969 970 971 972 973 974 975 976 977
			}
			/* skb pointer is in R6 (%rbx), it will be copied into
			 * %rdi if skb_copy_bits() call is necessary.
			 * sk_load_* helpers also use %r10 and %r9d.
			 * See bpf_jit.S
			 */
			EMIT1_off32(0xE8, jmp_offset); /* call */
			break;

		case BPF_LD | BPF_IND | BPF_H:
			func = sk_load_half;
			goto common_load;
		case BPF_LD | BPF_ABS | BPF_H:
978
			func = CHOOSE_LOAD_FUNC(imm32, sk_load_half);
979 980 981 982 983
			goto common_load;
		case BPF_LD | BPF_IND | BPF_B:
			func = sk_load_byte;
			goto common_load;
		case BPF_LD | BPF_ABS | BPF_B:
984
			func = CHOOSE_LOAD_FUNC(imm32, sk_load_byte);
985 986 987
			goto common_load;

		case BPF_JMP | BPF_EXIT:
988
			if (seen_exit) {
989 990 991
				jmp_offset = ctx->cleanup_addr - addrs[i];
				goto emit_jmp;
			}
992
			seen_exit = true;
993 994 995
			/* update cleanup_addr */
			ctx->cleanup_addr = proglen;
			/* mov rbx, qword ptr [rbp-X] */
996
			EMIT3_off32(0x48, 0x8B, 0x9D, -STACKSIZE);
997
			/* mov r13, qword ptr [rbp-X] */
998
			EMIT3_off32(0x4C, 0x8B, 0xAD, -STACKSIZE + 8);
999
			/* mov r14, qword ptr [rbp-X] */
1000
			EMIT3_off32(0x4C, 0x8B, 0xB5, -STACKSIZE + 16);
1001
			/* mov r15, qword ptr [rbp-X] */
1002
			EMIT3_off32(0x4C, 0x8B, 0xBD, -STACKSIZE + 24);
1003 1004 1005 1006 1007

			EMIT1(0xC9); /* leave */
			EMIT1(0xC3); /* ret */
			break;

1008
		default:
1009 1010 1011
			/* By design x64 JIT should support all BPF instructions
			 * This error will be seen if new instruction was added
			 * to interpreter, but not to JIT
1012
			 * or if there is junk in bpf_prog
1013 1014
			 */
			pr_err("bpf_jit: unknown opcode %02x\n", insn->code);
1015 1016
			return -EINVAL;
		}
1017

1018
		ilen = prog - temp;
1019 1020 1021 1022 1023
		if (ilen > BPF_MAX_INSN_SIZE) {
			pr_err("bpf_jit_compile fatal insn size error\n");
			return -EFAULT;
		}

1024 1025
		if (image) {
			if (unlikely(proglen + ilen > oldproglen)) {
1026
				pr_err("bpf_jit_compile fatal error\n");
1027
				return -EFAULT;
1028
			}
1029
			memcpy(image + proglen, temp, ilen);
1030
		}
1031 1032 1033 1034 1035 1036 1037
		proglen += ilen;
		addrs[i] = proglen;
		prog = temp;
	}
	return proglen;
}

1038
void bpf_jit_compile(struct bpf_prog *prog)
1039 1040 1041
{
}

1042
void bpf_int_jit_compile(struct bpf_prog *prog)
1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053
{
	struct bpf_binary_header *header = NULL;
	int proglen, oldproglen = 0;
	struct jit_context ctx = {};
	u8 *image = NULL;
	int *addrs;
	int pass;
	int i;

	if (!bpf_jit_enable)
		return;
1054

1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070
	if (!prog || !prog->len)
		return;

	addrs = kmalloc(prog->len * sizeof(*addrs), GFP_KERNEL);
	if (!addrs)
		return;

	/* Before first pass, make a rough estimation of addrs[]
	 * each bpf instruction is translated to less than 64 bytes
	 */
	for (proglen = 0, i = 0; i < prog->len; i++) {
		proglen += 64;
		addrs[i] = proglen;
	}
	ctx.cleanup_addr = proglen;

1071 1072 1073 1074 1075 1076
	/* JITed image shrinks with every pass and the loop iterates
	 * until the image stops shrinking. Very large bpf programs
	 * may converge on the last pass. In such case do one more
	 * pass to emit the final image
	 */
	for (pass = 0; pass < 10 || image; pass++) {
1077 1078 1079 1080
		proglen = do_jit(prog, addrs, image, oldproglen, &ctx);
		if (proglen <= 0) {
			image = NULL;
			if (header)
1081
				bpf_jit_binary_free(header);
1082 1083
			goto out;
		}
1084
		if (image) {
1085
			if (proglen != oldproglen) {
1086 1087
				pr_err("bpf_jit: proglen=%d != oldproglen=%d\n",
				       proglen, oldproglen);
1088 1089
				goto out;
			}
1090 1091 1092
			break;
		}
		if (proglen == oldproglen) {
1093 1094
			header = bpf_jit_binary_alloc(proglen, &image,
						      1, jit_fill_hole);
1095
			if (!header)
1096 1097 1098 1099
				goto out;
		}
		oldproglen = proglen;
	}
1100

1101
	if (bpf_jit_enable > 1)
1102
		bpf_jit_dump(prog->len, proglen, 0, image);
1103 1104

	if (image) {
1105 1106
		bpf_flush_icache(header, image + proglen);
		set_memory_ro((unsigned long)header, header->pages);
1107
		prog->bpf_func = (void *)image;
1108
		prog->jited = true;
1109 1110 1111 1112 1113
	}
out:
	kfree(addrs);
}

1114
void bpf_jit_free(struct bpf_prog *fp)
1115 1116 1117 1118
{
	unsigned long addr = (unsigned long)fp->bpf_func & PAGE_MASK;
	struct bpf_binary_header *header = (void *)addr;

1119 1120 1121
	if (!fp->jited)
		goto free_filter;

1122
	set_memory_rw(addr, header->pages);
1123
	bpf_jit_binary_free(header);
1124

1125 1126
free_filter:
	bpf_prog_unlock_free(fp);
1127
}