| /* bpf_jit.S : BPF JIT helper functions | 
 |  * | 
 |  * Copyright (C) 2011 Eric Dumazet (eric.dumazet@gmail.com) | 
 |  * | 
 |  * 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/linkage.h> | 
 | #include <asm/dwarf2.h> | 
 |  | 
 | /* | 
 |  * Calling convention : | 
 |  * rdi : skb pointer | 
 |  * esi : offset of byte(s) to fetch in skb (can be scratched) | 
 |  * r8  : copy of skb->data | 
 |  * r9d : hlen = skb->len - skb->data_len | 
 |  */ | 
 | #define SKBDATA	%r8 | 
 |  | 
 | sk_load_word_ind: | 
 | 	.globl	sk_load_word_ind | 
 |  | 
 | 	add	%ebx,%esi	/* offset += X */ | 
 | #	test    %esi,%esi	/* if (offset < 0) goto bpf_error; */ | 
 | 	js	bpf_error | 
 |  | 
 | sk_load_word: | 
 | 	.globl	sk_load_word | 
 |  | 
 | 	mov	%r9d,%eax		# hlen | 
 | 	sub	%esi,%eax		# hlen - offset | 
 | 	cmp	$3,%eax | 
 | 	jle	bpf_slow_path_word | 
 | 	mov     (SKBDATA,%rsi),%eax | 
 | 	bswap   %eax  			/* ntohl() */ | 
 | 	ret | 
 |  | 
 |  | 
 | sk_load_half_ind: | 
 | 	.globl sk_load_half_ind | 
 |  | 
 | 	add	%ebx,%esi	/* offset += X */ | 
 | 	js	bpf_error | 
 |  | 
 | sk_load_half: | 
 | 	.globl	sk_load_half | 
 |  | 
 | 	mov	%r9d,%eax | 
 | 	sub	%esi,%eax		#	hlen - offset | 
 | 	cmp	$1,%eax | 
 | 	jle	bpf_slow_path_half | 
 | 	movzwl	(SKBDATA,%rsi),%eax | 
 | 	rol	$8,%ax			# ntohs() | 
 | 	ret | 
 |  | 
 | sk_load_byte_ind: | 
 | 	.globl sk_load_byte_ind | 
 | 	add	%ebx,%esi	/* offset += X */ | 
 | 	js	bpf_error | 
 |  | 
 | sk_load_byte: | 
 | 	.globl	sk_load_byte | 
 |  | 
 | 	cmp	%esi,%r9d   /* if (offset >= hlen) goto bpf_slow_path_byte */ | 
 | 	jle	bpf_slow_path_byte | 
 | 	movzbl	(SKBDATA,%rsi),%eax | 
 | 	ret | 
 |  | 
 | /** | 
 |  * sk_load_byte_msh - BPF_S_LDX_B_MSH helper | 
 |  * | 
 |  * Implements BPF_S_LDX_B_MSH : ldxb  4*([offset]&0xf) | 
 |  * Must preserve A accumulator (%eax) | 
 |  * Inputs : %esi is the offset value, already known positive | 
 |  */ | 
 | ENTRY(sk_load_byte_msh) | 
 | 	CFI_STARTPROC | 
 | 	cmp	%esi,%r9d      /* if (offset >= hlen) goto bpf_slow_path_byte_msh */ | 
 | 	jle	bpf_slow_path_byte_msh | 
 | 	movzbl	(SKBDATA,%rsi),%ebx | 
 | 	and	$15,%bl | 
 | 	shl	$2,%bl | 
 | 	ret | 
 | 	CFI_ENDPROC | 
 | ENDPROC(sk_load_byte_msh) | 
 |  | 
 | bpf_error: | 
 | # force a return 0 from jit handler | 
 | 	xor		%eax,%eax | 
 | 	mov		-8(%rbp),%rbx | 
 | 	leaveq | 
 | 	ret | 
 |  | 
 | /* rsi contains offset and can be scratched */ | 
 | #define bpf_slow_path_common(LEN)		\ | 
 | 	push	%rdi;    /* save skb */		\ | 
 | 	push	%r9;				\ | 
 | 	push	SKBDATA;			\ | 
 | /* rsi already has offset */			\ | 
 | 	mov	$LEN,%ecx;	/* len */	\ | 
 | 	lea	-12(%rbp),%rdx;			\ | 
 | 	call	skb_copy_bits;			\ | 
 | 	test    %eax,%eax;			\ | 
 | 	pop	SKBDATA;			\ | 
 | 	pop	%r9;				\ | 
 | 	pop	%rdi | 
 |  | 
 |  | 
 | bpf_slow_path_word: | 
 | 	bpf_slow_path_common(4) | 
 | 	js	bpf_error | 
 | 	mov	-12(%rbp),%eax | 
 | 	bswap	%eax | 
 | 	ret | 
 |  | 
 | bpf_slow_path_half: | 
 | 	bpf_slow_path_common(2) | 
 | 	js	bpf_error | 
 | 	mov	-12(%rbp),%ax | 
 | 	rol	$8,%ax | 
 | 	movzwl	%ax,%eax | 
 | 	ret | 
 |  | 
 | bpf_slow_path_byte: | 
 | 	bpf_slow_path_common(1) | 
 | 	js	bpf_error | 
 | 	movzbl	-12(%rbp),%eax | 
 | 	ret | 
 |  | 
 | bpf_slow_path_byte_msh: | 
 | 	xchg	%eax,%ebx /* dont lose A , X is about to be scratched */ | 
 | 	bpf_slow_path_common(1) | 
 | 	js	bpf_error | 
 | 	movzbl	-12(%rbp),%eax | 
 | 	and	$15,%al | 
 | 	shl	$2,%al | 
 | 	xchg	%eax,%ebx | 
 | 	ret |