source: EcnlProtoTool/trunk/ntshell/src/io_stub.c@ 331

/*
 *  TOPPERS ECHONET Lite Communication Middleware
 * 
 *  Copyright (C) 2017 Cores Co., Ltd. Japan
 * 
 *  上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
 *  (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再配布する場合には，再配布に伴うドキュメント（利用
 *      者マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再配布する場合には，次のいずれかの条件を満たすこ
 *      と．
 *    (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
 *        報告すること．
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
 *      免責すること．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  の責任を負わない．
 * 
 *  @(#) $Id$
 */
#include "shellif.h"
#include <stdint.h>
#include "ff.h"
#include <kernel.h>
#include <t_syslog.h>
#include <t_stdlib.h>
#include <sil.h>
#include <string.h>
#include <setjmp.h>
#include "syssvc/syslog.h"
#include <tinet_config.h>
#include <netinet/in.h>
#include <netinet/in_itron.h>
#include <tinet_nic_defs.h>
#include <tinet_cfg.h>
#include <netinet/in_var.h>
#include <net/ethernet.h>
#include <net/if6_var.h>
#include <net/net.h>
#include <net/if_var.h>
#include <netinet/udp_var.h>
//#include <ethernet_api.h>
#include "socket_stub.h"
//#include <sys/stat.h>
#include "util/ntstdio.h"
#include "usrcmd.h"
#include "core/ntlibc.h"

int fresult2errno(FRESULT res)
{
        switch (res) {
        case FR_INVALID_OBJECT:
                return -EINVAL;
        case FR_TOO_MANY_OPEN_FILES:
                return -ENOMEM;
        case FR_NO_FILE:
        case FR_NO_PATH:
        case FR_INVALID_DRIVE:
        case FR_INVALID_NAME:
                return -ENOENT;
        case FR_DISK_ERR:
        case FR_NO_FILESYSTEM:
        case FR_NOT_ENABLED:
                return -ENODEV;
        case FR_WRITE_PROTECTED:
        case FR_DENIED:
                return -EACCES;
        case FR_EXIST:
                return -EEXIST;
        case FR_INT_ERR:
        default:
                return -EIO;
        }
}

int shell_open(const char * path, int flags, void *arg)
{
        FRESULT res;
        struct _IO_FILE *fp;

        if (flags & O_DIRECTORY) {
                fp = new_dir_fd(0);
                if (fp == NULL)
                        return -ENOMEM;

                DIR *dir = &fp->dir;
                FRESULT res;
                if ((res = f_opendir(dir, path)) != FR_OK) {
                        return fresult2errno(res);
                }
                return 0;
        }

        fp = new_file_fd(0);
        if (fp == NULL)
                return -ENOMEM;

        BYTE fmd = 0;
        switch (flags & O_ACCMODE) {
        case O_RDONLY:
                fmd = FA_READ;
                break;
        case O_WRONLY:
                fmd = FA_WRITE;
                break;
        default:
                fmd = FA_READ | FA_WRITE;
                break;
        }
        /* ファイルを作成 */
        if (flags & O_CREAT) {
                /* 既存の内容は消す */
                if (flags & O_TRUNC) {
                        fmd |= FA_CREATE_ALWAYS;
                }
                /* 新規作成の保障 */
                else if (flags & O_EXCL) {
                        fmd |= FA_CREATE_NEW;
                }
                else {
                        fmd |= FA_OPEN_ALWAYS;
                }
        }
        /* ある場合は開く */
        else {
                /* 既存の内容は消す */
                if (flags & O_TRUNC) {
                        fmd |= FA_CREATE_ALWAYS;
                }
        }

        if ((res = f_open(&fp->file, path, fmd)) == FR_OK) {
                fp->handle = fp->fd;
                return fp->fd;
        }

        return fresult2errno(res);
}

int file_close(struct _IO_FILE *fp)
{
        FRESULT res;

        if ((res = f_close(&fp->file)) == FR_OK) {
                return 0;
        }

        return -EINVAL;
}

size_t file_read(struct _IO_FILE *fp, unsigned char *data, size_t len)
{
        unsigned int ret = 0;
        FRESULT res;

        if ((res = f_read(&fp->file, data, len, &ret)) != FR_OK)
                return -EIO;

        return ret;
}

