1 /* stdout_console.c */ 2 3 /* 4 * Copyright (c) 2014 Wind River Systems, Inc. 5 * 6 * SPDX-License-Identifier: Apache-2.0 7 */ 8 9 #include <stdio.h> 10 #include <zephyr/sys/libc-hooks.h> 11 #include <zephyr/internal/syscall_handler.h> 12 #include <string.h> 13 _stdout_hook_default(int c)14 static int _stdout_hook_default(int c) 15 { 16 (void)(c); /* Prevent warning about unused argument */ 17 18 return EOF; 19 } 20 21 static int (*_stdout_hook)(int c) = _stdout_hook_default; 22 __stdout_hook_install(int (* hook)(int c))23 void __stdout_hook_install(int (*hook)(int c)) 24 { 25 _stdout_hook = hook; 26 } 27 z_impl_zephyr_fputc(int c,FILE * stream)28 int z_impl_zephyr_fputc(int c, FILE *stream) 29 { 30 return ((stream == stdout) || (stream == stderr)) ? _stdout_hook(c) : EOF; 31 } 32 33 #ifdef CONFIG_USERSPACE z_vrfy_zephyr_fputc(int c,FILE * stream)34 static inline int z_vrfy_zephyr_fputc(int c, FILE *stream) 35 { 36 return z_impl_zephyr_fputc(c, stream); 37 } 38 #include <zephyr/syscalls/zephyr_fputc_mrsh.c> 39 #endif 40 fputc(int c,FILE * stream)41 int fputc(int c, FILE *stream) 42 { 43 return zephyr_fputc(c, stream); 44 } 45 fputs(const char * ZRESTRICT s,FILE * ZRESTRICT stream)46 int fputs(const char *ZRESTRICT s, FILE *ZRESTRICT stream) 47 { 48 int len = strlen(s); 49 int ret; 50 51 ret = fwrite(s, 1, len, stream); 52 53 return (len == ret) ? 0 : EOF; 54 } 55 56 #undef putc putc(int c,FILE * stream)57 int putc(int c, FILE *stream) 58 { 59 return zephyr_fputc(c, stream); 60 } 61 62 #undef putchar putchar(int c)63 int putchar(int c) 64 { 65 return zephyr_fputc(c, stdout); 66 } 67 z_impl_zephyr_fwrite(const void * ZRESTRICT ptr,size_t size,size_t nitems,FILE * ZRESTRICT stream)68 size_t z_impl_zephyr_fwrite(const void *ZRESTRICT ptr, size_t size, 69 size_t nitems, FILE *ZRESTRICT stream) 70 { 71 size_t i; 72 size_t j; 73 const unsigned char *p; 74 75 if (((stream != stdout) && (stream != stderr)) || 76 (nitems == 0) || (size == 0)) { 77 return 0; 78 } 79 80 p = ptr; 81 i = nitems; 82 do { 83 j = size; 84 do { 85 if (_stdout_hook((int) *p++) == EOF) { 86 goto done; 87 } 88 j--; 89 } while (j > 0); 90 91 i--; 92 } while (i > 0); 93 94 done: 95 return (nitems - i); 96 } 97 98 #ifdef CONFIG_USERSPACE z_vrfy_zephyr_fwrite(const void * ZRESTRICT ptr,size_t size,size_t nitems,FILE * ZRESTRICT stream)99 static inline size_t z_vrfy_zephyr_fwrite(const void *ZRESTRICT ptr, 100 size_t size, size_t nitems, 101 FILE *ZRESTRICT stream) 102 { 103 104 K_OOPS(K_SYSCALL_MEMORY_ARRAY_READ(ptr, nitems, size)); 105 return z_impl_zephyr_fwrite(ptr, size, nitems, stream); 106 } 107 #include <zephyr/syscalls/zephyr_fwrite_mrsh.c> 108 #endif 109 fwrite(const void * ZRESTRICT ptr,size_t size,size_t nitems,FILE * ZRESTRICT stream)110 size_t fwrite(const void *ZRESTRICT ptr, size_t size, size_t nitems, 111 FILE *ZRESTRICT stream) 112 { 113 return zephyr_fwrite(ptr, size, nitems, stream); 114 } 115 116 puts(const char * s)117 int puts(const char *s) 118 { 119 if (fputs(s, stdout) == EOF) { 120 return EOF; 121 } 122 123 return (fputc('\n', stdout) == EOF) ? EOF : 0; 124 } 125
