| 1 | /* strchr/strchrnul optimized with AVX2. | 
|---|
| 2 | Copyright (C) 2017-2021 Free Software Foundation, Inc. | 
|---|
| 3 | This file is part of the GNU C Library. | 
|---|
| 4 |  | 
|---|
| 5 | The GNU C Library is free software; you can redistribute it and/or | 
|---|
| 6 | modify it under the terms of the GNU Lesser General Public | 
|---|
| 7 | License as published by the Free Software Foundation; either | 
|---|
| 8 | version 2.1 of the License, or (at your option) any later version. | 
|---|
| 9 |  | 
|---|
| 10 | The GNU C Library is distributed in the hope that it will be useful, | 
|---|
| 11 | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|---|
| 12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU | 
|---|
| 13 | Lesser General Public License for more details. | 
|---|
| 14 |  | 
|---|
| 15 | You should have received a copy of the GNU Lesser General Public | 
|---|
| 16 | License along with the GNU C Library; if not, see | 
|---|
| 17 | <https://www.gnu.org/licenses/>.  */ | 
|---|
| 18 |  | 
|---|
| 19 | #if IS_IN (libc) | 
|---|
| 20 |  | 
|---|
| 21 | # include <sysdep.h> | 
|---|
| 22 |  | 
|---|
| 23 | # ifndef STRCHR | 
|---|
| 24 | #  define STRCHR	__strchr_avx2 | 
|---|
| 25 | # endif | 
|---|
| 26 |  | 
|---|
| 27 | # ifdef USE_AS_WCSCHR | 
|---|
| 28 | #  define VPBROADCAST	vpbroadcastd | 
|---|
| 29 | #  define VPCMPEQ	vpcmpeqd | 
|---|
| 30 | #  define VPMINU	vpminud | 
|---|
| 31 | #  define CHAR_REG	esi | 
|---|
| 32 | # else | 
|---|
| 33 | #  define VPBROADCAST	vpbroadcastb | 
|---|
| 34 | #  define VPCMPEQ	vpcmpeqb | 
|---|
| 35 | #  define VPMINU	vpminub | 
|---|
| 36 | #  define CHAR_REG	sil | 
|---|
| 37 | # endif | 
|---|
| 38 |  | 
|---|
| 39 | # ifndef VZEROUPPER | 
|---|
| 40 | #  define VZEROUPPER	vzeroupper | 
|---|
| 41 | # endif | 
|---|
| 42 |  | 
|---|
| 43 | # ifndef SECTION | 
|---|
| 44 | #  define SECTION(p)	p##.avx | 
|---|
| 45 | # endif | 
|---|
| 46 |  | 
|---|
| 47 | # define VEC_SIZE 32 | 
|---|
| 48 | # define PAGE_SIZE 4096 | 
|---|
| 49 |  | 
|---|
| 50 | .section SECTION(.text), "ax",@progbits | 
|---|
| 51 | ENTRY (STRCHR) | 
|---|
| 52 | /* Broadcast CHAR to YMM0.	*/ | 
|---|
| 53 | vmovd	%esi, %xmm0 | 
|---|
| 54 | movl	%edi, %eax | 
|---|
| 55 | andl	$(PAGE_SIZE - 1), %eax | 
|---|
| 56 | VPBROADCAST	%xmm0, %ymm0 | 
|---|
| 57 | vpxor	%xmm9, %xmm9, %xmm9 | 
|---|
| 58 |  | 
|---|
| 59 | /* Check if we cross page boundary with one vector load.  */ | 
|---|
| 60 | cmpl	$(PAGE_SIZE - VEC_SIZE), %eax | 
|---|
| 61 | ja	L(cross_page_boundary) | 
|---|
| 62 |  | 
|---|
| 63 | /* Check the first VEC_SIZE bytes.	Search for both CHAR and the | 
|---|
| 64 | null byte.  */ | 
|---|
| 65 | vmovdqu	(%rdi), %ymm8 | 
|---|
| 66 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 67 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 68 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 69 | vpmovmskb %ymm1, %eax | 
|---|
| 70 | testl	%eax, %eax | 
|---|
| 71 | jz	L(aligned_more) | 
|---|
| 72 | tzcntl	%eax, %eax | 
|---|
| 73 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 74 | /* Found CHAR or the null byte.	 */ | 
|---|
| 75 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 76 | jne	L(zero) | 
|---|
| 77 | # endif | 
|---|
| 78 | addq	%rdi, %rax | 
|---|
| 79 | VZEROUPPER_RETURN | 
|---|
| 80 |  | 
|---|
| 81 | /* .p2align 5 helps keep performance more consistent if ENTRY() | 
|---|
| 82 | alignment % 32 was either 16 or 0. As well this makes the | 
|---|
| 83 | alignment % 32 of the loop_4x_vec fixed which makes tuning it | 
|---|
| 84 | easier.  */ | 
|---|
| 85 | .p2align 5 | 
|---|
| 86 | L(first_vec_x4): | 
|---|
| 87 | tzcntl	%eax, %eax | 
|---|
| 88 | addq	$(VEC_SIZE * 3 + 1), %rdi | 
|---|
| 89 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 90 | /* Found CHAR or the null byte.	 */ | 
|---|
| 91 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 92 | jne	L(zero) | 
|---|
| 93 | # endif | 
|---|
| 94 | addq	%rdi, %rax | 
|---|
| 95 | VZEROUPPER_RETURN | 
|---|
| 96 |  | 
|---|
| 97 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 98 | L(zero): | 
|---|
| 99 | xorl	%eax, %eax | 
|---|
| 100 | VZEROUPPER_RETURN | 
|---|
| 101 | # endif | 
|---|
| 102 |  | 
|---|
| 103 |  | 
|---|
| 104 | .p2align 4 | 
|---|
| 105 | L(first_vec_x1): | 
|---|
| 106 | tzcntl	%eax, %eax | 
|---|
| 107 | incq	%rdi | 
|---|
| 108 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 109 | /* Found CHAR or the null byte.	 */ | 
|---|
| 110 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 111 | jne	L(zero) | 
|---|
| 112 | # endif | 
|---|
| 113 | addq	%rdi, %rax | 
|---|
| 114 | VZEROUPPER_RETURN | 
|---|
| 115 |  | 
|---|
| 116 | .p2align 4 | 
|---|
| 117 | L(first_vec_x2): | 
|---|
| 118 | tzcntl	%eax, %eax | 
|---|
| 119 | addq	$(VEC_SIZE + 1), %rdi | 
|---|
| 120 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 121 | /* Found CHAR or the null byte.	 */ | 
|---|
| 122 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 123 | jne	L(zero) | 
|---|
| 124 | # endif | 
|---|
| 125 | addq	%rdi, %rax | 
|---|
| 126 | VZEROUPPER_RETURN | 
|---|
| 127 |  | 
|---|
| 128 | .p2align 4 | 
|---|
| 129 | L(first_vec_x3): | 
|---|
| 130 | tzcntl	%eax, %eax | 
|---|
| 131 | addq	$(VEC_SIZE * 2 + 1), %rdi | 
|---|
| 132 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 133 | /* Found CHAR or the null byte.	 */ | 
|---|
| 134 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 135 | jne	L(zero) | 
|---|
| 136 | # endif | 
|---|
| 137 | addq	%rdi, %rax | 
|---|
| 138 | VZEROUPPER_RETURN | 
|---|
| 139 |  | 
|---|
| 140 | .p2align 4 | 
|---|
| 141 | L(aligned_more): | 
|---|
| 142 | /* Align data to VEC_SIZE - 1. This is the same number of | 
|---|
| 143 | instructions as using andq -VEC_SIZE but saves 4 bytes of code | 
|---|
| 144 | on x4 check.  */ | 
|---|
| 145 | orq	$(VEC_SIZE - 1), %rdi | 
|---|
| 146 | L(cross_page_continue): | 
|---|
| 147 | /* Check the next 4 * VEC_SIZE.  Only one VEC_SIZE at a time | 
|---|
| 148 | since data is only aligned to VEC_SIZE.  */ | 
|---|
| 149 | vmovdqa	1(%rdi), %ymm8 | 
|---|
| 150 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 151 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 152 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 153 | vpmovmskb %ymm1, %eax | 
|---|
| 154 | testl	%eax, %eax | 
|---|
| 155 | jnz	L(first_vec_x1) | 
|---|
| 156 |  | 
|---|
| 157 | vmovdqa	(VEC_SIZE + 1)(%rdi), %ymm8 | 
|---|
| 158 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 159 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 160 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 161 | vpmovmskb %ymm1, %eax | 
|---|
| 162 | testl	%eax, %eax | 
|---|
| 163 | jnz	L(first_vec_x2) | 
|---|
| 164 |  | 
|---|
| 165 | vmovdqa	(VEC_SIZE * 2 + 1)(%rdi), %ymm8 | 
|---|
| 166 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 167 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 168 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 169 | vpmovmskb %ymm1, %eax | 
|---|
| 170 | testl	%eax, %eax | 
|---|
| 171 | jnz	L(first_vec_x3) | 
|---|
| 172 |  | 
|---|
| 173 | vmovdqa	(VEC_SIZE * 3 + 1)(%rdi), %ymm8 | 
|---|
| 174 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 175 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 176 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 177 | vpmovmskb %ymm1, %eax | 
|---|
| 178 | testl	%eax, %eax | 
|---|
| 179 | jnz	L(first_vec_x4) | 
|---|
| 180 | /* Align data to VEC_SIZE * 4 - 1.	*/ | 
|---|
| 181 | addq	$(VEC_SIZE * 4 + 1), %rdi | 
|---|
| 182 | andq	$-(VEC_SIZE * 4), %rdi | 
|---|
| 183 | .p2align 4 | 
|---|
| 184 | L(loop_4x_vec): | 
|---|
| 185 | /* Compare 4 * VEC at a time forward.  */ | 
|---|
| 186 | vmovdqa	(%rdi), %ymm5 | 
|---|
| 187 | vmovdqa	(VEC_SIZE)(%rdi), %ymm6 | 
|---|
| 188 | vmovdqa	(VEC_SIZE * 2)(%rdi), %ymm7 | 
|---|
| 189 | vmovdqa	(VEC_SIZE * 3)(%rdi), %ymm8 | 
|---|
| 190 |  | 
|---|
| 191 | /* Leaves only CHARS matching esi as 0.	 */ | 
|---|
| 192 | vpxor	%ymm5, %ymm0, %ymm1 | 
|---|
| 193 | vpxor	%ymm6, %ymm0, %ymm2 | 
|---|
| 194 | vpxor	%ymm7, %ymm0, %ymm3 | 
|---|
| 195 | vpxor	%ymm8, %ymm0, %ymm4 | 
|---|
| 196 |  | 
|---|
| 197 | VPMINU	%ymm1, %ymm5, %ymm1 | 
|---|
| 198 | VPMINU	%ymm2, %ymm6, %ymm2 | 
|---|
| 199 | VPMINU	%ymm3, %ymm7, %ymm3 | 
|---|
| 200 | VPMINU	%ymm4, %ymm8, %ymm4 | 
|---|
| 201 |  | 
|---|
| 202 | VPMINU	%ymm1, %ymm2, %ymm5 | 
|---|
| 203 | VPMINU	%ymm3, %ymm4, %ymm6 | 
|---|
| 204 |  | 
|---|
| 205 | VPMINU	%ymm5, %ymm6, %ymm6 | 
|---|
| 206 |  | 
|---|
| 207 | VPCMPEQ	%ymm6, %ymm9, %ymm6 | 
|---|
| 208 | vpmovmskb %ymm6, %ecx | 
|---|
| 209 | subq	$-(VEC_SIZE * 4), %rdi | 
|---|
| 210 | testl	%ecx, %ecx | 
|---|
| 211 | jz	L(loop_4x_vec) | 
|---|
| 212 |  | 
|---|
| 213 |  | 
|---|
| 214 | VPCMPEQ	%ymm1, %ymm9, %ymm1 | 
|---|
| 215 | vpmovmskb %ymm1, %eax | 
|---|
| 216 | testl	%eax, %eax | 
|---|
| 217 | jnz	L(last_vec_x0) | 
|---|
| 218 |  | 
|---|
| 219 |  | 
|---|
| 220 | VPCMPEQ	%ymm5, %ymm9, %ymm2 | 
|---|
| 221 | vpmovmskb %ymm2, %eax | 
|---|
| 222 | testl	%eax, %eax | 
|---|
| 223 | jnz	L(last_vec_x1) | 
|---|
| 224 |  | 
|---|
| 225 | VPCMPEQ	%ymm3, %ymm9, %ymm3 | 
|---|
| 226 | vpmovmskb %ymm3, %eax | 
|---|
| 227 | /* rcx has combined result from all 4 VEC. It will only be used | 
|---|
| 228 | if the first 3 other VEC all did not contain a match.  */ | 
|---|
| 229 | salq	$32, %rcx | 
|---|
| 230 | orq	%rcx, %rax | 
|---|
| 231 | tzcntq	%rax, %rax | 
|---|
| 232 | subq	$(VEC_SIZE * 2), %rdi | 
|---|
| 233 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 234 | /* Found CHAR or the null byte.	 */ | 
|---|
| 235 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 236 | jne	L(zero_end) | 
|---|
| 237 | # endif | 
|---|
| 238 | addq	%rdi, %rax | 
|---|
| 239 | VZEROUPPER_RETURN | 
|---|
| 240 |  | 
|---|
| 241 |  | 
|---|
| 242 | .p2align 4 | 
|---|
| 243 | L(last_vec_x0): | 
|---|
| 244 | tzcntl	%eax, %eax | 
|---|
| 245 | addq	$-(VEC_SIZE * 4), %rdi | 
|---|
| 246 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 247 | /* Found CHAR or the null byte.	 */ | 
|---|
| 248 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 249 | jne	L(zero_end) | 
|---|
| 250 | # endif | 
|---|
| 251 | addq	%rdi, %rax | 
|---|
| 252 | VZEROUPPER_RETURN | 
|---|
| 253 |  | 
|---|
| 254 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 255 | L(zero_end): | 
|---|
| 256 | xorl	%eax, %eax | 
|---|
| 257 | VZEROUPPER_RETURN | 
|---|
| 258 | # endif | 
|---|
| 259 |  | 
|---|
| 260 | .p2align 4 | 
|---|
| 261 | L(last_vec_x1): | 
|---|
| 262 | tzcntl	%eax, %eax | 
|---|
| 263 | subq	$(VEC_SIZE * 3), %rdi | 
|---|
| 264 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 265 | /* Found CHAR or the null byte.	 */ | 
|---|
| 266 | cmp	(%rdi, %rax), %CHAR_REG | 
|---|
| 267 | jne	L(zero_end) | 
|---|
| 268 | # endif | 
|---|
| 269 | addq	%rdi, %rax | 
|---|
| 270 | VZEROUPPER_RETURN | 
|---|
| 271 |  | 
|---|
| 272 |  | 
|---|
| 273 | /* Cold case for crossing page with first load.	 */ | 
|---|
| 274 | .p2align 4 | 
|---|
| 275 | L(cross_page_boundary): | 
|---|
| 276 | movq	%rdi, %rdx | 
|---|
| 277 | /* Align rdi to VEC_SIZE - 1.  */ | 
|---|
| 278 | orq	$(VEC_SIZE - 1), %rdi | 
|---|
| 279 | vmovdqa	-(VEC_SIZE - 1)(%rdi), %ymm8 | 
|---|
| 280 | VPCMPEQ	%ymm8, %ymm0, %ymm1 | 
|---|
| 281 | VPCMPEQ	%ymm8, %ymm9, %ymm2 | 
|---|
| 282 | vpor	%ymm1, %ymm2, %ymm1 | 
|---|
| 283 | vpmovmskb %ymm1, %eax | 
|---|
| 284 | /* Remove the leading bytes. sarxl only uses bits [5:0] of COUNT | 
|---|
| 285 | so no need to manually mod edx.  */ | 
|---|
| 286 | sarxl	%edx, %eax, %eax | 
|---|
| 287 | testl	%eax, %eax | 
|---|
| 288 | jz	L(cross_page_continue) | 
|---|
| 289 | tzcntl	%eax, %eax | 
|---|
| 290 | # ifndef USE_AS_STRCHRNUL | 
|---|
| 291 | xorl	%ecx, %ecx | 
|---|
| 292 | /* Found CHAR or the null byte.	 */ | 
|---|
| 293 | cmp	(%rdx, %rax), %CHAR_REG | 
|---|
| 294 | leaq	(%rdx, %rax), %rax | 
|---|
| 295 | cmovne	%rcx, %rax | 
|---|
| 296 | # else | 
|---|
| 297 | addq	%rdx, %rax | 
|---|
| 298 | # endif | 
|---|
| 299 | L(return_vzeroupper): | 
|---|
| 300 | ZERO_UPPER_VEC_REGISTERS_RETURN | 
|---|
| 301 |  | 
|---|
| 302 | END (STRCHR) | 
|---|
| 303 | # endif | 
|---|
| 304 |  | 
|---|