blob: 6d88d2f9db5601a674655d484541350e7f29aef2 [file] [log] [blame]
Summer Qinf24dbb52020-07-23 14:53:54 +08001/*
Ken Liu8fb61f12021-12-14 08:32:10 +08002 * Copyright (c) 2020-2022, Arm Limited. All rights reserved.
Summer Qinf24dbb52020-07-23 14:53:54 +08003 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 *
6 */
7
8#include "crt_impl_private.h"
9
10void *memset(void *s, int c, size_t n)
11{
Ken Liu8fb61f12021-12-14 08:32:10 +080012 union composite_addr_t p_mem;
13 uint32_t pattern_word;
Summer Qinf24dbb52020-07-23 14:53:54 +080014
15 p_mem.p_byte = (uint8_t *)s;
Ken Liu8fb61f12021-12-14 08:32:10 +080016 pattern_word = (((uint8_t)c) << 24) | (((uint8_t)c) << 16) |
Summer Qinf24dbb52020-07-23 14:53:54 +080017 (((uint8_t)c) << 8) | ((uint8_t)c);
18
Ken Liu8fb61f12021-12-14 08:32:10 +080019 while (n && ADDR_WORD_UNALIGNED(p_mem.uint_addr)) {
Summer Qinf24dbb52020-07-23 14:53:54 +080020 *p_mem.p_byte++ = (uint8_t)c;
21 n--;
22 }
23
24 while (n >= sizeof(uint32_t)) {
Ken Liu8fb61f12021-12-14 08:32:10 +080025 *p_mem.p_word++ = pattern_word;
Summer Qinf24dbb52020-07-23 14:53:54 +080026 n -= sizeof(uint32_t);
27 }
28
29 while (n--) {
30 *p_mem.p_byte++ = (uint8_t)c;
31 }
32
33 return s;
34}