source: trunk/libs/newlib/src/newlib/libc/machine/i960/strncat_ca.S @ 444

Last change on this file since 444 was 444, checked in by satin@…, 6 years ago

add newlib,libalmos-mkh, restructure shared_syscalls.h and mini-libc

File size: 10.2 KB
Line 
1/*******************************************************************************
2 *
3 * Copyright (c) 1993 Intel Corporation
4 *
5 * Intel hereby grants you permission to copy, modify, and distribute this
6 * software and its documentation.  Intel grants this permission provided
7 * that the above copyright notice appears in all copies and that both the
8 * copyright notice and this permission notice appear in supporting
9 * documentation.  In addition, Intel grants this permission provided that
10 * you prominently mark as "not part of the original" any modifications
11 * made to this software or documentation, and that the name of Intel
12 * Corporation not be used in advertising or publicity pertaining to
13 * distribution of the software or the documentation without specific,
14 * written prior permission.
15 *
16 * Intel Corporation provides this AS IS, WITHOUT ANY WARRANTY, EXPRESS OR
17 * IMPLIED, INCLUDING, WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY
18 * OR FITNESS FOR A PARTICULAR PURPOSE.  Intel makes no guarantee or
19 * representations regarding the use of, or the results of the use of,
20 * the software and documentation in terms of correctness, accuracy,
21 * reliability, currentness, or otherwise; and you rely on the software,
22 * documentation and results solely at your own risk.
23 *
24 * IN NO EVENT SHALL INTEL BE LIABLE FOR ANY LOSS OF USE, LOSS OF BUSINESS,
25 * LOSS OF PROFITS, INDIRECT, INCIDENTAL, SPECIAL OR CONSEQUENTIAL DAMAGES
26 * OF ANY KIND.  IN NO EVENT SHALL INTEL'S TOTAL LIABILITY EXCEED THE SUM
27 * PAID TO INTEL FOR THE PRODUCT LICENSED HEREUNDER.
28 *
29 ******************************************************************************/
30
31        .file "sncat_ca.s"
32#ifdef  __PIC
33        .pic
34#endif
35#ifdef  __PID
36        .pid
37#endif
38/*
39 * (c) copyright 1988,1993 Intel Corp., all rights reserved
40 */
41
42/*
43        procedure strncat  (optimized assembler version for the CA)
44
45        dest_addr = strncat (dest_addr, src_addr, max_bytes)
46
47        append the null terminated string pointed to by src_addr to the null
48        terminated string pointed to by dest_addr.  Return the original
49        dest_addr.  If the source string is longer than max_bytes, then
50        append only max_bytes bytes, and tack on a null byte on the end
51
52        This routine will fail if the source and destination string
53        overlap (in particular, if the end of the source is overlapped
54        by the beginning of the destination).  The behavior is undefined.
55        This is acceptable according to the draft C standard.
56
57        Undefined behavior will also occur if the end of the source string
58        (i.e. the terminating null byte) is in the last word of the program's
59        allocated memory space.  This is so because, in several cases, strncat
60        will fetch ahead one word.  Disallowing the fetch ahead would impose
61        a severe performance penalty.
62
63        This program handles five cases:
64
65        1) both arguments start on a word boundary
66        2) neither are word aligned, but they are offset by the same amount
67        3) source is word aligned, destination is not
68        4) destination is word aligned, source is not
69        5) neither is word aligned, and they are offset by differing amounts
70
71        At the time of this writing, only g0 thru g7 and g13 are available
72        for use in this leafproc;  other registers would have to be saved and
73        restored.  These nine registers, plus tricky use of g14 are sufficient
74        to implement the routine.  The registers are used as follows:
75
76        g0  original dest ptr;  not modified, so that it may be returned.
77        g1  src ptr;  shift count
78        g2  max_bytes
79        g3  src ptr (word aligned)
80        g4  dest ptr (word aligned)
81        g5  0xff  --  byte extraction mask
82        Little endian:
83                g6  lsw of double word for extraction of 4 bytes
84                g7  msw of double word for extraction of 4 bytes
85        Big endian:
86                g6  msw of double word for extraction of 4 bytes
87                g7  lsw of double word for extraction of 4 bytes
88        g13 return address
89        g14 byte extracted.
90*/
91
92#if __i960_BIG_ENDIAN__
93#define MSW g6
94#define LSW g7
95#else
96#define LSW g6
97#define MSW g7
98#endif
99
100        .globl  _strncat
101        .globl  __strncat
102        .leafproc       _strncat, __strncat
103        .align  2
104_strncat:
105#ifndef __PIC
106        lda     Lrett,g14
107#else
108        lda     Lrett-(.+8)(ip),g14
109#endif
110__strncat:
111        notand  g0,3,g4         # extract word addr of start of dest
112         lda    (g14),g13       # preserve return address
113        cmpibge.f 0,g2,Lexit_code # Lexit if number of bytes to move is <= zero.
114        and     g0,3,LSW        # extract byte offset of dest
115         ld     (g4),MSW        # fetch word containing at least first byte
116        shlo    3,LSW,g14       # get shift count for making mask for first word
117        subi    1,0,LSW         # mask initially all ones
118#if __i960_BIG_ENDIAN__
119        shro    g14,LSW,LSW     # get mask for bytes needed from first word
120#else
121        shlo    g14,LSW,LSW     # get mask for bytes needed from first word
122#endif
123        notor   MSW,LSW,MSW     # set unneeded bytes to all ones
124         lda    0xff,g5         # byte extraction mask
125Lsearch_for_word_with_null:
126        scanbyte 0,MSW          # check for null byte
127         lda    4(g4),g4        # post-increment dest word pointer
128        mov     MSW,LSW         # keep a copy of current word
129         ld     (g4),MSW        # fetch next word of dest
130         bno.t  Lsearch_for_word_with_null      # branch if null not found yet
131#if __i960_BIG_ENDIAN__
132        shro    24,LSW,g14      # extract byte
133#else
134        and     g5,LSW,g14      # extract byte
135#endif
136        cmpo    0,g14           # branch if null is first byte of word
137        subo    4,g4,g4         # move dest word ptr to word with null
138        notand  g1,3,g3         # extract word addr of start of src
139         bne.t  Lsearch_for_null
140
141Lcase_14:
142        cmpo    g1,g3           # check alignment of source
143         ld     (g3),LSW        # fetch first word of source
144        shlo    3,g1,g14        # compute shift count
145         lda    4(g3),g3        # post-increment src addr
146         bne.f  Lcase_4         # branch if source is unaligned
147Lcase_1:
148Lcase_1_wloop:                  # word copying loop
149        cmpi    g2,4            # check for fewer than four bytes to move
150         lda    (LSW),g1        # keep a copy of the src word
151         bl.f   Lcase_1_cloop   # branch if fewer than four bytes to copy
152        scanbyte 0,g1           # check for null byte in src word
153         ld     (g3),LSW        # pre-fetch next word of src
154        addo    4,g3,g3         # post-increment src addr
155         bo.f   Lcase_1_cloop   # branch if word contains null byte
156        subi    4,g2,g2         # decrease max_byte count by the 4 bytes moved
157         st     g1,(g4)         # store word in dest string
158        addo    4,g4,g4         # post-increment dest addr
159         b      Lcase_1_wloop
160
161Lcase_3_cloop:
162Lcase_1_cloop:                  # character copying loop (max_bytes <= 3)
163        cmpdeci 0,g2,g2         # is max_bytes exhausted?
164#if __i960_BIG_ENDIAN__
165        rotate  8,g1,g1         # move next byte into position for extraction
166#endif
167        and     g5,g1,g14       # extract next char
168        be.f    Lstore_null     # if max_bytes is exhausted, store null and quit
169        cmpo    0,g14           # check for null byte
170         stob   g14,(g4)        # store the byte in dest
171#if ! __i960_BIG_ENDIAN__
172        shro    8,g1,g1         # move next byte into position for extraction
173#endif
174         lda    1(g4),g4        # post-increment dest byte addr
175         bne.t  Lcase_1_cloop   # branch if null not reached
176        bx      (g13)           # Lexit (g14 == 0)
177
178Lstore_null:
179        mov     0,g14           # store null, and set g14 to zero
180        stob    g14,(g4)
181        bx      (g13)
182
183
184Lsearch_for_null:
185#if __i960_BIG_ENDIAN__
186        shlo    8,LSW,LSW       # check next byte
187        shro    24,LSW,g14
188#else
189        shlo    8,g5,g5         # move mask up to next byte
190        and     g5,LSW,g14      # extract byte
191#endif
192         lda    1(g4),g4        # move dest byte ptr to next byte
193        cmpobne.t 0,g14,Lsearch_for_null        # branch if null is not yet found
194
195Lcase_235:
196        cmpo    g1,g3           # check alignment of src
197         ld     (g3),LSW        # pre-fetch word with start of src
198        and     3,g1,g1         # compute shift count
199         lda    0xff,g5         # load mask for byte extraction
200        shlo    3,g1,g14       
201         lda    4(g3),g3        # post-increment src word counter
202         be.t   Lcase_3         # branch if src is word aligned
203        and     g4,3,MSW        # extract byte offset for dest string
204        cmpo    MSW,g1          # < indicates first word of dest has more bytes
205                                /* than first word of source. */
206         ld     (g3),MSW        # fetch second word of src
207#if __i960_BIG_ENDIAN__
208        subo    g14,0,g14       # adjust shift count for big endian
209#endif
210        eshro   g14,g6,g5       # extract four bytes
211#if __i960_BIG_ENDIAN__
212         bge.f  1f
213#else
214         bg.f   1f
215#endif
216        mov     MSW,LSW
217         lda    4(g3),g3        # move src word addr to second word boundary
2181:
219        mov     g5,MSW
220         lda    0xff,g5
221         b      Lcase_25
222
223Lcase_3:                                # src is word aligned; dest is not
224        mov     LSW,MSW         # make copy of first word of src
225         lda    32,g14          # initialize shift count to zero (mod 32)
226Lcase_25:
227
228Lcase_3_cloop_at_start:         # character copying loop for start of dest str
229        cmpdeci 0,g2,g2         # is max_bytes exhausted?
230#if __i960_BIG_ENDIAN__
231        shro    24,MSW,g5       # extract next char
232#else
233        and     g5,MSW,g5       # extract next char
234#endif
235         be.f   Lstore_null     # Lexit if max_bytes is exhausted
236        cmpo    0,g5            # check for null byte
237         stob   g5,(g4)         # store the byte in dest
238        addo    1,g4,g4         # post-increment dest ptr
239         lda    0xff,g5         # re-initialize byte extraction mask
240        notand  g4,3,g1         # extract word address
241         be.t   Lexit_code      # Lexit if null byte reached
242        cmpo    g1,g4           # have we reached word boundary in dest yet?
243#if __i960_BIG_ENDIAN__
244         lda    -8(g14),g14     # augment the shift counter
245        rotate  8,MSW,MSW       # move next byte into position for extraction
246#else
247         lda    8(g14),g14      # augment the shift counter
248        shro    8,MSW,MSW       # move next byte into position for extraction
249#endif
250         bne.t  Lcase_3_cloop_at_start  # branch if reached word boundary?
251
252#if __i960_BIG_ENDIAN__
253        cmpo    0,g14
254         ld     (g3),MSW        # fetch msw of operand for double shift
255        bne     Lcase_3_wloop   # branch if src is still unaligned.
256
257Lcase_3_wloop2:
258        cmpi    g2,4            # less than four bytes to move?
259        mov     LSW,g1          # extract 4 bytes of src
260         lda    4(g3),g3        # post-increment src word addr
261         bl.f   Lcase_3_cloop   # branch if < four bytes left to move
262        scanbyte 0,g1           # check for null byte
263        mov     MSW,LSW         # move msw to lsw
264         ld     (g3),MSW        # pre-fetch msw of operand for double shift
265         bo.f   Lcase_3_cloop   # branch if word contains null byte
266        subi    4,g2,g2         # decrease max_byte count by the 4 bytes moved
267         st     g1,(g4)         # store 4 bytes to dest
268        addo    4,g4,g4         # post-increment dest ptr
269         b      Lcase_3_wloop2
270Lcase_4:
271        subo    g14,0,g14       # adjust shift count for big endian
272#else
273Lcase_4:
274#endif
275
276        ld      (g3),MSW        # fetch msw of operand for double shift
277
278Lcase_3_wloop:
279        cmpi    g2,4            # less than four bytes to move?
280        eshro   g14,g6,g1       # extract 4 bytes of src
281         lda    4(g3),g3        # post-increment src word addr
282         bl.f   Lcase_3_cloop   # branch if < four bytes left to move
283        scanbyte 0,g1           # check for null byte
284        mov     MSW,LSW         # move msw to lsw
285         ld     (g3),MSW        # pre-fetch msw of operand for double shift
286         bo.f   Lcase_3_cloop   # branch if word contains null byte
287        subi    4,g2,g2         # decrease max_byte count by the 4 bytes moved
288         st     g1,(g4)         # store 4 bytes to dest
289        addo    4,g4,g4         # post-increment dest ptr
290         b      Lcase_3_wloop
291
292
293Lexit_code:
294        mov     0,g14           # conform to register conventions
295        bx      (g13)           # g0 = addr of dest;  g14 = 0
296Lrett:
297        ret
298
299/* end of strncat */
300
Note: See TracBrowser for help on using the repository browser.