1/*	$NetBSD: ashldi3.S,v 1.3 2020/08/22 10:12:29 isaki Exp $	*/
2
3/*
4 * Copyright (C) 2020 Tetsuya Isaki. All rights reserved.
5 * Copyright (C) 2020 Y.Sugahara (moveccr). All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 *    notice, this list of conditions and the following disclaimer in the
14 *    documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29/*
30 * Size optimized version for primary bootloader.
31 */
32
33#include <machine/asm.h>
34
35ASENTRY_NOPROFILE(__ashldi3)
36		moveml	%sp@(4),%d0-%d1/%a0	| %d0:%d1 = quad value
37						| %a0     = shift count
38		jbra	start
39loop:
40		addl	%d1,%d1			| X:%d1 <<= 1
41		addxl	%d0,%d0			| %d0:X <<= 1
42start:
43		subql	#1,%a0			| sub %a0 doesn't affect ccr,
44		tstl	%a0			|  but this extra TST op is
45						|  smaller than push/pop %d2.
46		jpl	loop
47		rts
48
49
50#if defined(SELFTEST)
51#include "iocscall.h"
52		.macro	PRINT	msg
53		leal	\msg,%a1
54		IOCS(__B_PRINT)
55		.endm
56
57		.macro	TEST	name
58		leal	\name,%a2
59		jbsr	test
60		.endm
61
62ASENTRY_NOPROFILE(selftest_ashldi3)
63		moveml	%d2-%d7/%a2-%a6,%sp@-
64		PRINT	%pc@(msg_testname)
65
66		TEST	test0
67		TEST	test1
68		TEST	test2
69		TEST	test63
70
71		PRINT	%pc@(msg_crlf)
72		moveml	%sp@+,%d2-%d7/%a2-%a6
73		rts
74
75test:
76		moveml	%a2@+,%d0-%d2		| %d0:%d1 = value
77						| %d2     = count
78		moveml	%d0-%d2,%sp@-
79		jbsr	__ashldi3
80		leal	%sp@(12),%sp
81
82		cmpl	%a2@+,%d0		| compare high word
83		jne	fail
84		cmpl	%a2@+,%d1		| compare low word
85		jne	fail
86		PRINT	%pc@(msg_ok)
87		rts
88fail:
89		PRINT	%pc@(msg_fail)
90		rts
91
92test0:		| count = 0
93		.long	0x11223344, 0x55667788
94		.long	0
95		.long	0x11223344, 0x55667788
96
97test1:		| count = 1
98		.long	0x11223344, 0x55667788
99		.long	1
100		.long	0x22446688, 0xaaccef10
101
102test2:		| count = 2
103		.long	0x11223344, 0x55667788
104		.long	2
105		.long	0x4488cd11, 0x5599de20
106
107test63:		| count = 63
108		.long	0x11223344, 0x55667789
109		.long	63
110		.long	0x80000000, 0x00000000
111
112msg_testname:
113		.asciz	"__ashldi3"
114msg_ok:
115		.asciz	" ok"
116msg_fail:
117		.asciz	" fail"
118msg_crlf:
119		.asciz	"\r\n"
120
121#endif
122