18c2ecf20Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * arch/alpha/lib/ev6-memchr.S
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * 21264 version contributed by Rick Gorton <rick.gorton@alpha-processor.com>
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * Finds characters in a memory area.  Optimized for the Alpha:
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci *    - memory accessed as aligned quadwords only
108c2ecf20Sopenharmony_ci *    - uses cmpbge to compare 8 bytes in parallel
118c2ecf20Sopenharmony_ci *    - does binary search to find 0 byte in last
128c2ecf20Sopenharmony_ci *      quadword (HAKMEM needed 12 instructions to
138c2ecf20Sopenharmony_ci *      do this instead of the 9 instructions that
148c2ecf20Sopenharmony_ci *      binary search needs).
158c2ecf20Sopenharmony_ci *
168c2ecf20Sopenharmony_ci * For correctness consider that:
178c2ecf20Sopenharmony_ci *
188c2ecf20Sopenharmony_ci *    - only minimum number of quadwords may be accessed
198c2ecf20Sopenharmony_ci *    - the third argument is an unsigned long
208c2ecf20Sopenharmony_ci *
218c2ecf20Sopenharmony_ci * Much of the information about 21264 scheduling/coding comes from:
228c2ecf20Sopenharmony_ci *	Compiler Writer's Guide for the Alpha 21264
238c2ecf20Sopenharmony_ci *	abbreviated as 'CWG' in other comments here
248c2ecf20Sopenharmony_ci *	ftp.digital.com/pub/Digital/info/semiconductor/literature/dsc-library.html
258c2ecf20Sopenharmony_ci * Scheduling notation:
268c2ecf20Sopenharmony_ci *	E	- either cluster
278c2ecf20Sopenharmony_ci *	U	- upper subcluster; U0 - subcluster U0; U1 - subcluster U1
288c2ecf20Sopenharmony_ci *	L	- lower subcluster; L0 - subcluster L0; L1 - subcluster L1
298c2ecf20Sopenharmony_ci * Try not to change the actual algorithm if possible for consistency.
308c2ecf20Sopenharmony_ci */
318c2ecf20Sopenharmony_ci#include <asm/export.h>
328c2ecf20Sopenharmony_ci        .set noreorder
338c2ecf20Sopenharmony_ci        .set noat
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci	.align	4
368c2ecf20Sopenharmony_ci	.globl memchr
378c2ecf20Sopenharmony_ci	.ent memchr
388c2ecf20Sopenharmony_cimemchr:
398c2ecf20Sopenharmony_ci	.frame $30,0,$26,0
408c2ecf20Sopenharmony_ci	.prologue 0
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	# Hack -- if someone passes in (size_t)-1, hoping to just
438c2ecf20Sopenharmony_ci	# search til the end of the address space, we will overflow
448c2ecf20Sopenharmony_ci	# below when we find the address of the last byte.  Given
458c2ecf20Sopenharmony_ci	# that we will never have a 56-bit address space, cropping
468c2ecf20Sopenharmony_ci	# the length is the easiest way to avoid trouble.
478c2ecf20Sopenharmony_ci	zap	$18, 0x80, $5	# U : Bound length
488c2ecf20Sopenharmony_ci	beq	$18, $not_found	# U :
498c2ecf20Sopenharmony_ci        ldq_u   $1, 0($16)	# L : load first quadword Latency=3
508c2ecf20Sopenharmony_ci	and	$17, 0xff, $17	# E : L L U U : 00000000000000ch
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci	insbl	$17, 1, $2	# U : 000000000000ch00
538c2ecf20Sopenharmony_ci	cmpult	$18, 9, $4	# E : small (< 1 quad) string?
548c2ecf20Sopenharmony_ci	or	$2, $17, $17	# E : 000000000000chch
558c2ecf20Sopenharmony_ci        lda     $3, -1($31)	# E : U L L U
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	sll	$17, 16, $2	# U : 00000000chch0000
588c2ecf20Sopenharmony_ci	addq	$16, $5, $5	# E : Max search address
598c2ecf20Sopenharmony_ci	or	$2, $17, $17	# E : 00000000chchchch
608c2ecf20Sopenharmony_ci	sll	$17, 32, $2	# U : U L L U : chchchch00000000
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	or	$2, $17, $17	# E : chchchchchchchch
638c2ecf20Sopenharmony_ci	extql	$1, $16, $7	# U : $7 is upper bits
648c2ecf20Sopenharmony_ci	beq	$4, $first_quad	# U :
658c2ecf20Sopenharmony_ci	ldq_u	$6, -1($5)	# L : L U U L : eight or less bytes to search Latency=3
668c2ecf20Sopenharmony_ci
678c2ecf20Sopenharmony_ci	extqh	$6, $16, $6	# U : 2 cycle stall for $6
688c2ecf20Sopenharmony_ci	mov	$16, $0		# E :
698c2ecf20Sopenharmony_ci	nop			# E :
708c2ecf20Sopenharmony_ci	or	$7, $6, $1	# E : L U L U $1 = quadword starting at $16
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	# Deal with the case where at most 8 bytes remain to be searched
738c2ecf20Sopenharmony_ci	# in $1.  E.g.:
748c2ecf20Sopenharmony_ci	#	$18 = 6
758c2ecf20Sopenharmony_ci	#	$1 = ????c6c5c4c3c2c1
768c2ecf20Sopenharmony_ci$last_quad:
778c2ecf20Sopenharmony_ci	negq	$18, $6		# E :
788c2ecf20Sopenharmony_ci        xor	$17, $1, $1	# E :
798c2ecf20Sopenharmony_ci	srl	$3, $6, $6	# U : $6 = mask of $18 bits set
808c2ecf20Sopenharmony_ci        cmpbge  $31, $1, $2	# E : L U L U
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci	nop
838c2ecf20Sopenharmony_ci	nop
848c2ecf20Sopenharmony_ci	and	$2, $6, $2	# E :
858c2ecf20Sopenharmony_ci        beq     $2, $not_found	# U : U L U L
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_ci$found_it:
888c2ecf20Sopenharmony_ci#ifdef CONFIG_ALPHA_EV67
898c2ecf20Sopenharmony_ci	/*
908c2ecf20Sopenharmony_ci	 * Since we are guaranteed to have set one of the bits, we don't
918c2ecf20Sopenharmony_ci	 * have to worry about coming back with a 0x40 out of cttz...
928c2ecf20Sopenharmony_ci	 */
938c2ecf20Sopenharmony_ci	cttz	$2, $3		# U0 :
948c2ecf20Sopenharmony_ci	addq	$0, $3, $0	# E : All done
958c2ecf20Sopenharmony_ci	nop			# E :
968c2ecf20Sopenharmony_ci	ret			# L0 : L U L U
978c2ecf20Sopenharmony_ci#else
988c2ecf20Sopenharmony_ci	/*
998c2ecf20Sopenharmony_ci	 * Slow and clunky.  It can probably be improved.
1008c2ecf20Sopenharmony_ci	 * An exercise left for others.
1018c2ecf20Sopenharmony_ci	 */
1028c2ecf20Sopenharmony_ci        negq    $2, $3		# E :
1038c2ecf20Sopenharmony_ci        and     $2, $3, $2	# E :
1048c2ecf20Sopenharmony_ci        and     $2, 0x0f, $1	# E :
1058c2ecf20Sopenharmony_ci        addq    $0, 4, $3	# E :
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci        cmoveq  $1, $3, $0	# E : Latency 2, extra map cycle
1088c2ecf20Sopenharmony_ci	nop			# E : keep with cmov
1098c2ecf20Sopenharmony_ci        and     $2, 0x33, $1	# E :
1108c2ecf20Sopenharmony_ci        addq    $0, 2, $3	# E : U L U L : 2 cycle stall on $0
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci        cmoveq  $1, $3, $0	# E : Latency 2, extra map cycle
1138c2ecf20Sopenharmony_ci	nop			# E : keep with cmov
1148c2ecf20Sopenharmony_ci        and     $2, 0x55, $1	# E :
1158c2ecf20Sopenharmony_ci        addq    $0, 1, $3	# E : U L U L : 2 cycle stall on $0
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci        cmoveq  $1, $3, $0	# E : Latency 2, extra map cycle
1188c2ecf20Sopenharmony_ci	nop
1198c2ecf20Sopenharmony_ci	nop
1208c2ecf20Sopenharmony_ci	ret			# L0 : L U L U
1218c2ecf20Sopenharmony_ci#endif
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	# Deal with the case where $18 > 8 bytes remain to be
1248c2ecf20Sopenharmony_ci	# searched.  $16 may not be aligned.
1258c2ecf20Sopenharmony_ci	.align 4
1268c2ecf20Sopenharmony_ci$first_quad:
1278c2ecf20Sopenharmony_ci	andnot	$16, 0x7, $0	# E :
1288c2ecf20Sopenharmony_ci        insqh   $3, $16, $2	# U : $2 = 0000ffffffffffff ($16<0:2> ff)
1298c2ecf20Sopenharmony_ci        xor	$1, $17, $1	# E :
1308c2ecf20Sopenharmony_ci	or	$1, $2, $1	# E : U L U L $1 = ====ffffffffffff
1318c2ecf20Sopenharmony_ci
1328c2ecf20Sopenharmony_ci        cmpbge  $31, $1, $2	# E :
1338c2ecf20Sopenharmony_ci        bne     $2, $found_it	# U :
1348c2ecf20Sopenharmony_ci	# At least one byte left to process.
1358c2ecf20Sopenharmony_ci	ldq	$1, 8($0)	# L :
1368c2ecf20Sopenharmony_ci	subq	$5, 1, $18	# E : U L U L
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	addq	$0, 8, $0	# E :
1398c2ecf20Sopenharmony_ci	# Make $18 point to last quad to be accessed (the
1408c2ecf20Sopenharmony_ci	# last quad may or may not be partial).
1418c2ecf20Sopenharmony_ci	andnot	$18, 0x7, $18	# E :
1428c2ecf20Sopenharmony_ci	cmpult	$0, $18, $2	# E :
1438c2ecf20Sopenharmony_ci	beq	$2, $final	# U : U L U L
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_ci	# At least two quads remain to be accessed.
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci	subq	$18, $0, $4	# E : $4 <- nr quads to be processed
1488c2ecf20Sopenharmony_ci	and	$4, 8, $4	# E : odd number of quads?
1498c2ecf20Sopenharmony_ci	bne	$4, $odd_quad_count # U :
1508c2ecf20Sopenharmony_ci	# At least three quads remain to be accessed
1518c2ecf20Sopenharmony_ci	mov	$1, $4		# E : L U L U : move prefetched value to correct reg
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_ci	.align	4
1548c2ecf20Sopenharmony_ci$unrolled_loop:
1558c2ecf20Sopenharmony_ci	ldq	$1, 8($0)	# L : prefetch $1
1568c2ecf20Sopenharmony_ci	xor	$17, $4, $2	# E :
1578c2ecf20Sopenharmony_ci	cmpbge	$31, $2, $2	# E :
1588c2ecf20Sopenharmony_ci	bne	$2, $found_it	# U : U L U L
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci	addq	$0, 8, $0	# E :
1618c2ecf20Sopenharmony_ci	nop			# E :
1628c2ecf20Sopenharmony_ci	nop			# E :
1638c2ecf20Sopenharmony_ci	nop			# E :
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci$odd_quad_count:
1668c2ecf20Sopenharmony_ci	xor	$17, $1, $2	# E :
1678c2ecf20Sopenharmony_ci	ldq	$4, 8($0)	# L : prefetch $4
1688c2ecf20Sopenharmony_ci	cmpbge	$31, $2, $2	# E :
1698c2ecf20Sopenharmony_ci	addq	$0, 8, $6	# E :
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci	bne	$2, $found_it	# U :
1728c2ecf20Sopenharmony_ci	cmpult	$6, $18, $6	# E :
1738c2ecf20Sopenharmony_ci	addq	$0, 8, $0	# E :
1748c2ecf20Sopenharmony_ci	nop			# E :
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	bne	$6, $unrolled_loop # U :
1778c2ecf20Sopenharmony_ci	mov	$4, $1		# E : move prefetched value into $1
1788c2ecf20Sopenharmony_ci	nop			# E :
1798c2ecf20Sopenharmony_ci	nop			# E :
1808c2ecf20Sopenharmony_ci
1818c2ecf20Sopenharmony_ci$final:	subq	$5, $0, $18	# E : $18 <- number of bytes left to do
1828c2ecf20Sopenharmony_ci	nop			# E :
1838c2ecf20Sopenharmony_ci	nop			# E :
1848c2ecf20Sopenharmony_ci	bne	$18, $last_quad	# U :
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_ci$not_found:
1878c2ecf20Sopenharmony_ci	mov	$31, $0		# E :
1888c2ecf20Sopenharmony_ci	nop			# E :
1898c2ecf20Sopenharmony_ci	nop			# E :
1908c2ecf20Sopenharmony_ci	ret			# L0 :
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci        .end memchr
1938c2ecf20Sopenharmony_ci	EXPORT_SYMBOL(memchr)
194