libc.c 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221
  1. /*
  2. * Copyright (c) 2006-2023, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2017/10/15 bernard the first version
  9. */
  10. #include <rtthread.h>
  11. #include <stdio.h>
  12. #include <stdlib.h>
  13. #include <string.h>
  14. #include <unistd.h>
  15. #include <fcntl.h>
  16. #include <sys/time.h>
  17. #include <sys/errno.h>
  18. #include "libc.h"
  19. #define STDIO_DEVICE_NAME_MAX 32
  20. int sys_dup2(int oldfd, int new);
  21. int libc_system_init(void)
  22. {
  23. #ifdef RT_USING_POSIX_STDIO
  24. rt_device_t dev_console;
  25. dev_console = rt_console_get_device();
  26. if (dev_console)
  27. {
  28. int fd = libc_stdio_set_console(dev_console->parent.name, O_RDWR);
  29. if (fd < 0)
  30. {
  31. return -1;
  32. }
  33. /* set fd (0, 1, 2) */
  34. sys_dup2(fd, 0);
  35. sys_dup2(fd, 1);
  36. sys_dup2(fd, 2);
  37. }
  38. #endif /* RT_USING_POSIX_STDIO */
  39. return 0;
  40. }
  41. INIT_APP_EXPORT(libc_system_init);
  42. #if defined(RT_USING_POSIX_STDIO) && defined(RT_USING_NEWLIBC)
  43. static FILE* std_console = NULL;
  44. int libc_stdio_set_console(const char* device_name, int mode)
  45. {
  46. FILE *fp;
  47. char name[STDIO_DEVICE_NAME_MAX];
  48. char *file_mode;
  49. rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
  50. name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
  51. if (mode == O_RDWR)
  52. {
  53. file_mode = "r+";
  54. }
  55. else if (mode == O_WRONLY)
  56. {
  57. file_mode = "wb";
  58. }
  59. else
  60. {
  61. file_mode = "rb";
  62. }
  63. fp = fopen(name, file_mode);
  64. if (fp)
  65. {
  66. setvbuf(fp, NULL, _IONBF, 0);
  67. if (std_console)
  68. {
  69. fclose(std_console);
  70. std_console = NULL;
  71. }
  72. std_console = fp;
  73. if (mode == O_RDWR)
  74. {
  75. _GLOBAL_REENT->_stdin = std_console;
  76. }
  77. else
  78. {
  79. _GLOBAL_REENT->_stdin = NULL;
  80. }
  81. if (mode == O_RDONLY)
  82. {
  83. _GLOBAL_REENT->_stdout = NULL;
  84. _GLOBAL_REENT->_stderr = NULL;
  85. }
  86. else
  87. {
  88. _GLOBAL_REENT->_stdout = std_console;
  89. _GLOBAL_REENT->_stderr = std_console;
  90. }
  91. _GLOBAL_REENT->__sdidinit = 1;
  92. }
  93. if (std_console)
  94. return fileno(std_console);
  95. return -1;
  96. }
  97. int libc_stdio_get_console(void)
  98. {
  99. if (std_console)
  100. return fileno(std_console);
  101. else
  102. return -1;
  103. }
  104. #elif defined(RT_USING_POSIX_STDIO) && defined(RT_USING_MUSLLIBC)
  105. static FILE* std_console = NULL;
  106. int libc_stdio_set_console(const char* device_name, int mode)
  107. {
  108. FILE *fp;
  109. char name[STDIO_DEVICE_NAME_MAX];
  110. char *file_mode;
  111. rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
  112. name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
  113. if (mode == O_RDWR) file_mode = "r+";
  114. else if (mode == O_WRONLY) file_mode = "wb";
  115. else file_mode = "rb";
  116. fp = fopen(name, file_mode);
  117. if (fp)
  118. {
  119. setvbuf(fp, NULL, _IONBF, 0);
  120. if (std_console)
  121. {
  122. fclose(std_console);
  123. std_console = NULL;
  124. }
  125. std_console = fp;
  126. }
  127. if (std_console)
  128. {
  129. int fd = fileno(std_console);
  130. return fd;
  131. }
  132. return -1;
  133. }
  134. int libc_stdio_get_console(void)
  135. {
  136. int ret = -1;
  137. if (std_console)
  138. {
  139. ret = fileno(std_console);
  140. }
  141. return ret;
  142. }
  143. #elif defined(RT_USING_POSIX_STDIO)
  144. static int std_fd = -1;
  145. int libc_stdio_set_console(const char* device_name, int mode)
  146. {
  147. int fd;
  148. char name[STDIO_DEVICE_NAME_MAX];
  149. rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
  150. name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
  151. fd = open(name, mode, 0);
  152. if (fd >= 0)
  153. {
  154. if (std_fd >= 0)
  155. {
  156. close(std_fd);
  157. }
  158. std_fd = fd;
  159. }
  160. return std_fd;
  161. }
  162. int libc_stdio_get_console(void) {
  163. return std_fd;
  164. }
  165. #endif /* defined(RT_USING_POSIX_STDIO) && defined(RT_USING_NEWLIBC) */
  166. int isatty(int fd)
  167. {
  168. #if defined(RT_USING_CONSOLE) && defined(RT_USING_DEVICE)
  169. if(fd == STDOUT_FILENO || fd == STDERR_FILENO)
  170. {
  171. return 1;
  172. }
  173. #endif
  174. #ifdef RT_USING_POSIX_STDIO
  175. if(fd == STDIN_FILENO)
  176. {
  177. return 1;
  178. }
  179. #endif
  180. rt_set_errno(ENOTTY);
  181. return 0;
  182. }
  183. RTM_EXPORT(isatty);