size_t file_write(struct _IO_FILE *fp, const unsigned char *data, size_t len)
{
        unsigned int ret = 0;
        FRESULT res;

        if ((res = f_write(&fp->file, data, len, &ret)) != FR_OK)
                return -EIO;

        return ret;
}

off_t file_seek(struct _IO_FILE *fp, off_t ptr, int dir)
{
        switch (dir) {
        case SEEK_SET:
                dir = F_SEEK_SET;
                break;
        case SEEK_CUR:
                dir = F_SEEK_CUR;
                break;
        case SEEK_END:
                dir = F_SEEK_END;
                break;
        default:
                return -EINVAL;
        }

        FRESULT res;
        if ((res = f_seek(&fp->file, ptr, dir)) != FR_OK)
                return -EIO;

        return fp->file.fptr;
}

int file_ioctl(struct _IO_FILE *fp, int req, void *arg)
{
        DRESULT res;

        if ((res = disk_ioctl(fp->file.fs->drv, req, arg) != RES_OK))
                return -EINVAL;

        return 0;
}

int shell_close(int fd)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        return fp->close(fp);
}

ssize_t shell_read(int fd, void *data, size_t len)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        return fp->read(fp, (unsigned char *)data, len);
}

int shell_readv(int fd, const struct iovec *iov, int iovcnt)
{
        int result = 0;
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        const struct iovec *end = &iov[iovcnt];
        for (; iov < end; iov++) {
                result += fp->read(fp, (unsigned char *)iov->iov_base, iov->iov_len);
        }

        return result;
}

ssize_t shell_write(int fd, const void *data, size_t len)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        return fp->write(fp, (unsigned char *)data, len);
}

int shell_writev(int fd, const struct iovec *iov, int iovcnt)
{
        int result = 0;
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        const struct iovec *end = &iov[iovcnt];
        for (; iov < end; iov++) {
                result += fp->write(fp, (unsigned char *)iov->iov_base, iov->iov_len);
        }

        return result;
}

int shell_llseek(int fd, off_t ptr, off_t *result, int dir)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        off_t ret = fp->seek(fp, ptr, dir);
        if (ret < 0)
                return ret;

        *result = ret;
        return 0;
}

int shell_fstat(int fd, struct stat * st)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        memset(st, 0, sizeof(*st));
        st->st_mode = S_IFCHR;
        //st->st_blksize = 1024;
        return 0;
}

int shell_fsync(int fd)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;
        return -EIO;
}

int shell_ftruncate(int fd, off_t length)
{
        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        FRESULT res;
        if ((res = f_truncate(&fp->file)) != FR_OK)
                return fresult2errno(res);

        return 0;
}

int shell_fcntl(int fd, int cmd, void *arg)
{
        return shell_ioctl(fd, cmd, arg);
}

int sio_tcgetattr(int fd, struct termios *termios)
{
        extern ntstdio_t ntstdio;

        if (fd == STDIN_FILENO) {
                memset(termios, 0, sizeof(*termios));

                if (ntstdio.option & NTSTDIO_OPTION_LINE_ECHO) {
                        termios->c_lflag |= ECHO;
                }
                else {
                        termios->c_lflag &= ~ECHO;
                }
                if (ntstdio.option & NTSTDIO_OPTION_CANON) {
                        termios->c_lflag |= ICANON;
                }
                else {
                        termios->c_lflag &= ~ICANON;
                }
                if (ntstdio.option & NTSTDIO_OPTION_LF_CR) {
                        termios->c_iflag |= INLCR;
                }
                else {
                        termios->c_iflag &= ~INLCR;
                }
                if (ntstdio.option & NTSTDIO_OPTION_LF_CRLF) {
                        termios->c_oflag |= ONLCR;
                }
                else {
                        termios->c_oflag &= ~ONLCR;
                }
                return 0;
        }
        shell_abort();
        return 0;
}

