nuttx/libs/libc/machine/risc-v/arch_strnlen.S
ganjing 9b20c629fe libs/libc/risc-v: Add optimized string and memory functions.
Add assembly-optimized implementations for 14 string/memory functions
using word-at-a-time techniques (DETECTNULL, broadcast+XOR) and
XLEN-adaptive macros for both RV32 and RV64:

 - memmove: direction check + forward tail to memcpy, reverse path
   with 16xSZREG unroll and shift-merge for misaligned src.
 - memcmp: word-granularity compare when both pointers share alignment,
   bytewise fallback for mismatched pointers.
 - memchr: broadcast target byte, XOR with each word, DETECTNULL to
   find matches. Counter-based bounds (no pointer overflow).
 - strlen: DETECTNULL word loop, constants loaded from .srodata.
 - strnlen: strlen with counter-based length limit.
 - strcpy/strncpy: word loop with DETECTNULL, zero-fill remainder
   for strncpy. strncpy reuses strcpy via #define USE_AS_STRNCPY.
 - stpcpy/stpncpy: reuse strcpy/strncpy via #define USE_AS_STPCPY.
 - strchr/strchrnul: broadcast+XOR detecting both target char and
   null simultaneously. strchrnul reuses strchr via #define.
 - strrchr: forward scan recording last match position.
 - strncmp: word-at-a-time compare with null detection and counter.
 - strcat: strlen(dst) then strcpy(dst_end, src) word-at-a-time.

Each function is independently selectable via CONFIG_RISCV_<FUNC>,
or all enabled together with CONFIG_RISCV_STRING_FUNCTION=y.

Assisted-by: Claude Opus 5 (1M context) <noreply@anthropic.com>
Signed-off-by: ganjing <ganjing@xiaomi.com>
2026-08-12 10:23:47 +08:00

123 lines
2.7 KiB
ArmAsm

/****************************************************************************
* libs/libc/machine/risc-v/arch_strnlen.S
*
* SPDX-License-Identifier: Apache-2.0
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
#include "libc.h"
#ifdef LIBC_BUILD_STRNLEN
#include "asm.h"
.text
.global ARCH_LIBCFUN(strnlen)
.type ARCH_LIBCFUN(strnlen), @function
.align 2
/************************************************************************************
* Name: strnlen
*
* size_t strnlen(const char *s, size_t maxlen)
*
* Word-at-a-time DETECTNULL with maxlen bound.
************************************************************************************/
ARCH_LIBCFUN(strnlen):
.cfi_sections .debug_frame
.cfi_startproc
beqz a1, .Lret_zero
mv t0, a0 /* t0 = current ptr */
mv t6, a1 /* t6 = remaining count */
/* Align head */
.Lhead:
andi t1, t0, SZREG-1
beqz t1, .Laligned
beqz t6, .Lret_maxlen
lbu t2, 0(t0)
beqz t2, .Ldone
addi t0, t0, 1
addi t6, t6, -1
j .Lhead
.Laligned:
#if SZREG == 8
lla t2, .Lsnl_mask01
ld t2, 0(t2)
lla t3, .Lsnl_mask80
ld t3, 0(t3)
#else
li t2, 0x01010101
li t3, 0x80808080
#endif
/* Word loop with count check */
.Lword_loop:
li t4, SZREG
bltu t6, t4, .Ltail /* not enough bytes for a word */
REG_L t1, 0(t0)
/* DETECTNULL */
sub t4, t1, t2
not t5, t1
and t4, t4, t5
and t4, t4, t3
bnez t4, .Lfind_byte
addi t0, t0, SZREG
addi t6, t6, -SZREG
j .Lword_loop
.Lfind_byte:
/* Null in this word, find exact position */
.Ltail:
beqz t6, .Lret_maxlen
lbu t1, 0(t0)
beqz t1, .Ldone
addi t0, t0, 1
addi t6, t6, -1
j .Ltail
.Ldone:
sub a0, t0, a0
ret
.Lret_maxlen:
mv a0, a1
ret
.Lret_zero:
li a0, 0
ret
.cfi_endproc
.size ARCH_LIBCFUN(strnlen), .-ARCH_LIBCFUN(strnlen)
#if SZREG == 8
.section .srodata.cst8,"aM",@progbits,8
.align 3
.Lsnl_mask01:
.dword 0x0101010101010101
.Lsnl_mask80:
.dword 0x8080808080808080
#endif
#endif