| /* |
| * (c) Copyright 1986 HEWLETT-PACKARD COMPANY |
| * |
| * To anyone who acknowledges that this file is provided "AS IS" |
| * without any express or implied warranty: |
| * permission to use, copy, modify, and distribute this file |
| * for any purpose is hereby granted without fee, provided that |
| * the above copyright notice and this notice appears in all |
| * copies, and that the name of Hewlett-Packard Company not be |
| * used in advertising or publicity pertaining to distribution |
| * of the software without specific, written prior permission. |
| * Hewlett-Packard Company makes no representations about the |
| * suitability of this software for any purpose. |
| */ |
| |
| /* HPUX_ID: @(#) $Revision: 1.1 $ */ |
| /* |
| * strcat(s1, s2) |
| * |
| * Concatenate s2 on the end of s1. S1's space must be large enough. |
| * Return s1. |
| */ |
| #include "DEFS.h" |
| |
| #define d_addr r26 |
| #define s_addr r25 |
| #define tmp6 r24 |
| #define tmp1 r19 |
| #define tmp2 r20 |
| #define tmp3 r21 |
| #define tmp4 r22 |
| #define tmp5 arg3 |
| #define save r1 |
| |
| |
| ENTRY(strcat) |
| |
| comb,= r0,s_addr,done /* quit if s2=NULL */ |
| copy d_addr,ret0 /* The return value is the value of d_addr. DELAY SLOT*/ |
| |
| /* First look for end of s1 (d_addr) */ |
| |
| extru d_addr,31,2,tmp1 /* Extract the low two bits of the dest address. */ |
| combt,= tmp1,r0,dont_mask |
| dep 0,31,2,d_addr /*set word alignment */ |
| ldwm 4(d_addr),tmp2 |
| sh3add tmp1,r0,save /* build mask based on tmp1 */ |
| mtctl save,11 |
| zvdepi -2,32,save |
| or save,tmp2,tmp2 |
| uxor,nbz tmp2,r0,save |
| search: |
| b,n found_end /* nullified under uxor conditions above and below */ |
| dont_mask: |
| ldwm 4(d_addr),tmp2 |
| comib,tr r0,r0,search |
| uxor,nbz tmp2,r0,save |
| |
| found_end: /* at this point d_addr points to word */ |
| extru,<> save,7,8,r0 /* following word with null */ |
| addib,tr,n -4,d_addr,begin_copy /*set d_addr to end of s1 */ |
| extru,<> save,15,8,r0 |
| addib,tr,n -3,d_addr,begin_copy |
| extru,<> save,23,8,r0 |
| addi -1,d_addr,d_addr |
| addi -1,d_addr,d_addr |
| |
| |
| begin_copy: |
| |
| extru s_addr,31,2,tmp1 /* Extract the low two bits of the source address. */ |
| extru d_addr,31,2,tmp6 /* Extract the low two bits of the destination address. */ |
| sub,= tmp6,tmp1,tmp3 /* Compute the shift quantity and don't branch if tmp6=tmp1. */ |
| b not_aligned /* Not_aligned says that shifts Will be needed. */ |
| dep 0,31,2,s_addr /* Compute the word address of the source. DELAY SLOT. */ |
| /* aligned */ |
| |
| combt,= tmp6,r0,skip_mask |
| ldwm 4(0,s_addr),tmp1 /* tmp1 = *s_addr s_addr += 4 (DELAY SLOT) */ |
| sh3add tmp6,r0,save |
| mtctl save,r11 |
| zvdepi -2,32,save |
| or save,tmp1,tmp1 |
| uxor,nbz tmp1,r0,save |
| b,n first_null /* special case: null in first word */ |
| b,n skip_mask2 |
| |
| chunks: |
| b,n null_found /* delay slot for uxor below */ |
| |
| skip_mask2: |
| stbys,b,m tmp1,4(d_addr) |
| ldwm 4(s_addr),tmp1 |
| skip_mask: |
| comib,tr 0,0,chunks |
| uxor,nbz tmp1,r0,save |
| |
| /* Begin non_aligned code. */ |
| |
| not_aligned: |
| sh3add,>= tmp3,r0,tmp4 /* compute the shift amt.and skip load if tmp6 > tmp1. */ |
| ldwm 4(0,s_addr),tmp1 /* load up the first word from the source. tmp1 = *s_addr++ */ |
| ldwm 4(0,s_addr),tmp2 /* get either first or second word from source. */ |
| combt,= tmp6,r0,chunk2 /* don't mask if whole word is valid */ |
| mtctl tmp4,11 /* load the shift count into cr11 = shift count register. */ |
| vshd tmp1,tmp2,tmp3 /* position data ! (delay slot) */ |
| sh3add tmp6,r0,save /* setup r1 */ |
| mtctl save,r11 /* set-up cr11 for mask */ |
| zvdepi -2,32,save |
| or save, tmp3, tmp3 |
| uxor,nbz tmp3,r0,save |
| b,n first_null2 |
| b did_mask |
| mtctl tmp4,11 /* re-load the shift count into cr11 */ |
| |
| chunk2: |
| vshd tmp1,tmp2,tmp3 |
| uxor,nbz tmp3, r0, save |
| b,n null_found |
| did_mask: |
| stbys,b,m tmp3,4(0,d_addr) /* store ! */ |
| |
| ldwm 4(0,s_addr),tmp1 /* get next word ! */ |
| vshd tmp2,tmp1,tmp3 /* position data ! */ |
| uxor,nbz tmp3, r0, save |
| b,n null_found |
| stwm tmp3,4(d_addr) |
| comib,tr 0,0,chunk2 |
| ldwm 4(s_addr),tmp2 |
| |
| |
| null_found: /* adjust d_addr and store final word */ |
| |
| extru,<> save,7,8,r0 |
| addib,tr,n 1,d_addr,store_final |
| extru,<> save,15,8,r0 |
| addib,tr,n 2,d_addr,store_final |
| extru,<> save,23,8,r0 |
| addib,tr 3,d_addr,store_final2 |
| bv 0(r2) |
| stw save,0(d_addr) |
| |
| store_final: |
| bv 0(r2) |
| store_final2: |
| stbys,e save,0(d_addr) /* delay slot */ |
| |
| first_null: /* null found in first word of aligned (wrt d_addr) */ |
| addi -4,s_addr,s_addr |
| ldbx tmp6(s_addr),tmp4 |
| add tmp6,s_addr,s_addr |
| comib,= 0,tmp4,done |
| stbs,ma tmp4,1(d_addr) |
| ldbs 1(s_addr),tmp4 |
| comib,= 0,tmp4,done |
| stbs,ma tmp4,1(d_addr) |
| bv 0(r2) /* done */ |
| stbs 0,0(d_addr) |
| |
| first_null2: /* null found in first word of non-aligned (wrt d_addr) */ |
| addibt,= -1,tmp6,check3 /* check last 3 bytes of word */ |
| extru save,15,8,tmp4 |
| addibt,=,n -1,tmp6,check2 /* check last 2 bytes */ |
| bv 0(r2) |
| stbys,b save, 0(d_addr) |
| |
| check3: |
| combt,= tmp4,r0,done |
| stbs,ma tmp4,1(d_addr) |
| check2: |
| extru,<> save,23,8,tmp4 |
| bv 0(r2) |
| stbs,ma tmp4,1(d_addr) |
| bv 0(r2) |
| stbs r0,0(d_addr) |
| |
| done: |
| EXIT(strcat) |