int sio_tcsetattr(int fd, int optional_actions, const struct termios *termios)
{
        extern ntstdio_t ntstdio;

        if ((fd == STDIN_FILENO) && (optional_actions == TCSANOW)) {
                if (termios->c_lflag & ECHO) {
                        ntstdio.option |= NTSTDIO_OPTION_LINE_ECHO;
                }
                else {
                        ntstdio.option &= ~NTSTDIO_OPTION_LINE_ECHO;
                }
                if (termios->c_lflag & ICANON) {
                        ntstdio.option |= NTSTDIO_OPTION_CANON;
                }
                else {
                        ntstdio.option &= ~NTSTDIO_OPTION_CANON;
                }
                if (termios->c_iflag & INLCR) {
                        ntstdio.option |= NTSTDIO_OPTION_LF_CR;
                }
                else{
                        ntstdio.option &= ~NTSTDIO_OPTION_LF_CR;
                }
                if (termios->c_oflag & ONLCR) {
                        ntstdio.option |= NTSTDIO_OPTION_LF_CRLF;
                }
                else {
                        ntstdio.option &= ~NTSTDIO_OPTION_LF_CRLF;
                }
                return 0;
        }
        shell_abort();
        return 0;
}

int shell_stat(const char *__restrict path, struct stat *__restrict st)
{
        FILINFO fi;
        FRESULT ret;
#if _USE_LFN
        static char lfn[_MAX_LFN + 1];   /* Buffer to store the LFN */
        fi.lfname = lfn;
        fi.lfsize = sizeof lfn;
#endif
        if (ntlibc_strcmp(path, ".") == 0) {
                char cwd[_MAX_LFN];
                if ((ret = f_getcwd(cwd, sizeof(cwd))) != FR_OK) {
                        return fresult2errno(ret);
                }
                int l = ntlibc_strlen(cwd);
                // ルートディレクトリの場合
                if (cwd[l - 2] == ':' && cwd[l - 1] == '/') {
                        st->st_size = 0;
                        st->st_mtim.tv_nsec = 0;
                        st->st_mtim.tv_sec = 0;
                        st->st_mode = S_IFDIR;
                        return 0;
                }
                if ((ret = f_stat(cwd, &fi)) != FR_OK) {
                        return fresult2errno(ret);
                }
        }
        else if ((ret = f_stat(path, &fi)) != FR_OK) {
                return fresult2errno(ret);
        }

        st->st_size = fi.fsize;
        st->st_mtim.tv_nsec = 0;
        st->st_mtim.tv_sec = fi.fdate + fi.ftime;
        st->st_mode  = (S_IRUSR | S_IRGRP | S_IROTH);
        st->st_mode |= (fi.fattrib & AM_RDO) ? 0 : (S_IWUSR | S_IWGRP | S_IWOTH);
        st->st_mode |= (fi.fattrib & (AM_DIR | AM_VOL)) ? S_IFDIR : S_IFREG;

        return 0;
}

int shell_lstat(const char *__restrict path, struct stat *__restrict st)
{
        return shell_stat(path, st);
}

int shell_link(const char *a, const char *b)
{
        return -EPERM;
}

int shell_unlink(const char *path)
{
        FRESULT res;

        if ((res = f_unlink(path)) != FR_OK)
                return -EIO;

        return 0;
}

int shell_rmdir(const char *path)
{
        FRESULT res;

        if ((res = f_unlink(path)) != FR_OK)
                return -EIO;

        return 0;
}

int shell_rename(const char *oldpath, const char *newpath)
{
        FRESULT res;

        if ((res = f_rename(oldpath, newpath)) != FR_OK)
                return fresult2errno(res);
        return 0;
}

#define S_IREAD S_IRUSR
#define S_IWRITE S_IWUSR

int shell_mkdir(const char *path, mode_t mode)
{
        FRESULT res;

        if ((res = f_mkdir(path)) != FR_OK)
                return fresult2errno(res);

        BYTE attr = 0;
        BYTE mask = AM_RDO | AM_SYS; // AM_ARC, AM_HID

        if(mode & S_IREAD) {
                if((mode & S_IWRITE) == 0) {
                        attr |= AM_RDO;
                }
        }
        else {
                attr |= AM_SYS;
        }

        if((res = f_chmod(path, attr, mask)) != FR_OK) {
                return fresult2errno(res);
        }

        return 0;
}

int shell_chmod(const char *path, mode_t mode)
{
        FRESULT res;
        BYTE attr = 0;
        BYTE mask = AM_RDO | AM_SYS; // AM_ARC, AM_HID

        if(mode & S_IREAD) {
                if((mode & S_IWRITE) == 0) {
                        attr |= AM_RDO;
                }
        }
        else {
                attr |= AM_SYS;
        }

        if((res = f_chmod(path, attr, mask)) != FR_OK) {
                return fresult2errno(res);
        }

        return 0;
}

