Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 1 | /* |
Ken Liu | 8fb61f1 | 2021-12-14 08:32:10 +0800 | [diff] [blame^] | 2 | * Copyright (c) 2020-2022, Arm Limited. All rights reserved. |
Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | * |
| 6 | */ |
| 7 | |
| 8 | #include "crt_impl_private.h" |
| 9 | |
| 10 | void *memset(void *s, int c, size_t n) |
| 11 | { |
Ken Liu | 8fb61f1 | 2021-12-14 08:32:10 +0800 | [diff] [blame^] | 12 | union composite_addr_t p_mem; |
| 13 | uint32_t pattern_word; |
Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 14 | |
| 15 | p_mem.p_byte = (uint8_t *)s; |
Ken Liu | 8fb61f1 | 2021-12-14 08:32:10 +0800 | [diff] [blame^] | 16 | pattern_word = (((uint8_t)c) << 24) | (((uint8_t)c) << 16) | |
Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 17 | (((uint8_t)c) << 8) | ((uint8_t)c); |
| 18 | |
Ken Liu | 8fb61f1 | 2021-12-14 08:32:10 +0800 | [diff] [blame^] | 19 | while (n && ADDR_WORD_UNALIGNED(p_mem.uint_addr)) { |
Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 20 | *p_mem.p_byte++ = (uint8_t)c; |
| 21 | n--; |
| 22 | } |
| 23 | |
| 24 | while (n >= sizeof(uint32_t)) { |
Ken Liu | 8fb61f1 | 2021-12-14 08:32:10 +0800 | [diff] [blame^] | 25 | *p_mem.p_word++ = pattern_word; |
Summer Qin | f24dbb5 | 2020-07-23 14:53:54 +0800 | [diff] [blame] | 26 | n -= sizeof(uint32_t); |
| 27 | } |
| 28 | |
| 29 | while (n--) { |
| 30 | *p_mem.p_byte++ = (uint8_t)c; |
| 31 | } |
| 32 | |
| 33 | return s; |
| 34 | } |