/* * Copyright (c) 2018-2020, Andreas Kling * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #ifdef KERNEL # include # include # include #endif #ifdef KERNEL String copy_string_from_user(const char* user_str, size_t user_str_size) { Kernel::SmapDisabler disabler; size_t length = strnlen(user_str, user_str_size); return String(user_str, length); } #endif extern "C" { #ifdef KERNEL void copy_to_user(void* dest_ptr, const void* src_ptr, size_t n) { ASSERT(Kernel::is_user_range(VirtualAddress(dest_ptr), n)); ASSERT(!Kernel::is_user_range(VirtualAddress(src_ptr), n)); Kernel::SmapDisabler disabler; memcpy(dest_ptr, src_ptr, n); } void copy_from_user(void* dest_ptr, const void* src_ptr, size_t n) { ASSERT(Kernel::is_user_range(VirtualAddress(src_ptr), n)); ASSERT(!Kernel::is_user_range(VirtualAddress(dest_ptr), n)); Kernel::SmapDisabler disabler; memcpy(dest_ptr, src_ptr, n); } #endif void* memcpy(void* dest_ptr, const void* src_ptr, size_t n) { size_t dest = (size_t)dest_ptr; size_t src = (size_t)src_ptr; // FIXME: Support starting at an unaligned address. if (!(dest & 0x3) && !(src & 0x3) && n >= 12) { size_t size_ts = n / sizeof(size_t); asm volatile( "rep movsl\n" : "=S"(src), "=D"(dest) : "S"(src), "D"(dest), "c"(size_ts) : "memory"); n -= size_ts * sizeof(size_t); if (n == 0) return dest_ptr; } asm volatile( "rep movsb\n" ::"S"(src), "D"(dest), "c"(n) : "memory"); return dest_ptr; } void* memmove(void* dest, const void* src, size_t n) { if (dest < src) return memcpy(dest, src, n); u8* pd = (u8*)dest; const u8* ps = (const u8*)src; for (pd += n, ps += n; n--;) *--pd = *--ps; return dest; } char* strcpy(char* dest, const char* src) { auto* dest_ptr = dest; auto* src_ptr = src; while ((*dest_ptr++ = *src_ptr++) != '\0') ; return dest; } char* strncpy(char* dest, const char* src, size_t n) { size_t i; for (i = 0; i < n && src[i] != '\0'; ++i) dest[i] = src[i]; for (; i < n; ++i) dest[i] = '\0'; return dest; } #ifdef KERNEL void memset_user(void* dest_ptr, int c, size_t n) { ASSERT(Kernel::is_user_range(VirtualAddress(dest_ptr), n)); Kernel::SmapDisabler disabler; memset(dest_ptr, c, n); } #endif void* memset(void* dest_ptr, int c, size_t n) { size_t dest = (size_t)dest_ptr; // FIXME: Support starting at an unaligned address. if (!(dest & 0x3) && n >= 12) { size_t size_ts = n / sizeof(size_t); size_t expanded_c = (u8)c; expanded_c |= expanded_c << 8; expanded_c |= expanded_c << 16; asm volatile( "rep stosl\n" : "=D"(dest) : "D"(dest), "c"(size_ts), "a"(expanded_c) : "memory"); n -= size_ts * sizeof(size_t); if (n == 0) return dest_ptr; } asm volatile( "rep stosb\n" : "=D"(dest), "=c"(n) : "0"(dest), "1"(n), "a"(c) : "memory"); return dest_ptr; } char* strrchr(const char* str, int ch) { char* last = nullptr; char c; for (; (c = *str); ++str) { if (c == ch) last = const_cast(str); } return last; } size_t strlen(const char* str) { size_t len = 0; while (*(str++)) ++len; return len; } size_t strnlen(const char* str, size_t maxlen) { size_t len = 0; for (; len < maxlen && *str; str++) len++; return len; } int strcmp(const char* s1, const char* s2) { for (; *s1 == *s2; ++s1, ++s2) { if (*s1 == 0) return 0; } return *(const u8*)s1 < *(const u8*)s2 ? -1 : 1; } char* strdup(const char* str) { size_t len = strlen(str); char* new_str = (char*)kmalloc(len + 1); strcpy(new_str, str); return new_str; } int memcmp(const void* v1, const void* v2, size_t n) { auto* s1 = (const u8*)v1; auto* s2 = (const u8*)v2; while (n-- > 0) { if (*s1++ != *s2++) return s1[-1] < s2[-1] ? -1 : 1; } return 0; } int strncmp(const char* s1, const char* s2, size_t n) { if (!n) return 0; do { if (*s1 != *s2++) return *(const unsigned char*)s1 - *(const unsigned char*)--s2; if (*s1++ == 0) break; } while (--n); return 0; } char* strstr(const char* haystack, const char* needle) { char nch; char hch; if ((nch = *needle++) != 0) { size_t len = strlen(needle); do { do { if ((hch = *haystack++) == 0) return nullptr; } while (hch != nch); } while (strncmp(haystack, needle, len) != 0); --haystack; } return const_cast(haystack); } [[noreturn]] void __cxa_pure_virtual() { ASSERT_NOT_REACHED(); } #ifdef KERNEL void* realloc(void* p, size_t s) { return krealloc(p, s); } #endif void free(void* p) { return kfree(p); } [[noreturn]] void __stack_chk_fail() { ASSERT_NOT_REACHED(); } [[noreturn]] void __stack_chk_fail_local() { ASSERT_NOT_REACHED(); } }