2017-10-15 22:41:59 +08:00
|
|
|
/*
|
2023-06-10 21:35:25 +08:00
|
|
|
* Copyright (c) 2006-2023, RT-Thread Development Team
|
2017-10-15 22:41:59 +08:00
|
|
|
*
|
2018-10-14 19:28:18 +08:00
|
|
|
* SPDX-License-Identifier: Apache-2.0
|
2017-10-15 22:41:59 +08:00
|
|
|
*
|
|
|
|
* Change Logs:
|
|
|
|
* Date Author Notes
|
|
|
|
* 2017/10/15 bernard the first version
|
2023-08-08 01:46:34 +08:00
|
|
|
* 2023/08/07 Meco Man rename as posix/stdio.c
|
2017-10-15 22:41:59 +08:00
|
|
|
*/
|
2022-01-08 23:29:41 +08:00
|
|
|
|
2021-10-28 14:48:51 +08:00
|
|
|
#include <rtthread.h>
|
2017-10-15 22:41:59 +08:00
|
|
|
#include <stdio.h>
|
2021-10-28 02:42:25 +08:00
|
|
|
#include <stdlib.h>
|
2021-10-28 14:48:51 +08:00
|
|
|
#include <string.h>
|
|
|
|
#include <unistd.h>
|
2023-08-08 01:46:34 +08:00
|
|
|
#include <limits.h>
|
2021-09-11 11:07:51 +08:00
|
|
|
#include <fcntl.h>
|
2021-10-28 14:48:51 +08:00
|
|
|
#include <sys/time.h>
|
2022-01-24 09:16:57 +08:00
|
|
|
#include <sys/errno.h>
|
2023-08-08 01:46:34 +08:00
|
|
|
#include "posix/stdio.h"
|
2021-10-28 14:48:51 +08:00
|
|
|
|
2022-11-23 10:40:50 +08:00
|
|
|
#define STDIO_DEVICE_NAME_MAX 32
|
|
|
|
|
2022-12-03 12:07:44 +08:00
|
|
|
int sys_dup2(int oldfd, int new);
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_init(void)
|
2021-10-28 14:48:51 +08:00
|
|
|
{
|
|
|
|
rt_device_t dev_console;
|
|
|
|
|
|
|
|
dev_console = rt_console_get_device();
|
|
|
|
if (dev_console)
|
|
|
|
{
|
2023-08-08 01:46:34 +08:00
|
|
|
int fd = rt_posix_stdio_set_console(dev_console->parent.name, O_RDWR);
|
2023-08-08 00:22:14 +08:00
|
|
|
if (fd < 0)
|
2022-12-03 12:07:44 +08:00
|
|
|
{
|
|
|
|
return -1;
|
|
|
|
}
|
2023-08-08 00:22:14 +08:00
|
|
|
/* set fd (0, 1, 2) */
|
|
|
|
sys_dup2(fd, 0);
|
|
|
|
sys_dup2(fd, 1);
|
|
|
|
sys_dup2(fd, 2);
|
2021-10-28 14:48:51 +08:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
2023-08-08 01:46:34 +08:00
|
|
|
INIT_ENV_EXPORT(rt_posix_stdio_init);
|
2021-10-28 14:48:51 +08:00
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
#if defined(RT_USING_NEWLIBC)
|
2022-11-23 10:40:50 +08:00
|
|
|
|
2023-08-17 07:47:41 +08:00
|
|
|
#define NEWLIB_VERSION_NUM (__NEWLIB__ * 10000U + __NEWLIB_MINOR__ * 100U + __NEWLIB_PATCHLEVEL__)
|
|
|
|
|
2017-10-15 22:41:59 +08:00
|
|
|
static FILE* std_console = NULL;
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_set_console(const char* device_name, int mode)
|
2017-10-15 22:41:59 +08:00
|
|
|
{
|
|
|
|
FILE *fp;
|
|
|
|
char name[STDIO_DEVICE_NAME_MAX];
|
|
|
|
char *file_mode;
|
|
|
|
|
2022-11-23 10:40:50 +08:00
|
|
|
rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
|
2017-10-15 22:41:59 +08:00
|
|
|
name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
|
|
|
|
|
2021-10-27 14:52:04 +08:00
|
|
|
if (mode == O_RDWR)
|
|
|
|
{
|
|
|
|
file_mode = "r+";
|
|
|
|
}
|
|
|
|
else if (mode == O_WRONLY)
|
|
|
|
{
|
|
|
|
file_mode = "wb";
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
file_mode = "rb";
|
|
|
|
}
|
2017-10-15 22:41:59 +08:00
|
|
|
|
|
|
|
fp = fopen(name, file_mode);
|
|
|
|
if (fp)
|
|
|
|
{
|
|
|
|
setvbuf(fp, NULL, _IONBF, 0);
|
|
|
|
|
|
|
|
if (std_console)
|
|
|
|
{
|
|
|
|
fclose(std_console);
|
|
|
|
std_console = NULL;
|
|
|
|
}
|
|
|
|
std_console = fp;
|
|
|
|
|
|
|
|
if (mode == O_RDWR)
|
|
|
|
{
|
|
|
|
_GLOBAL_REENT->_stdin = std_console;
|
|
|
|
}
|
2021-03-08 18:19:04 +08:00
|
|
|
else
|
2017-10-15 22:41:59 +08:00
|
|
|
{
|
|
|
|
_GLOBAL_REENT->_stdin = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mode == O_RDONLY)
|
|
|
|
{
|
|
|
|
_GLOBAL_REENT->_stdout = NULL;
|
|
|
|
_GLOBAL_REENT->_stderr = NULL;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
_GLOBAL_REENT->_stdout = std_console;
|
|
|
|
_GLOBAL_REENT->_stderr = std_console;
|
|
|
|
}
|
|
|
|
|
2023-08-17 07:47:41 +08:00
|
|
|
#if (NEWLIB_VERSION_NUM < 30400U) || (NEWLIB_VERSION_NUM >= 40000U && NEWLIB_VERSION_NUM < 40300U)
|
|
|
|
_GLOBAL_REENT->__sdidinit = 1; /* __sdidinit is obselete */
|
|
|
|
#endif
|
2017-10-15 22:41:59 +08:00
|
|
|
}
|
|
|
|
|
2021-10-28 02:42:25 +08:00
|
|
|
if (std_console)
|
|
|
|
return fileno(std_console);
|
2018-02-11 13:57:51 +08:00
|
|
|
|
|
|
|
return -1;
|
2017-10-15 22:41:59 +08:00
|
|
|
}
|
2018-01-12 16:55:47 +08:00
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_get_console(void)
|
2021-10-14 00:57:32 +08:00
|
|
|
{
|
2018-01-12 16:55:47 +08:00
|
|
|
if (std_console)
|
|
|
|
return fileno(std_console);
|
|
|
|
else
|
|
|
|
return -1;
|
|
|
|
}
|
2021-10-26 12:51:32 +08:00
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
#elif defined(RT_USING_MUSLLIBC)
|
2022-11-23 10:40:50 +08:00
|
|
|
|
|
|
|
static FILE* std_console = NULL;
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_set_console(const char* device_name, int mode)
|
2022-11-23 10:40:50 +08:00
|
|
|
{
|
|
|
|
FILE *fp;
|
|
|
|
char name[STDIO_DEVICE_NAME_MAX];
|
|
|
|
char *file_mode;
|
|
|
|
|
|
|
|
rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
|
|
|
|
name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
|
|
|
|
|
|
|
|
if (mode == O_RDWR) file_mode = "r+";
|
|
|
|
else if (mode == O_WRONLY) file_mode = "wb";
|
|
|
|
else file_mode = "rb";
|
|
|
|
|
|
|
|
fp = fopen(name, file_mode);
|
|
|
|
if (fp)
|
|
|
|
{
|
|
|
|
setvbuf(fp, NULL, _IONBF, 0);
|
|
|
|
|
|
|
|
if (std_console)
|
|
|
|
{
|
|
|
|
fclose(std_console);
|
|
|
|
std_console = NULL;
|
|
|
|
}
|
|
|
|
std_console = fp;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (std_console)
|
|
|
|
{
|
|
|
|
int fd = fileno(std_console);
|
|
|
|
|
|
|
|
return fd;
|
|
|
|
}
|
|
|
|
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_get_console(void)
|
2022-11-23 10:40:50 +08:00
|
|
|
{
|
|
|
|
int ret = -1;
|
|
|
|
if (std_console)
|
|
|
|
{
|
|
|
|
ret = fileno(std_console);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
#else
|
2022-11-23 10:40:50 +08:00
|
|
|
|
2021-10-28 14:48:51 +08:00
|
|
|
static int std_fd = -1;
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_set_console(const char* device_name, int mode)
|
2021-10-28 14:48:51 +08:00
|
|
|
{
|
|
|
|
int fd;
|
|
|
|
char name[STDIO_DEVICE_NAME_MAX];
|
|
|
|
|
2022-11-23 10:40:50 +08:00
|
|
|
rt_snprintf(name, sizeof(name) - 1, "/dev/%s", device_name);
|
2021-10-28 14:48:51 +08:00
|
|
|
name[STDIO_DEVICE_NAME_MAX - 1] = '\0';
|
|
|
|
|
|
|
|
fd = open(name, mode, 0);
|
|
|
|
if (fd >= 0)
|
|
|
|
{
|
|
|
|
if (std_fd >= 0)
|
|
|
|
{
|
|
|
|
close(std_fd);
|
|
|
|
}
|
|
|
|
std_fd = fd;
|
|
|
|
}
|
|
|
|
|
|
|
|
return std_fd;
|
|
|
|
}
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
int rt_posix_stdio_get_console(void) {
|
2021-10-28 14:48:51 +08:00
|
|
|
return std_fd;
|
|
|
|
}
|
2023-08-08 01:46:34 +08:00
|
|
|
#endif /* defined(RT_USING_NEWLIBC) */
|
2022-01-24 09:16:57 +08:00
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
ssize_t getdelim(char **lineptr, size_t *n, int delim, FILE *stream)
|
2022-01-24 09:16:57 +08:00
|
|
|
{
|
2023-08-08 01:46:34 +08:00
|
|
|
char *cur_pos, *new_lineptr;
|
|
|
|
size_t new_lineptr_len;
|
|
|
|
int c;
|
|
|
|
|
|
|
|
if (lineptr == NULL || n == NULL || stream == NULL)
|
2022-01-24 09:16:57 +08:00
|
|
|
{
|
2023-08-08 01:46:34 +08:00
|
|
|
errno = EINVAL;
|
|
|
|
return -1;
|
2022-01-24 09:16:57 +08:00
|
|
|
}
|
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
if (*lineptr == NULL)
|
2022-01-24 09:16:57 +08:00
|
|
|
{
|
2023-08-08 01:46:34 +08:00
|
|
|
*n = 128; /* init len */
|
|
|
|
if ((*lineptr = (char *)malloc(*n)) == NULL)
|
|
|
|
{
|
|
|
|
errno = ENOMEM;
|
|
|
|
return -1;
|
|
|
|
}
|
2022-01-24 09:16:57 +08:00
|
|
|
}
|
2023-08-08 01:46:34 +08:00
|
|
|
|
|
|
|
cur_pos = *lineptr;
|
|
|
|
for (;;)
|
|
|
|
{
|
|
|
|
c = getc(stream);
|
|
|
|
|
|
|
|
if (ferror(stream) || (c == EOF && cur_pos == *lineptr))
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
if (c == EOF)
|
|
|
|
break;
|
|
|
|
|
|
|
|
if ((*lineptr + *n - cur_pos) < 2)
|
|
|
|
{
|
|
|
|
if (LONG_MAX / 2 < *n)
|
|
|
|
{
|
|
|
|
#ifdef EOVERFLOW
|
|
|
|
errno = EOVERFLOW;
|
|
|
|
#else
|
|
|
|
errno = ERANGE; /* no EOVERFLOW defined */
|
2022-01-24 09:16:57 +08:00
|
|
|
#endif
|
2023-08-08 01:46:34 +08:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
new_lineptr_len = *n * 2;
|
|
|
|
|
|
|
|
if ((new_lineptr = (char *)realloc(*lineptr, new_lineptr_len)) == NULL)
|
|
|
|
{
|
|
|
|
errno = ENOMEM;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
cur_pos = new_lineptr + (cur_pos - *lineptr);
|
|
|
|
*lineptr = new_lineptr;
|
|
|
|
*n = new_lineptr_len;
|
|
|
|
}
|
2022-01-24 09:16:57 +08:00
|
|
|
|
2023-08-08 01:46:34 +08:00
|
|
|
*cur_pos++ = (char)c;
|
|
|
|
|
|
|
|
if (c == delim)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
*cur_pos = '\0';
|
|
|
|
return (ssize_t)(cur_pos - *lineptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
ssize_t getline(char **lineptr, size_t *n, FILE *stream)
|
|
|
|
{
|
|
|
|
return getdelim(lineptr, n, '\n', stream);
|
2022-01-24 09:16:57 +08:00
|
|
|
}
|