From patchwork Tue Jul 8 07:06:53 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Zi Shen Lim X-Patchwork-Id: 4502851 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.19.201]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 5B018BEEAA for ; Tue, 8 Jul 2014 07:10:20 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id CE1B420357 for ; Tue, 8 Jul 2014 07:10:17 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher DHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 6A8AD2034F for ; Tue, 8 Jul 2014 07:10:15 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1X4PUx-0006P5-Bi; Tue, 08 Jul 2014 07:07:31 +0000 Received: from mail-pa0-x236.google.com ([2607:f8b0:400e:c03::236]) by bombadil.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1X4PUs-0006N5-Tz for linux-arm-kernel@lists.infradead.org; Tue, 08 Jul 2014 07:07:29 +0000 Received: by mail-pa0-f54.google.com with SMTP id et14so6767684pad.41 for ; Tue, 08 Jul 2014 00:07:05 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=from:to:cc:subject:date:message-id; bh=zvZiwOCWscQcMxnP43o3Pw+nzPdCrlTsd3Re/oGJcJg=; b=LyuzhoEOz+H9VaidVt2hS/DYehjKm0jfhDjm4UpgfMb7ORjLJkjjfZWa4wEoMFocfc 5r8k9DbT3RktUa0+1SEvieb3ehevLtI7LCYfb7aeQW9Z8J3mKAsWpObUSIfjAGHMjMMG 1DTALWgC+onVtU3ESysD/iPhaproM0QuSZb/K44rw388oIwmMN8AFTvMn65fgaYId9iH Iw9lXTBz67EW015/wx02ZcBD32R8sRPf8eGniVUQSnbB3akeMwB1OidNAWvno1W42czm 5eZxfSB8MUTWqsBKsO9beKOm2MNzod6oFeOizhi50CvUNO+G6ugaZJk5XISjAF+YQXvX qaUw== X-Received: by 10.68.197.195 with SMTP id iw3mr1532588pbc.139.1404803225480; Tue, 08 Jul 2014 00:07:05 -0700 (PDT) Received: from gup76.hsd1.ca.comcast.net ([98.234.176.204]) by mx.google.com with ESMTPSA id w16sm23064256pdl.36.2014.07.08.00.07.03 for (version=TLSv1.2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Tue, 08 Jul 2014 00:07:04 -0700 (PDT) From: Zi Shen Lim To: Catalin Marinas , Will Deacon , "David S. Miller" , Daniel Borkmann , Alexei Starovoitov , Chema Gonzalez Subject: [PATCH RFCv2] arm64: eBPF JIT compiler Date: Tue, 8 Jul 2014 00:06:53 -0700 Message-Id: <1404803213-10653-1-git-send-email-zlim.lnx@gmail.com> X-Mailer: git-send-email 1.9.1 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20140708_000727_174155_17F50772 X-CRM114-Status: GOOD ( 19.80 ) X-Spam-Score: -0.8 (/) Cc: Zi Shen Lim , linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, netdev@vger.kernel.org X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.18-1 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Spam-Status: No, score=-2.4 required=5.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RP_MATCHES_RCVD, T_DKIM_INVALID, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP The JIT compiler emits A64 instructions. It supports eBPF only. Legacy BPF is supported thanks to conversion by BPF core. JIT is enabled in the same way as for other architectures: echo 1 > /proc/sys/net/core/bpf_jit_enable Or for additional compiler output: echo 2 > /proc/sys/net/core/bpf_jit_enable See Documentation/networking/filter.txt for more information. The implementation passes all 57 tests in lib/test_bpf.c on ARMv8 Foundation Model :) Signed-off-by: Zi Shen Lim Acked-by: Alexei Starovoitov --- RFCv1->RFCv2: Addressed review comments from Alexei: - use core-$(CONFIG_NET) - use GENMASK - lower-case function names in header file - drop LD_ABS+DW and LD_IND+DW, which do not exist in eBPF yet - use pr_xxx_once() to prevent spamming logs - clarify 16B stack alignment requirement - drop usage of EMIT macro which was saving just one argument, turns out having additional argument wasn't too much of an eyesore Also, per discussion with Alexei, and additional suggestion from Daniel: - moved load_pointer() from net/core/filter.c into filter.h as bpf_load_pointer() which is done as a separate preparatory patch. [1] [1] http://patchwork.ozlabs.org/patch/366906/ NOTES: * This patch applies on top of net-next @ bd4578bc84a8 ("drivers/net/hyperv/netvsc.c: remove unnecessary null test before kfree"). * Patch [1] above must be applied first, followed by this patch. * bpf_jit_comp.c is checkpatch clean. * Checkpatch warns about long lines for bpf_jit.h, but those lines are actually more readable as is. * The following sparse warning is not applicable: warning: symbol 'bpf_jit_enable' was not declared. Should it be static? * Per discussion with Will, I'll also look into consolidating bpf_jit.h into arch/arm64/kernel/insn.{c,h}. FUTURE WORK: 1. Implement remaining classes of eBPF instructions: ST|MEM, STX|XADD which currently do not have corresponding test cases in test_bpf. 2. Further compiler optimization, such as optimization for small immediates. --- Documentation/networking/filter.txt | 2 +- arch/arm64/Kconfig | 1 + arch/arm64/Makefile | 1 + arch/arm64/net/Makefile | 4 + arch/arm64/net/bpf_jit.h | 317 +++++++++++++++++ arch/arm64/net/bpf_jit_comp.c | 681 ++++++++++++++++++++++++++++++++++++ 6 files changed, 1005 insertions(+), 1 deletion(-) create mode 100644 arch/arm64/net/Makefile create mode 100644 arch/arm64/net/bpf_jit.h create mode 100644 arch/arm64/net/bpf_jit_comp.c diff --git a/Documentation/networking/filter.txt b/Documentation/networking/filter.txt index ee78eba..d71e616 100644 --- a/Documentation/networking/filter.txt +++ b/Documentation/networking/filter.txt @@ -462,7 +462,7 @@ JIT compiler ------------ The Linux kernel has a built-in BPF JIT compiler for x86_64, SPARC, PowerPC, -ARM and s390 and can be enabled through CONFIG_BPF_JIT. The JIT compiler is +ARM, ARM64 and s390 and can be enabled through CONFIG_BPF_JIT. The JIT compiler is transparently invoked for each attached filter from user space or for internal kernel users if it has been previously enabled by root: diff --git a/arch/arm64/Kconfig b/arch/arm64/Kconfig index a474de34..b0a4ff8 100644 --- a/arch/arm64/Kconfig +++ b/arch/arm64/Kconfig @@ -32,6 +32,7 @@ config ARM64 select HAVE_ARCH_KGDB select HAVE_ARCH_TRACEHOOK select HAVE_C_RECORDMCOUNT + select HAVE_BPF_JIT select HAVE_DEBUG_BUGVERBOSE select HAVE_DEBUG_KMEMLEAK select HAVE_DMA_API_DEBUG diff --git a/arch/arm64/Makefile b/arch/arm64/Makefile index 8185a91..9820fa7 100644 --- a/arch/arm64/Makefile +++ b/arch/arm64/Makefile @@ -43,6 +43,7 @@ TEXT_OFFSET := 0x00080000 export TEXT_OFFSET GZFLAGS core-y += arch/arm64/kernel/ arch/arm64/mm/ +core-$(CONFIG_NET) += arch/arm64/net/ core-$(CONFIG_KVM) += arch/arm64/kvm/ core-$(CONFIG_XEN) += arch/arm64/xen/ core-$(CONFIG_CRYPTO) += arch/arm64/crypto/ diff --git a/arch/arm64/net/Makefile b/arch/arm64/net/Makefile new file mode 100644 index 0000000..da97633 --- /dev/null +++ b/arch/arm64/net/Makefile @@ -0,0 +1,4 @@ +# +# ARM64 networking code +# +obj-$(CONFIG_BPF_JIT) += bpf_jit_comp.o diff --git a/arch/arm64/net/bpf_jit.h b/arch/arm64/net/bpf_jit.h new file mode 100644 index 0000000..66787c9 --- /dev/null +++ b/arch/arm64/net/bpf_jit.h @@ -0,0 +1,317 @@ +/* + * BPF JIT compiler for ARM64 + * + * Copyright (C) 2014 Zi Shen Lim + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see . + */ +#ifndef _BPF_JIT_H +#define _BPF_JIT_H + +#include + +#define BITSMASK(bits) GENMASK(bits - 1, 0) + +/* 5-bit Register Operand */ +#define A64_R(x) x /* R0-R30: General purpose */ +#define A64_FP A64_R(29) /* Frame pointer */ +#define A64_LR A64_R(30) /* Link register */ +#define A64_ZR 31 /* As source register operand */ +#define A64_SP 31 /* As load/store base register */ + +/* Compare & branch (immediate) */ +static inline u32 a64_comp_branch_imm(int sf, int op, int imm19, int Rt) +{ + sf &= BITSMASK(1); + op &= BITSMASK(1); + imm19 &= BITSMASK(19); + Rt &= BITSMASK(5); + return 0x34000000 | sf << 31 | op << 24 | imm19 << 5 | Rt; +} +#define A64_CBZ(sf, Rt, imm19) a64_comp_branch_imm(sf, 0, imm19, Rt) +#define A64_CBNZ(sf, Rt, imm19) a64_comp_branch_imm(sf, 1, imm19, Rt) + +/* Conditional branch (immediate) */ +static inline u32 a64_cond_branch_imm(int o1, int imm19, int o0, int cond) +{ + o1 &= BITSMASK(1); + imm19 &= BITSMASK(19); + o0 &= BITSMASK(1); + cond &= BITSMASK(4); + return 0x54000000 | o1 << 24 | imm19 << 5 | o0 << 4 | cond; +} +#define A64_COND_EQ 0x0 /* == */ +#define A64_COND_NE 0x1 /* != */ +#define A64_COND_CS 0x2 /* unsigned >= */ +#define A64_COND_HI 0x8 /* unsigned > */ +#define A64_COND_GE 0xa /* signed >= */ +#define A64_COND_GT 0xc /* signed > */ +#define A64_B_(cond, imm19) a64_cond_branch_imm(0, imm19, 0, cond) + +/* Unconditional branch (immediate) */ +static inline u32 a64_branch_imm(int op, int imm26) +{ + op &= BITSMASK(1); + imm26 &= BITSMASK(26); + return 0x14000000 | op << 31 | imm26; +} +#define A64_B(imm26) a64_branch_imm(0, imm26) +#define A64_BL(imm26) a64_branch_imm(1, imm26) + +/* Unconditional branch (register) */ +static inline u32 a64_branch_reg(int opc, int op2, int op3, int Rn, int op4) +{ + opc &= BITSMASK(4); + op2 &= BITSMASK(5); + op3 &= BITSMASK(6); + Rn &= BITSMASK(5); + op4 &= BITSMASK(5); + return 0xd6000000 | opc << 21 | op2 << 16 | op3 << 10 | Rn << 5 | op4; +} +#define A64_BR(Rn) a64_branch_reg(0, 0x1f, 0, Rn, 0) +#define A64_BLR(Rn) a64_branch_reg(1, 0x1f, 0, Rn, 0) +#define A64_RET(Rn) a64_branch_reg(2, 0x1f, 0, Rn, 0) + +/* Load/store register (register offset) */ +static inline u32 a64_ls_reg(int size, int V, int opc, int Rm, int option, int S, int Rn, int Rt) +{ + size &= BITSMASK(2); + V &= BITSMASK(1); + opc &= BITSMASK(2); + Rm &= BITSMASK(5); + option &= BITSMASK(3); + S &= BITSMASK(1); + Rn &= BITSMASK(5); + Rt &= BITSMASK(5); + return 0x38200800 | size << 30 | V << 26 | opc << 22 | Rm << 16 | option << 13 | S << 12 | Rn << 5 | Rt; +} +#define A64_STRB(Wt, Xn, Xm) a64_ls_reg(0, 0, 0, Xm, 3, 0, Xn, Wt) +#define A64_LDRB(Wt, Xn, Xm) a64_ls_reg(0, 0, 1, Xm, 3, 0, Xn, Wt) +#define A64_STRH(Wt, Xn, Xm) a64_ls_reg(1, 0, 0, Xm, 3, 0, Xn, Wt) +#define A64_LDRH(Wt, Xn, Xm) a64_ls_reg(1, 0, 1, Xm, 3, 0, Xn, Wt) +#define A64_STR32(Wt, Xn, Xm) a64_ls_reg(2, 0, 0, Xm, 3, 0, Xn, Wt) +#define A64_LDR32(Wt, Xn, Xm) a64_ls_reg(2, 0, 1, Xm, 3, 0, Xn, Wt) +#define A64_STR64(Xt, Xn, Xm) a64_ls_reg(3, 0, 0, Xm, 3, 0, Xn, Xt) +#define A64_LDR64(Xt, Xn, Xm) a64_ls_reg(3, 0, 1, Xm, 3, 0, Xn, Xt) + +/* Load/store register pair */ +static inline u32 a64_ls_pair(int opc, int V, int mode, int L, int imm7, int Rt2, int Rn, int Rt) +{ + opc &= BITSMASK(2); + V &= BITSMASK(1); + mode &= BITSMASK(3); + L &= BITSMASK(1); + imm7 &= BITSMASK(7); + Rt2 &= BITSMASK(5); + Rn &= BITSMASK(5); + Rt &= BITSMASK(5); + return 0x28000000 | opc << 30 | V << 26 | mode << 23 | L << 22 | imm7 << 15 | Rt2 << 10 | Rn << 5 | Rt; +} +#define lspPostIndexed 1 +#define lspOffset 2 +#define lspPreIndexed 3 +/* Non-SIMD, 64-bit variant. imm = [-512, 504] */ +#define A64_STP64(Rt, Rt2, Rn, imm, mode) a64_ls_pair(2, 0, mode, 0, imm >> 3, Rt2, Rn, Rt) +#define A64_LDP64(Rt, Rt2, Rn, imm, mode) a64_ls_pair(2, 0, mode, 1, imm >> 3, Rt2, Rn, Rt) + +/* Rn -= 16; Rn[0] = Rt; Rn[8] = Rt2; */ +#define A64_PUSH(Rt, Rt2, Rn) A64_STP64(Rt, Rt2, Rn, -16, lspPreIndexed) +/* Rt = Rn[0]; Rt2 = Rn[8]; Rn += 16; */ +#define A64_POP(Rt, Rt2, Rn) A64_LDP64(Rt, Rt2, Rn, 16, lspPostIndexed) + +/* Add/subtract (immediate) */ +static inline u32 a64_addsub_imm(int sf, int op, int S, int shift, int imm12, int Rn, int Rd) +{ + sf &= BITSMASK(1); + op &= BITSMASK(1); + S &= BITSMASK(1); + shift &= BITSMASK(2); + imm12 &= BITSMASK(12); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x11000000 | sf << 31 | op << 30 | S << 29 | shift << 22 | imm12 << 10 | Rn << 5 | Rd; +} +#define A64_ADD_IMM(sf, shift, imm12, Rn, Rd) a64_addsub_imm(sf, 0, 0, shift, imm12, Rn, Rd) +#define A64_ADDS_IMM(sf, shift, imm12, Rn, Rd) a64_addsub_imm(sf, 0, 1, shift, imm12, Rn, Rd) +#define A64_SUB_IMM(sf, shift, imm12, Rn, Rd) a64_addsub_imm(sf, 1, 0, shift, imm12, Rn, Rd) +#define A64_SUBS_IMM(sf, shift, imm12, Rn, Rd) a64_addsub_imm(sf, 1, 1, shift, imm12, Rn, Rd) + +/* Rd = Rn OP imm12 */ +#define A64_ADD_I(sf, Rd, Rn, imm12) A64_ADD_IMM(sf, 0, imm12, Rn, Rd) +#define A64_SUB_I(sf, Rd, Rn, imm12) A64_SUB_IMM(sf, 0, imm12, Rn, Rd) +/* Rd = Rn */ +#define A64_MOV(sf, Rd, Rn) A64_ADD_I(sf, Rd, Rn, 0) + +/* Bitfield move */ +static inline u32 a64_bitfield(int sf, int opc, int N, int immr, int imms, int Rn, int Rd) +{ + sf &= BITSMASK(1); + opc &= BITSMASK(2); + N &= BITSMASK(1); + immr &= BITSMASK(6); + imms &= BITSMASK(6); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x13000000 | sf << 31 | opc << 29 | N << 22 | immr << 16 | imms << 10 | Rn << 5 | Rd; +} +/* Signed, with sign replication to left and zeros to right */ +#define A64_SBFM(sf, Rd, Rn, immr, imms) a64_bitfield(sf, 0, sf, immr, imms, Rn, Rd) +/* Leave other bits unchanged */ +#define A64_BFM(sf, Rd, Rn, immr, imms) a64_bitfield(sf, 1, sf, immr, imms, Rn, Rd) +/* Unsigned, with zeros to left and right */ +#define A64_UBFM(sf, Rd, Rn, immr, imms) a64_bitfield(sf, 2, sf, immr, imms, Rn, Rd) + +/* Rd = Rn << shift */ +#define A64_LSL(sf, Rd, Rn, shift) ({ \ + int sz = (sf) ? 64 : 32; \ + A64_UBFM(sf, Rd, Rn, (unsigned)-(shift) % sz, sz - 1 - (shift)); \ +}) +/* Rd = Rn >> shift */ +#define A64_LSR(sf, Rd, Rn, shift) A64_UBFM(sf, Rd, Rn, shift, (sf) ? 63 : 31) +/* Rd = Rn >> shift; signed */ +#define A64_ASR(sf, Rd, Rn, shift) A64_SBFM(sf, Rd, Rn, shift, (sf) ? 63 : 31) + +/* Move wide (immediate) */ +static inline u32 a64_move_imm(int sf, int opc, int hw, int imm16, int Rd) +{ + sf &= BITSMASK(1); + opc &= BITSMASK(2); + hw &= BITSMASK(2); + imm16 &= BITSMASK(16); + Rd &= BITSMASK(5); + return 0x12800000 | sf << 31 | opc << 29 | hw << 21 | imm16 << 5 | Rd; +} +#define A64_MOVN_IMM(sf, hw, imm16, Rd) a64_move_imm(sf, 0, hw, imm16, Rd) +#define A64_MOVZ_IMM(sf, hw, imm16, Rd) a64_move_imm(sf, 2, hw, imm16, Rd) +#define A64_MOVK_IMM(sf, hw, imm16, Rd) a64_move_imm(sf, 3, hw, imm16, Rd) + +/* Rd = Zeros (for MOVZ); + * Rd |= imm16 << shift (where shift is {0, 16, 32, 48}); + * Rd = ~Rd; (for MOVN); */ +#define A64_MOVN(sf, Rd, imm16, shift) A64_MOVN_IMM(sf, shift >> 4, imm16, Rd) +#define A64_MOVZ(sf, Rd, imm16, shift) A64_MOVZ_IMM(sf, shift >> 4, imm16, Rd) +#define A64_MOVK(sf, Rd, imm16, shift) A64_MOVK_IMM(sf, shift >> 4, imm16, Rd) + +/* Add/subtract (shifted register) */ +static inline u32 a64_addsub_sreg(int sf, int op, int S, int shift, int Rm, int imm6, int Rn, int Rd) +{ + sf &= BITSMASK(1); + op &= BITSMASK(1); + S &= BITSMASK(1); + shift &= BITSMASK(2); + Rm &= BITSMASK(5); + imm6 &= BITSMASK(6); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x0b000000 | sf << 31 | op << 30 | S << 29 | shift << 22 | Rm << 16 | imm6 << 10 | Rn << 5 | Rd; +} +#define A64_ADD_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_addsub_sreg(sf, 0, 0, shift, Rm, imm6, Rn, Rd) +#define A64_ADDS_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_addsub_sreg(sf, 0, 1, shift, Rm, imm6, Rn, Rd) +#define A64_SUB_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_addsub_sreg(sf, 1, 0, shift, Rm, imm6, Rn, Rd) +#define A64_SUBS_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_addsub_sreg(sf, 1, 1, shift, Rm, imm6, Rn, Rd) + +/* Rd = Rn OP Rm */ +#define A64_ADD(sf, Rd, Rn, Rm) A64_ADD_SREG(sf, 0, Rm, 0, Rn, Rd) +#define A64_SUB(sf, Rd, Rn, Rm) A64_SUB_SREG(sf, 0, Rm, 0, Rn, Rd) +#define A64_SUBS(sf, Rd, Rn, Rm) A64_SUBS_SREG(sf, 0, Rm, 0, Rn, Rd) +/* Rd = -Rm */ +#define A64_NEG(sf, Rd, Rm) A64_SUB(sf, Rd, A64_ZR, Rm) +/* Rn - Rm; set condition flags */ +#define A64_CMP(sf, Rn, Rm) A64_SUBS(sf, A64_ZR, Rn, Rm) + +/* Data-processing (1 source) */ +static inline u32 a64_data1(int sf, int S, int opcode2, int opcode, int Rn, int Rd) +{ + sf &= BITSMASK(1); + S &= BITSMASK(1); + opcode2 &= BITSMASK(5); + opcode &= BITSMASK(6); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x5ac00000 | sf << 31 | S << 29 | opcode2 << 16 | opcode << 10 | Rn << 5 | Rd; +} +/* Rd = BSWAPx(Rn) */ +#define A64_REV16(sf, Rd, Rn) a64_data1(sf, 0, 0, 1, Rn, Rd) +#define A64_REV32(sf, Rd, Rn) a64_data1(sf, 0, 0, 2, Rn, Rd) +#define A64_REV64(Rd, Rn) a64_data1(1, 0, 0, 3, Rn, Rd) + +/* Data-processing (2 source) */ +static inline u32 a64_data2(int sf, int S, int Rm, int opcode, int Rn, int Rd) +{ + sf &= BITSMASK(1); + S &= BITSMASK(1); + Rm &= BITSMASK(5); + opcode &= BITSMASK(6); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x1ac00000 | sf << 31 | S << 29 | Rm << 16 | opcode << 10 | Rn << 5 | Rd; +} +/* Rd = Rn OP Rm */ +#define A64_UDIV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0x2, Rn, Rd) +#define A64_SDIV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0x3, Rn, Rd) +#define A64_LSLV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0x8, Rn, Rd) +#define A64_LSRV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0x9, Rn, Rd) +#define A64_ASRV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0xa, Rn, Rd) +#define A64_RORV(sf, Rd, Rn, Rm) a64_data2(sf, 0, Rm, 0xb, Rn, Rd) + +/* Data-processing (3 source) */ +static inline u32 a64_data3(int sf, int op54, int op31, int Rm, int o0, int Ra, int Rn, int Rd) +{ + sf &= BITSMASK(1); + op54 &= BITSMASK(2); + op31 &= BITSMASK(3); + Rm &= BITSMASK(5); + o0 &= BITSMASK(1); + Ra &= BITSMASK(5); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x1b000000 | sf << 31 | op54 << 29 | op31 << 21 | Rm << 16 | o0 << 15 | Ra << 10 | Rn << 5 | Rd; +} +#define A64_MADD(sf, Rm, Ra, Rn, Rd) a64_data3(sf, 0, 0, Rm, 0, Ra, Rn, Rd) +#define A64_MSUB(sf, Rm, Ra, Rn, Rd) a64_data3(sf, 0, 0, Rm, 1, Ra, Rn, Rd) + +/* Rd = Rn * Rm */ +#define A64_MUL(sf, Rd, Rn, Rm) A64_MADD(sf, Rm, A64_ZR, Rn, Rd) + +/* Logical (shifted register) */ +static inline u32 a64_logical_sreg(int sf, int opc, int shift, int N, int Rm, int imm6, int Rn, int Rd) +{ + sf &= BITSMASK(1); + opc &= BITSMASK(2); + shift &= BITSMASK(2); + N &= BITSMASK(1); + Rm &= BITSMASK(5); + imm6 &= BITSMASK(6); + Rn &= BITSMASK(5); + Rd &= BITSMASK(5); + return 0x0a000000 | sf << 31 | opc << 29 | shift << 22 | N << 21 | Rm << 16 | imm6 << 10 | Rn << 5 | Rd; +} +#define A64_AND_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 0, shift, 0, Rm, imm6, Rn, Rd) +#define A64_BIC_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 0, shift, 1, Rm, imm6, Rn, Rd) +#define A64_ORR_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 1, shift, 0, Rm, imm6, Rn, Rd) +#define A64_ORN_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 1, shift, 1, Rm, imm6, Rn, Rd) +#define A64_EOR_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 2, shift, 0, Rm, imm6, Rn, Rd) +#define A64_EON_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 2, shift, 1, Rm, imm6, Rn, Rd) +#define A64_ANDS_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 3, shift, 0, Rm, imm6, Rn, Rd) +#define A64_BICS_SREG(sf, shift, Rm, imm6, Rn, Rd) a64_logical_sreg(sf, 3, shift, 1, Rm, imm6, Rn, Rd) + +/* Rd = Rn OP Rm */ +#define A64_AND(sf, Rd, Rn, Rm) A64_AND_SREG(sf, 0, Rm, 0, Rn, Rd) +#define A64_ORR(sf, Rd, Rn, Rm) A64_ORR_SREG(sf, 0, Rm, 0, Rn, Rd) +#define A64_EOR(sf, Rd, Rn, Rm) A64_EOR_SREG(sf, 0, Rm, 0, Rn, Rd) +/* Rn & Rm; set condition flags */ +#define A64_TST(sf, Rn, Rm) A64_ANDS_SREG(sf, 0, Rm, 0, Rn, A64_ZR) + +#undef BITSMASK + +#endif /* _BPF_JIT_H */ diff --git a/arch/arm64/net/bpf_jit_comp.c b/arch/arm64/net/bpf_jit_comp.c new file mode 100644 index 0000000..f01b312 --- /dev/null +++ b/arch/arm64/net/bpf_jit_comp.c @@ -0,0 +1,681 @@ +/* + * BPF JIT compiler for ARM64 + * + * Copyright (C) 2014 Zi Shen Lim + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see . + */ + +#define pr_fmt(fmt) "bpf_jit: " fmt + +#include +#include +#include +#include +#include +#include +#include + +#include "bpf_jit.h" + +int bpf_jit_enable __read_mostly; + +#define TMP_REG_1 (MAX_BPF_REG + 0) +#define TMP_REG_2 (MAX_BPF_REG + 1) + +/* Map BPF registers to A64 registers */ +static const int bpf2a64[] = { + /* return value from in-kernel function, and exit value from eBPF */ + [BPF_REG_0] = A64_R(7), + /* arguments from eBPF program to in-kernel function */ + [BPF_REG_1] = A64_R(0), + [BPF_REG_2] = A64_R(1), + [BPF_REG_3] = A64_R(2), + [BPF_REG_4] = A64_R(3), + [BPF_REG_5] = A64_R(4), + /* callee saved registers that in-kernel function will preserve */ + [BPF_REG_6] = A64_R(19), + [BPF_REG_7] = A64_R(20), + [BPF_REG_8] = A64_R(21), + [BPF_REG_9] = A64_R(22), + /* read-only frame pointer to access stack */ + [BPF_REG_FP] = A64_FP, + /* temporary register for internal BPF JIT */ + [TMP_REG_1] = A64_R(23), + [TMP_REG_2] = A64_R(24), +}; + +struct jit_ctx { + const struct sk_filter *prog; + int idx; + int tmp_used; + int body_offset; + int *offset; + u32 *image; +}; + +static inline void emit(const u32 insn, struct jit_ctx *ctx) +{ + if (ctx->image != NULL) + ctx->image[ctx->idx] = cpu_to_le32(insn); + + ctx->idx++; +} + +static inline void emit_a64_mov_i64(const int reg, const u64 val, + struct jit_ctx *ctx) +{ + u64 tmp = val; + int shift = 0; + + emit(A64_MOVZ(1, reg, tmp & 0xffff, shift), ctx); + tmp >>= 16; + shift += 16; + while (tmp) { + if (tmp & 0xffff) + emit(A64_MOVK(1, reg, tmp & 0xffff, shift), ctx); + tmp >>= 16; + shift += 16; + } +} + +static inline void emit_a64_mov_i(const int is64, const int reg, + const s32 val, struct jit_ctx *ctx) +{ + u16 hi = val >> 16; + u16 lo = val & 0xffff; + + if (hi & 0x8000) { + if (hi == 0xffff) { + emit(A64_MOVN(is64, reg, ~lo, 0), ctx); + } else { + emit(A64_MOVN(is64, reg, ~hi, 16), ctx); + emit(A64_MOVK(is64, reg, lo, 0), ctx); + } + } else { + emit(A64_MOVZ(is64, reg, lo, 0), ctx); + if (hi) + emit(A64_MOVK(is64, reg, hi, 16), ctx); + } +} + +static inline int bpf2a64_offset(int bpf_to, int bpf_from, + const struct jit_ctx *ctx) +{ + int to = ctx->offset[bpf_to + 1]; + /* -1 to account for the Branch instruction */ + int from = ctx->offset[bpf_from + 1] - 1; + + return to - from; +} + +static inline int epilogue_offset(const struct jit_ctx *ctx) +{ + int to = ctx->offset[ctx->prog->len - 1]; + int from = ctx->idx - ctx->body_offset; + + return to - from; +} + +/* Stack must be multiples of 16B */ +#define STACK_ALIGN(sz) (((sz) + 15) & ~15) + +static void build_prologue(struct jit_ctx *ctx) +{ + const u8 r6 = bpf2a64[BPF_REG_6]; + const u8 r7 = bpf2a64[BPF_REG_7]; + const u8 r8 = bpf2a64[BPF_REG_8]; + const u8 r9 = bpf2a64[BPF_REG_9]; + const u8 fp = bpf2a64[BPF_REG_FP]; + const u8 ra = bpf2a64[BPF_REG_A]; + const u8 rx = bpf2a64[BPF_REG_X]; + const u8 tmp1 = bpf2a64[TMP_REG_1]; + const u8 tmp2 = bpf2a64[TMP_REG_2]; + int stack_size = MAX_BPF_STACK; + + stack_size += 4; /* extra for skb_copy_bits buffer */ + stack_size = STACK_ALIGN(stack_size); + + /* Save callee-saved register */ + emit(A64_PUSH(r6, r7, A64_SP), ctx); + emit(A64_PUSH(r8, r9, A64_SP), ctx); + if (ctx->tmp_used) + emit(A64_PUSH(tmp1, tmp2, A64_SP), ctx); + + /* Set up BPF stack */ + emit(A64_SUB_I(1, A64_SP, A64_SP, stack_size), ctx); + + /* Set up frame pointer */ + emit(A64_MOV(1, fp, A64_SP), ctx); + + /* Clear registers A and X */ + emit_a64_mov_i64(ra, 0, ctx); + emit_a64_mov_i64(rx, 0, ctx); +} + +static void build_epilogue(struct jit_ctx *ctx) +{ + const u8 r0 = bpf2a64[BPF_REG_0]; + const u8 r6 = bpf2a64[BPF_REG_6]; + const u8 r7 = bpf2a64[BPF_REG_7]; + const u8 r8 = bpf2a64[BPF_REG_8]; + const u8 r9 = bpf2a64[BPF_REG_9]; + const u8 fp = bpf2a64[BPF_REG_FP]; + const u8 tmp1 = bpf2a64[TMP_REG_1]; + const u8 tmp2 = bpf2a64[TMP_REG_2]; + int stack_size = MAX_BPF_STACK; + + stack_size += 16; /* extra for skb_copy_bit buffer */ + + /* We're done with BPF stack */ + emit(A64_ADD_I(1, A64_SP, A64_SP, stack_size), ctx); + + /* Restore callee-saved register */ + if (ctx->tmp_used) + emit(A64_POP(tmp1, tmp2, A64_SP), ctx); + emit(A64_POP(r8, r9, A64_SP), ctx); + emit(A64_POP(r6, r7, A64_SP), ctx); + + /* Restore frame pointer */ + emit(A64_MOV(1, fp, A64_SP), ctx); + + /* Set return value */ + emit(A64_MOV(1, A64_R(0), r0), ctx); + + emit(A64_RET(A64_LR), ctx); +} + +static int build_insn(const struct sock_filter_int *insn, struct jit_ctx *ctx) +{ + const u8 code = insn->code; + const u8 dst = bpf2a64[insn->dst_reg]; + const u8 src = bpf2a64[insn->src_reg]; + const u8 tmp = bpf2a64[TMP_REG_1]; + const u8 tmp2 = bpf2a64[TMP_REG_2]; + const s16 off = insn->off; + const s32 imm = insn->imm; + const int i = insn - ctx->prog->insnsi; + const bool is64 = BPF_CLASS(code) == BPF_ALU64; + u8 jmp_cond; + s32 jmp_offset; + + switch (code) { + /* dst = src */ + case BPF_ALU | BPF_MOV | BPF_X: + case BPF_ALU64 | BPF_MOV | BPF_X: + emit(A64_MOV(is64, dst, src), ctx); + break; + /* dst = dst OP src */ + case BPF_ALU | BPF_ADD | BPF_X: + case BPF_ALU64 | BPF_ADD | BPF_X: + emit(A64_ADD(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_SUB | BPF_X: + case BPF_ALU64 | BPF_SUB | BPF_X: + emit(A64_SUB(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_AND | BPF_X: + case BPF_ALU64 | BPF_AND | BPF_X: + emit(A64_AND(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_OR | BPF_X: + case BPF_ALU64 | BPF_OR | BPF_X: + emit(A64_ORR(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_XOR | BPF_X: + case BPF_ALU64 | BPF_XOR | BPF_X: + emit(A64_EOR(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_MUL | BPF_X: + case BPF_ALU64 | BPF_MUL | BPF_X: + emit(A64_MUL(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_DIV | BPF_X: + case BPF_ALU64 | BPF_DIV | BPF_X: + emit(A64_UDIV(is64, dst, dst, src), ctx); + break; + case BPF_ALU | BPF_MOD | BPF_X: + case BPF_ALU64 | BPF_MOD | BPF_X: + ctx->tmp_used = 1; + emit(A64_UDIV(is64, tmp, dst, src), ctx); + emit(A64_MUL(is64, tmp, tmp, src), ctx); + emit(A64_SUB(is64, dst, dst, tmp), ctx); + break; + /* dst = -dst */ + case BPF_ALU | BPF_NEG: + case BPF_ALU64 | BPF_NEG: + emit(A64_NEG(is64, dst, dst), ctx); + break; + /* dst = BSWAP##imm(dst) */ + case BPF_ALU | BPF_END | BPF_FROM_LE: + case BPF_ALU | BPF_END | BPF_FROM_BE: +#ifdef CONFIG_CPU_BIG_ENDIAN + if (BPF_SRC(code) == BPF_FROM_BE) + break; +#else /* !CONFIG_CPU_BIG_ENDIAN */ + if (BPF_SRC(code) == BPF_FROM_LE) + break; +#endif + switch (imm) { + case 16: + emit(A64_REV16(is64, dst, dst), ctx); + break; + case 32: + emit(A64_REV32(is64, dst, dst), ctx); + break; + case 64: + emit(A64_REV64(dst, dst), ctx); + break; + } + break; + /* dst = imm */ + case BPF_ALU | BPF_MOV | BPF_K: + case BPF_ALU64 | BPF_MOV | BPF_K: + emit_a64_mov_i(is64, dst, imm, ctx); + break; + /* dst = dst OP imm */ + case BPF_ALU | BPF_ADD | BPF_K: + case BPF_ALU64 | BPF_ADD | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_ADD(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_SUB | BPF_K: + case BPF_ALU64 | BPF_SUB | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_SUB(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_AND | BPF_K: + case BPF_ALU64 | BPF_AND | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_AND(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_OR | BPF_K: + case BPF_ALU64 | BPF_OR | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_ORR(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_XOR | BPF_K: + case BPF_ALU64 | BPF_XOR | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_EOR(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_MUL | BPF_K: + case BPF_ALU64 | BPF_MUL | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_MUL(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_DIV | BPF_K: + case BPF_ALU64 | BPF_DIV | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp, imm, ctx); + emit(A64_UDIV(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_MOD | BPF_K: + case BPF_ALU64 | BPF_MOD | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(is64, tmp2, imm, ctx); + emit(A64_UDIV(is64, tmp, dst, tmp2), ctx); + emit(A64_MUL(is64, tmp, tmp, tmp2), ctx); + emit(A64_SUB(is64, dst, dst, tmp), ctx); + break; + case BPF_ALU | BPF_LSH | BPF_K: + case BPF_ALU64 | BPF_LSH | BPF_K: + emit(A64_LSL(is64, dst, dst, imm), ctx); + break; + case BPF_ALU | BPF_RSH | BPF_K: + case BPF_ALU64 | BPF_RSH | BPF_K: + emit(A64_LSR(is64, dst, dst, imm), ctx); + break; + case BPF_ALU | BPF_ARSH | BPF_K: + case BPF_ALU64 | BPF_ARSH | BPF_K: + emit(A64_ASR(is64, dst, dst, imm), ctx); + break; + +#define check_imm19(imm) do { \ + if (((imm > 0) && (imm >> 19)) || \ + ((imm < 0) && (~imm >> 19))) { \ + pr_info("[%2d] imm=%d(0x%x) out of range\n", \ + i, imm, imm); \ + return -EINVAL; \ + } \ +} while (0) + + /* JUMP off */ + case BPF_JMP | BPF_JA: + jmp_offset = bpf2a64_offset(i + off, i, ctx); + check_imm19(jmp_offset); + emit(A64_B(jmp_offset), ctx); + break; + /* IF (dst COND src) JUMP off */ + case BPF_JMP | BPF_JEQ | BPF_X: + case BPF_JMP | BPF_JGT | BPF_X: + case BPF_JMP | BPF_JGE | BPF_X: + case BPF_JMP | BPF_JNE | BPF_X: + case BPF_JMP | BPF_JSGT | BPF_X: + case BPF_JMP | BPF_JSGE | BPF_X: + emit(A64_CMP(1, dst, src), ctx); +emit_cond_jmp: + jmp_offset = bpf2a64_offset(i + off, i, ctx); + check_imm19(jmp_offset); + switch (BPF_OP(code)) { + case BPF_JEQ: + jmp_cond = A64_COND_EQ; + break; + case BPF_JGT: + jmp_cond = A64_COND_HI; + break; + case BPF_JGE: + jmp_cond = A64_COND_CS; + break; + case BPF_JNE: + jmp_cond = A64_COND_NE; + break; + case BPF_JSGT: + jmp_cond = A64_COND_GT; + break; + case BPF_JSGE: + jmp_cond = A64_COND_GE; + break; + default: + return -EFAULT; + } + emit(A64_B_(jmp_cond, jmp_offset), ctx); + break; + case BPF_JMP | BPF_JSET | BPF_X: + emit(A64_TST(1, dst, src), ctx); + goto emit_cond_jmp; + /* IF (dst COND imm) JUMP off */ + case BPF_JMP | BPF_JEQ | BPF_K: + case BPF_JMP | BPF_JGT | BPF_K: + case BPF_JMP | BPF_JGE | BPF_K: + case BPF_JMP | BPF_JNE | BPF_K: + case BPF_JMP | BPF_JSGT | BPF_K: + case BPF_JMP | BPF_JSGE | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(1, tmp, imm, ctx); + emit(A64_CMP(1, dst, tmp), ctx); + goto emit_cond_jmp; + case BPF_JMP | BPF_JSET | BPF_K: + ctx->tmp_used = 1; + emit_a64_mov_i(1, tmp, imm, ctx); + emit(A64_TST(1, dst, tmp), ctx); + goto emit_cond_jmp; + /* function call */ + case BPF_JMP | BPF_CALL: + { + const u8 r0 = bpf2a64[BPF_REG_0]; + const u64 func = (u64)__bpf_call_base + imm; + + ctx->tmp_used = 1; + emit_a64_mov_i64(tmp, func, ctx); + emit(A64_PUSH(A64_FP, A64_LR, A64_SP), ctx); + emit(A64_MOV(1, A64_FP, A64_SP), ctx); + emit(A64_BLR(tmp), ctx); + emit(A64_MOV(1, r0, A64_R(0)), ctx); + emit(A64_POP(A64_FP, A64_LR, A64_SP), ctx); + break; + } + /* function return */ + case BPF_JMP | BPF_EXIT: + if (i == ctx->prog->len - 1) + break; + jmp_offset = epilogue_offset(ctx); + check_imm19(jmp_offset); + emit(A64_B(jmp_offset), ctx); + break; + + /* LDX: dst = *(size *)(src + off) */ + case BPF_LDX | BPF_MEM | BPF_W: + case BPF_LDX | BPF_MEM | BPF_H: + case BPF_LDX | BPF_MEM | BPF_B: + case BPF_LDX | BPF_MEM | BPF_DW: + ctx->tmp_used = 1; + emit_a64_mov_i(1, tmp, off, ctx); + switch (BPF_SIZE(code)) { + case BPF_W: + emit(A64_LDR32(dst, src, tmp), ctx); + break; + case BPF_H: + emit(A64_LDRH(dst, src, tmp), ctx); + break; + case BPF_B: + emit(A64_LDRB(dst, src, tmp), ctx); + break; + case BPF_DW: + emit(A64_LDR64(dst, src, tmp), ctx); + break; + } + break; + + /* ST: *(size *)(dst + off) = imm */ + case BPF_ST | BPF_MEM | BPF_W: + case BPF_ST | BPF_MEM | BPF_H: + case BPF_ST | BPF_MEM | BPF_B: + case BPF_ST | BPF_MEM | BPF_DW: + goto notyet; + + /* STX: *(size *)(dst + off) = src */ + case BPF_STX | BPF_MEM | BPF_W: + case BPF_STX | BPF_MEM | BPF_H: + case BPF_STX | BPF_MEM | BPF_B: + case BPF_STX | BPF_MEM | BPF_DW: + ctx->tmp_used = 1; + emit_a64_mov_i(1, tmp, off, ctx); + switch (BPF_SIZE(code)) { + case BPF_W: + emit(A64_STR32(src, dst, tmp), ctx); + break; + case BPF_H: + emit(A64_STRH(src, dst, tmp), ctx); + break; + case BPF_B: + emit(A64_STRB(src, dst, tmp), ctx); + break; + case BPF_DW: + emit(A64_STR64(src, dst, tmp), ctx); + break; + } + break; + /* STX XADD: lock *(u32 *)(dst + off) += src */ + case BPF_STX | BPF_XADD | BPF_W: + /* STX XADD: lock *(u64 *)(dst + off) += src */ + case BPF_STX | BPF_XADD | BPF_DW: + goto notyet; + + /* R0 = ntohx(*(size *)(((struct sk_buff *)R6)->data + imm)) */ + case BPF_LD | BPF_ABS | BPF_W: + case BPF_LD | BPF_ABS | BPF_H: + case BPF_LD | BPF_ABS | BPF_B: + /* R0 = ntohx(*(size *)(((struct sk_buff *)R6)->data + src + imm)) */ + case BPF_LD | BPF_IND | BPF_W: + case BPF_LD | BPF_IND | BPF_H: + case BPF_LD | BPF_IND | BPF_B: + { + const u8 r0 = bpf2a64[BPF_REG_0]; /* r0 = return value */ + const u8 r6 = bpf2a64[BPF_REG_6]; /* r6 = pointer to sk_buff */ + const u8 fp = bpf2a64[BPF_REG_FP]; + const u8 r1 = bpf2a64[BPF_REG_1]; /* r1: struct sk_buff *skb */ + const u8 r2 = bpf2a64[BPF_REG_2]; /* r2: int k */ + const u8 r3 = bpf2a64[BPF_REG_3]; /* r3: unsigned int size */ + const u8 r4 = bpf2a64[BPF_REG_4]; /* r4: void *buffer */ + const u8 r5 = bpf2a64[BPF_REG_5]; /* r5: void *(*func)(...) */ + int size; + + emit(A64_MOV(1, r1, r6), ctx); + emit_a64_mov_i(0, r2, imm, ctx); + if (BPF_MODE(code) == BPF_IND) + emit(A64_ADD(0, r2, r2, src), ctx); + switch (BPF_SIZE(code)) { + case BPF_W: + size = 4; + break; + case BPF_H: + size = 2; + break; + case BPF_B: + size = 1; + break; + default: + return -EINVAL; + } + emit_a64_mov_i64(r3, size, ctx); + emit(A64_ADD_I(1, r4, fp, MAX_BPF_STACK), ctx); + emit_a64_mov_i64(r5, (unsigned long)bpf_load_pointer, ctx); + emit(A64_PUSH(A64_FP, A64_LR, A64_SP), ctx); + emit(A64_MOV(1, A64_FP, A64_SP), ctx); + emit(A64_BLR(r5), ctx); + emit(A64_MOV(1, r0, A64_R(0)), ctx); + emit(A64_POP(A64_FP, A64_LR, A64_SP), ctx); + + jmp_offset = epilogue_offset(ctx); + check_imm19(jmp_offset); + emit(A64_CBZ(1, r0, jmp_offset), ctx); + emit(A64_MOV(1, r5, r0), ctx); + switch (BPF_SIZE(code)) { + case BPF_W: + emit(A64_LDR32(r0, r5, A64_ZR), ctx); +#ifndef CONFIG_CPU_BIG_ENDIAN + emit(A64_REV32(0, r0, r0), ctx); +#endif + break; + case BPF_H: + emit(A64_LDRH(r0, r5, A64_ZR), ctx); +#ifndef CONFIG_CPU_BIG_ENDIAN + emit(A64_REV16(0, r0, r0), ctx); +#endif + break; + case BPF_B: + emit(A64_LDRB(r0, r5, A64_ZR), ctx); + break; + case BPF_DW: + emit(A64_LDR64(r0, r5, A64_ZR), ctx); +#ifndef CONFIG_CPU_BIG_ENDIAN + emit(A64_REV64(r0, r0), ctx); +#endif + break; + } + break; + } +notyet: + pr_info_once("*** NOT YET: opcode %02x ***\n", code); + return -EFAULT; + + default: + pr_err_once("unknown opcode %02x\n", code); + return -EINVAL; + } + + return 0; +} + +static int build_body(struct jit_ctx *ctx) +{ + const struct sk_filter *prog = ctx->prog; + int i; + + for (i = 0; i < prog->len; i++) { + const struct sock_filter_int *insn = &prog->insnsi[i]; + int ret; + + if (ctx->image == NULL) + ctx->offset[i] = ctx->idx; + + ret = build_insn(insn, ctx); + if (ret) + return ret; + } + + return 0; +} + +static inline void bpf_flush_icache(void *start, void *end) +{ + flush_icache_range((unsigned long)start, (unsigned long)end); +} + +void bpf_jit_compile(struct sk_filter *prog) +{ + /* Nothing to do here. We support Internal BPF. */ +} + +void bpf_int_jit_compile(struct sk_filter *prog) +{ + struct jit_ctx ctx; + int image_size; + + if (!bpf_jit_enable) + return; + + if (!prog || !prog->len) + return; + + memset(&ctx, 0, sizeof(ctx)); + ctx.prog = prog; + + ctx.offset = kcalloc(prog->len, sizeof(int), GFP_KERNEL); + if (ctx.offset == NULL) + return; + + /* 1. Initial fake pass to compute ctx->idx. */ + + /* Fake pass to fill in ctx->offset. */ + if (build_body(&ctx)) + goto out; + + build_prologue(&ctx); + + build_epilogue(&ctx); + + /* Now we know the actual image size. */ + image_size = sizeof(u32) * ctx.idx; + ctx.image = module_alloc(image_size); + if (unlikely(ctx.image == NULL)) + goto out; + + /* 2. Now, the actual pass. */ + + ctx.idx = 0; + build_prologue(&ctx); + + ctx.body_offset = ctx.idx; + if (build_body(&ctx)) + goto out; + + build_epilogue(&ctx); + + /* And we're done. */ + if (bpf_jit_enable > 1) + bpf_jit_dump(prog->len, image_size, 2, ctx.image); + + bpf_flush_icache(ctx.image, ctx.image + ctx.idx); + prog->bpf_func = (void *)ctx.image; + prog->jited = 1; + +out: + kfree(ctx.offset); +} + +void bpf_jit_free(struct sk_filter *prog) +{ + if (prog->jited) + module_free(NULL, prog->bpf_func); + + kfree(prog); +} +