Retro68/gcc/newlib/libc/machine/i960/strncpy.S
Wolfgang Thaller d464252791 re-add newlib
2017-04-11 23:13:36 +02:00

155 lines
5.5 KiB
ArmAsm

/*******************************************************************************
*
* Copyright (c) 1993 Intel Corporation
*
* Intel hereby grants you permission to copy, modify, and distribute this
* software and its documentation. Intel grants this permission provided
* that the above copyright notice appears in all copies and that both the
* copyright notice and this permission notice appear in supporting
* documentation. In addition, Intel grants this permission provided that
* you prominently mark as "not part of the original" any modifications
* made to this software or documentation, and that the name of Intel
* Corporation not be used in advertising or publicity pertaining to
* distribution of the software or the documentation without specific,
* written prior permission.
*
* Intel Corporation provides this AS IS, WITHOUT ANY WARRANTY, EXPRESS OR
* IMPLIED, INCLUDING, WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY
* OR FITNESS FOR A PARTICULAR PURPOSE. Intel makes no guarantee or
* representations regarding the use of, or the results of the use of,
* the software and documentation in terms of correctness, accuracy,
* reliability, currentness, or otherwise; and you rely on the software,
* documentation and results solely at your own risk.
*
* IN NO EVENT SHALL INTEL BE LIABLE FOR ANY LOSS OF USE, LOSS OF BUSINESS,
* LOSS OF PROFITS, INDIRECT, INCIDENTAL, SPECIAL OR CONSEQUENTIAL DAMAGES
* OF ANY KIND. IN NO EVENT SHALL INTEL'S TOTAL LIABILITY EXCEED THE SUM
* PAID TO INTEL FOR THE PRODUCT LICENSED HEREUNDER.
*
******************************************************************************/
.file "strncpy.s"
#ifdef __PIC
.pic
#endif
#ifdef __PID
.pid
#endif
/*
* (c) copyright 1988,1993 Intel Corp., all rights reserved
*/
/*
procedure strncpy (optimized assembler version for the 80960K Series)
dest_addr = strncpy (dest_addr, src_addr, max_bytes)
copy the null terminated string pointed to by src_addr to the
string pointed to by dest_addr. Return the original dest_addr.
If the source string is shorter than max_bytes, then null-pad
the destination string. If it is longer than max_bytes, the
copy stops at max_bytes bytes (and no terminating null appears
in the destination string).
This routine will fail if the source and destination string
overlap (in particular, if the end of the source is overlapped
by the beginning of the destination). The behavior is undefined.
This is acceptable according to the draft C standard.
Undefined behavior will also occur if the end of the source string
(i.e. the terminating null byte) is in the last two words of the
program's allocated memory space. This is so because strncpy fetches
ahead. Disallowing the fetch ahead would impose a severe performance
penalty.
Strategy:
Fetch and store the strings by words and go to a character move loop
as soon as a null byte is encountered. If max_bytes is exhausted
first, then terminate after moving only max_bytes (with the last
0, 1, 2, or 3 bytes moved as single bytes, not as a word).
Otherwise, the character move loop moves the last bytes or the
source string, and then null-pads the destination string until
max_bytes is exhausted.
Tactics:
1) Do NOT try to fetch the words in a word aligned manner because,
in my judgement, the performance degradation experienced due to
non-aligned accesses does NOT outweigh the time and complexity added
by the preamble and convoluted body that would be necessary to assure
alignment.
2) When the null byte is encountered in a source word, null out the
higher-numbered bytes in that word, store the word in the destination,
and go to the word null-padder, which may eventually go to the byte
null-padder.
*/
.globl _strncpy
.globl __strncpy
.leafproc _strncpy,__strncpy
.align 2
_strncpy:
#ifndef __PIC
lda Lrett,g14
#else
lda Lrett-(.+8)(ip),g14
#endif
__strncpy:
mov g14, g13
cmpibge 0,g2,Lexit # quit early if max_bytes <= 0
ld (g1), g7 # fetch the first word of the source
mov g0, g5
lda 0xff, g3 # byte extraction mask
addo g1, g2, g6
addo g2, g5, g2
Lwloop: # word copying loop
addo 4, g1, g1 # post-increment source ptr
cmpo g6, g1 # max_bytes < 4 ?
mov g7, g4 # keep a copy of source word
bl Lcloop.a # if less than four bytes to go, go to char loop
scanbyte 0, g4 # null byte found?
ld (g1), g7 # pre-fetch next word of the source
be Lcloop.c # go to char loop if null encountered
st g4, (g5) # store current word
addo 4, g5, g5 # post-increment destination ptr
b Lwloop
Lcloop.a: # character copying loop (max_bytes < 3)
and g3, g4, g14 # extract byte
Lcloop.b:
cmpo g2, g5 # max_bytes <= 0 ?
shro 8, g4, g4 # position word to extract next byte
be Lexit # exit if max_bytes exhausted
cmpo 0, g14 # is it null?
stob g14, (g5) # store it
addo 1, g5, g5 # post-increment dest ptr
bne Lcloop.a # branch if we are NOT null padding
b Lcloop.b # branch if we are null padding
Lexit:
mov 0, g14
bx (g13) # g0 = dest string address; g14 = 0
Lrett:
ret
Lcloop.c: # character copying loop
and g3, g4, g14 # extract byte
cmpo 0, g14 # is it null?
mov g3, g7 # save mask
shlo 8, g3, g3 # shift mask to next byte position
bne Lcloop.c # loop until null found
subo 1, g7, g3 # mask to null pad after null byte
and g3, g4, g4 # null-out stuff after null byte
st g4, (g5) # store last part of src and first of null-pad
subo 8,g2,g6 # adjust max_byte counter
Lzwloop:
cmpo g5, g6 # max_bytes < 4 ?
addo 4, g5, g5
bg Lcloop.b # if so, goto character loop
st g14, (g5) # store four null bytes
b Lzwloop
/* end of strncpy */