]>
Commit | Line | Data |
---|---|---|
5624e564 | 1 | ; Copyright (C) 2011-2015 Free Software Foundation, Inc. |
85b8555e DD |
2 | ; Contributed by Red Hat. |
3 | ; | |
4 | ; This file is free software; you can redistribute it and/or modify it | |
5 | ; under the terms of the GNU General Public License as published by the | |
6 | ; Free Software Foundation; either version 3, or (at your option) any | |
7 | ; later version. | |
8 | ; | |
9 | ; This file is distributed in the hope that it will be useful, but | |
10 | ; WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
12 | ; General Public License for more details. | |
13 | ; | |
14 | ; Under Section 7 of GPL version 3, you are granted additional | |
15 | ; permissions described in the GCC Runtime Library Exception, version | |
16 | ; 3.1, as published by the Free Software Foundation. | |
17 | ; | |
18 | ; You should have received a copy of the GNU General Public License and | |
19 | ; a copy of the GCC Runtime Library Exception along with this program; | |
20 | ; see the files COPYING3 and COPYING.RUNTIME respectively. If not, see | |
21 | ; <http://www.gnu.org/licenses/>. | |
22 | ||
5c0029de | 23 | #include "vregs.h" |
85b8555e DD |
24 | |
25 | .text | |
26 | .global ___lshrsi3 | |
27 | .type ___lshrsi3, @function | |
28 | ___lshrsi3: | |
29 | ||
30 | ;; input: | |
31 | ;; | |
32 | ;; [zero] | |
33 | ;; [count] <= $sp+8 | |
34 | ;; [in MSB] | |
35 | ;; [in] | |
36 | ;; [in] | |
37 | ;; [in LSB] <- $sp+4 | |
38 | ||
39 | ;; output: | |
40 | ;; | |
41 | ;; [r8..r11] result | |
42 | ||
43 | ;; registers: | |
44 | ;; | |
45 | ;; AX - temp for shift/rotate | |
46 | ;; B - count | |
47 | ||
48 | mov a, [sp+8] ; A now contains the count | |
49 | ||
50 | cmp a, #0x20 | |
51 | bc $.Lcount_is_normal | |
52 | ||
53 | ;; count is out of bounds, just return zero. | |
54 | movw r8, #0 | |
55 | movw r10, #0 | |
56 | ret | |
57 | ||
58 | .Lcount_is_normal: | |
59 | cmp0 a | |
60 | bnz $.Lcount_is_nonzero | |
61 | ||
62 | ;; count is zero, just copy IN to OUT | |
63 | movw ax, [sp+4] | |
64 | movw r8, ax | |
65 | movw ax, [sp+6] | |
66 | movw r10, ax | |
67 | ret | |
68 | ||
69 | .Lcount_is_nonzero: | |
70 | mov b, a ; B now contains the count also | |
71 | bf a.4, $.Lcount_lt_16 | |
72 | ||
73 | ;; count >= 16, shift 16 at a time. | |
74 | movw r10, #0 | |
75 | movw ax, [sp+6] | |
76 | movw r8, ax | |
77 | mov a, b | |
78 | and a, #0x0f | |
79 | sknz | |
80 | ret | |
81 | ||
82 | mov b, a ; B now contains the remaining count | |
83 | inc b | |
84 | br $.Lloop_top | |
85 | ||
86 | .Lcount_lt_16: | |
87 | ;; count is nonzero. Do one | |
88 | movw ax, [sp+6] | |
89 | shrw ax,1 | |
90 | movw r10, ax | |
91 | mov a, [sp+5] | |
92 | rorc a,1 | |
93 | mov r9, a | |
94 | mov a, [sp+4] | |
95 | rorc a,1 | |
96 | mov r8, a | |
97 | ||
98 | ;; we did one shift above; do as many more as we need now. | |
99 | .Lloop_top: | |
100 | dec b | |
101 | sknz | |
102 | ret | |
103 | ||
104 | movw ax, r10 | |
105 | shrw ax,1 | |
106 | movw r10, ax | |
107 | mov a, r9 | |
108 | rorc a,1 | |
109 | mov r9, a | |
110 | mov a, r8 | |
111 | rorc a,1 | |
112 | mov r8, a | |
113 | ||
114 | br $.Lloop_top | |
115 | ||
116 | .size ___lshrsi3, .-___lshrsi3 |