char *shell_getcwd(char *buf, size_t size)
{
        FRESULT ret;
        if((ret = f_getcwd(buf, size)) != FR_OK) {
                return NULL;
        }

        return buf;
}

int shell_chdir(const char *path)
{
        FRESULT res;
        if ((res = f_chdir(path)) != FR_OK) {
                return fresult2errno(res);
        }

        return 0;
}

int shell_chroot(const char *path)
{
        shell_abort();
        return -EPERM;
}

int dir_close(struct _IO_FILE *fp)
{
        FRESULT res;
        if ((res = f_closedir(&fp->dir)) != FR_OK) {
                return fresult2errno(res);
        }

        return 0;
}

int shell_getdents(int fd, struct dirent *de, size_t len)
{
        if (len < sizeof(struct dirent))
                return -EINVAL;

        struct _IO_FILE *fp = fd_to_fp(fd);
        if (fp == NULL)
                return -EBADF;

        FILINFO fno;
#if _USE_LFN
        static char lfn[_MAX_LFN + 1];   /* Buffer to store the LFN */
        fno.lfname = lfn;
        fno.lfsize = sizeof lfn;
#endif
        FRESULT res;
        if ((res = f_readdir(&fp->dir, &fno)) != FR_OK || fno.fname[0] == '\0') {
                return fresult2errno(res);
        }

        memset(de, 0, sizeof(*de));
#if _USE_LFN
        ntlibc_strlcpy(de->d_name, *fno.lfname ? fno.lfname : fno.fname, sizeof(de->d_name));
#else
        ntlibc_strlcpy(de->d_name, fno.fname, sizeof(de->d_name));
#endif

        return 0;
}

size_t dir_read(struct _IO_FILE *fp, unsigned char *data, size_t len)
{
        return -EPERM;
}

size_t dir_write(struct _IO_FILE *fp, const unsigned char *data, size_t len)
{
        return -EPERM;
}

off_t dir_seek(struct _IO_FILE *fp, off_t ptr, int dir)
{
        FRESULT res;

        if (dir != SEEK_SET)
                return -EINVAL;

        if (ptr == 0) {
                if ((res = f_rewinddir(&fp->dir)) != FR_OK) {
                        return fresult2errno(res);
                }
        }
        else {
                FILINFO fno;
#if _USE_LFN
                static char lfn[_MAX_LFN + 1];   /* Buffer to store the LFN */
                fno.lfname = lfn;
                fno.lfsize = sizeof lfn;
#endif
                if ((res = f_rewinddir(&fp->dir)) != FR_OK) {
                        return fresult2errno(res);
                }

                for (int i = 0; i < ptr; i++) {
                        if ((res = f_readdir(&fp->dir, &fno)) != FR_OK || fno.fname[0] == '\0') {
                                return fresult2errno(res);
                        }
                }
        }

        return ptr;
}

int dir_ioctl(struct _IO_FILE *fp, int req, void *arg)
{
        return -EINVAL;
}

pid_t shell_getpid(void)
{
        return 1;
}

int shell_access(const char *path, int mode)
{
        struct stat st;
        int ret;

        ret = shell_stat(path, &st);
        if (ret != 0)
                return ret;

        return 0;
}

//#include "../musl-1.1.18/include/bits/limits.h"
#define PAGE_SIZE 4096

uint32_t  __CmdBase;
uint32_t  __CmdLimit;

void *shell_brk(void *addr)
{
        if (addr == 0) {
                return (void *)((intptr_t)&__CmdBase + 0x20000);
        }
        if ((addr >= (intptr_t)&__CmdBase + 0x20000) && (addr < &__CmdLimit)) {
                return addr;
        }
        return (void *)-1;
}

void *shell_mmap2(void *start, size_t length, int prot, int flags, int fd, off_t pgoffset)
{
        if (fd != -1)
                return -EINVAL;

        if ((length >= 0) && (length <= (intptr_t)&__CmdLimit - (intptr_t)&__CmdBase - 0x20000)) {
                return &__CmdBase + 0x20000;
        }
        return (void *)-1;
}

int shell_mprotect(void *addr, size_t len, int prot)
{
        //if ((addr >= (intptr_t)&__CmdBase + 0x20000) && ((intptr_t)addr + len < &__CmdLimit)) {
                return 0;
        //}
        //return -1;
}