source: azure_iot_hub/trunk/ntshell/src/ntshell_main.c@ 388

/*
 *  TOPPERS ECHONET Lite Communication Middleware
 * 
 *  Copyright (C) 2014-2017 Cores Co., Ltd. Japan
 * 
 *  上記著作権者
は，以下の(1)～(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id: ntshell_main.c 388 2019-05-22 11:25:18Z coas-nagasima $
 */

/* 
 *  サンプルプログラム(1)の本体
 */

#include "shellif.h"
#include <kernel.h>
#include <t_stdlib.h>
#include <sil.h>
#include <setjmp.h>
#include <string.h>
#include "syssvc/serial.h"
#include "syssvc/syslog.h"
#include "target_syssvc.h"
#include "target_serial.h"
#include "kernel_cfg.h"
#include "ffarch.h"
#include "ff.h"
#include "core/ntshell.h"
#include "core/ntlibc.h"
#include "util/ntstdio.h"
#include "usrcmd.h"
#include "util/ntopt.h"
#include "ntshell_main.h"
#include "fdtable.h"

char command[NTOPT_TEXT_MAXLEN];

extern uint8_t mac_addr[6];
const struct utsname host_name = {
        "TOPPERS/ASP3",
        TARGET_NAME,
        "3.2.0",
        "3.2.0",
        TARGET_NAME,
        "toppers.jp"
};

int shell_uname(struct utsname *uts)
{
        memcpy(uts, &host_name, sizeof(host_name));
        return 0;
}

void stdio_open(ID portid);
static int usrcmd_ntopt_callback(long *args, void *extobj);

int ntshell_exit_code;
volatile int ntshell_state;
jmp_buf process_exit;

void ntshell_task_init(ID portid)
{
        stdio_open(portid);
}

/*
 *  ntshellタスク
 */
void ntshell_task(intptr_t exinf)
{
        ntshell_state = 1;

        if (setjmp(process_exit) == 0) {
                ntshell_exit_code = ntopt_parse(command, usrcmd_ntopt_callback, NULL);
        }

        fflush(stdout);
        clean_fd();

        ntshell_state = 2;
}

void ntshell_change_netif_link(uint8_t link_up, uint8_t up)
{
        FLGPTN flgptn;
        T_RTSK rtsk;
        ER ret;

        ret = ref_tsk(NTSHELL_TASK, &rtsk);
        if ((ret != E_OK) || (rtsk.tskstat == TTS_DMT))
                return;

        FD_SET(0, (fd_set *)&flgptn);

        set_flg(FLG_SELECT_WAIT, flgptn);
}

static int usrcmd_ntopt_callback(long *args, void *extobj)
{
        const cmd_table_t *p = cmd_table_info.table;
        int result = 0;
        int found = 0;

        if (*args == 0)
                return result;

        if (strcmp((const char *)args[1], "help") == 0) {
                found = 1;
                result = usrcmd_help(args[0], (char **)&args[1]);
        }
        else for (int i = 0; i < cmd_table_info.count; i++) {
                if (strcmp((const char *)args[1], p->cmd) == 0) {
                        found = 1;
                        result = p->func(args[0], (char **)&args[1]);
                        break;
                }
                p++;
        }

        if ((found == 0) && (((const char *)args[1])[0] != '\0'))
                printf("Unknown command found.\n");

        return result;
}

int usrcmd_help(int argc, char **argv)
{
        const cmd_table_t *p = cmd_table_info.table;
        for (int i = 0; i < cmd_table_info.count; i++) {
                fwrite(p->cmd, strlen(p->cmd), 1, stdout);
                fwrite("\t:", strlen("\t:"), 1, stdout);
                puts(p->desc);
                p++;
        }
        return 0;
}

void shell_abort()
{
        ntshell_exit_code = -1;
        longjmp(process_exit, 1);
}

void shell_exit(int exitcd)
{
        ntshell_exit_code = exitcd;
        longjmp(process_exit, 1);
}

void shell_exit_group(int exitcd)
{
        ntshell_exit_code = exitcd;
        longjmp(process_exit, 1);
}

int execute_command(int wait)
{
        T_RTSK rtsk;
        ER ret;

        ret = ter_tsk(NTSHELL_TASK);
        if ((ret != E_OK) && (ret != E_OBJ)) {
                syslog(LOG_ERROR, "ter_tsk => %d", ret);
        }

        tslp_tsk(100000);

        clean_fd();

        ntshell_state = 0;
        ret = act_tsk(NTSHELL_TASK);
        if (ret != E_OK) {
                syslog(LOG_ERROR, "act_tsk => %d", ret);
        }

        if (wait == 0)
                return 0;

        do {
                tslp_tsk(100000);

                ret = ref_tsk(NTSHELL_TASK, &rtsk);
                if ((ret != E_OK) || (rtsk.tskstat == TTS_DMT))
                        ntshell_state = 3;
        } while(ntshell_state == 1);

        return ntshell_exit_code;
}

int cmd_execute(const char *text, void *extobj)
{
        ntlibc_strlcpy(command, text, sizeof(command));
        return execute_command(1);
}

int shell_clock_getres(clockid_t clk_id, struct timespec *res)
{
        if ((clk_id != CLOCK_REALTIME) && (clk_id != CLOCK_MONOTONIC))
                return -EINVAL;

        memset(&res->tv_sec, 0xFF, sizeof(res->tv_sec));
        res->tv_nsec = 0;

        return 0;
}

int shell_clock_gettime(clockid_t clk_id, struct timespec *tp)
{
        SYSTIM now = 0;

        if ((clk_id != CLOCK_REALTIME) && (clk_id != CLOCK_MONOTONIC))
                return -EINVAL;

        get_tim(&now);
        tp->tv_sec = now / 1000000;
        tp->tv_nsec = (now % 1000000) * 1000;

        return 0;
}

int shell_clock_settime(clockid_t clk_id, const struct timespec *tp)
{
        if ((clk_id != CLOCK_REALTIME) && (clk_id != CLOCK_MONOTONIC))
                return -EINVAL;

        SYSTIM time;
        ER ret;

        time = (tp->tv_sec * 1000000ll) + (tp->tv_nsec / 1000ll);

        ret = set_tim(time);
        if (ret != E_OK) {
                return -EPERM;
        }

        return 0;
}

sigset_t g_sigmask;

int shell_sigprocmask(int how, const sigset_t *restrict set, sigset_t *restrict old)
{
        if (old != NULL)
                memcpy(old, &g_sigmask, sizeof(sigset_t));

        switch (how) {
        case SIG_BLOCK:
                for (int i = 0; i < sizeof(g_sigmask.__bits) / sizeof(g_sigmask.__bits[0]); i++) {
                        g_sigmask.__bits[i] |= set->__bits[i];
                }
                break;
        case SIG_UNBLOCK:
                for (int i = 0; i < sizeof(g_sigmask.__bits) / sizeof(g_sigmask.__bits[0]); i++) {
                        g_sigmask.__bits[i] &= ~set->__bits[i];
                }
                break;
        case SIG_SETMASK:
                memcpy(&g_sigmask, set, sizeof(sigset_t));
                break;
        default:
                return -EINVAL;
        }

        return 0;
}

// musl-1.1.18\src\internal\ksigaction.h
struct k_sigaction {
        void(*handler)(int);
        unsigned long flags;
        void(*restorer)(void);
        unsigned mask[2];
};

struct k_sigaction sigtable[7];

int shell_sigaction(int sig, const struct k_sigaction *__restrict sa,
        struct k_sigaction *__restrict old, size_t size)
{
        struct k_sigaction *sat;

        switch(sig){
        case SIGALRM:
                sat = &sigtable[0];
                break;
        case SIGFPE:
                sat = &sigtable[1];
                break;
        case SIGILL:
                sat = &sigtable[2];
                break;
        case SIGSEGV:
                sat = &sigtable[3];
                break;
        case SIGBUS:
                sat = &sigtable[4];
                break;
        case SIGABRT:
                sat = &sigtable[5];
                break;
        case SIGPIPE:
                sat = &sigtable[6];
                break;
        default:
                return -EINVAL;
        }

        if (old != NULL)
                memcpy(old, sat, offsetof(struct k_sigaction, mask) + size);

        memcpy(sat, sa, offsetof(struct k_sigaction, mask) + size);

        return 0;
}

int shell_madvise(void *a, size_t b, int c)
{
        return 0;
}

int shell_gettid()
{
        ID tskid;
        ER ret;

        ret = get_tid(&tskid);
        if (ret != E_OK)
                return -1;

        return tskid;
}

int shell_tkill(int tid, int sig)
{
        if ((tid == NTSHELL_TASK) && (sig == SIGABRT)) {
                shell_abort();
        }

        no_implement("tkill");
        return -1;
}

int shell_kill(int pid, int sig)
{
        DebugBreak();
        return -1;
}

int shell_gettimeofday(struct timeval *tv, void *tzvp)
{
        SYSTIM time;
        if (!tv) return 0;
        get_tim(&time);
        tv->tv_sec = time / 1000000;
        tv->tv_usec = time - (tv->tv_sec * 1000000);
        return 0;
}

int shell_nanosleep(const struct timespec *req, struct timespec *rem)
{
        ER ret;
        TMO tmo;
        SYSTIM prev, now, diff;

        if ((req == NULL) || (req->tv_nsec < 0) || (req->tv_nsec >= 1000000000))
                return -EINVAL;

        get_tim(&prev);

        tmo = req->tv_sec * 1000000 + req->tv_nsec / 1000;
        ret = tslp_tsk(tmo);
        if (ret == E_OK) {
                if (rem != NULL) {
                        get_tim(&now);
                        diff = now - prev;
                        rem->tv_sec = diff / 1000000ll;
                        rem->tv_nsec = (diff - (rem->tv_sec * 1000000ll)) * 1000ll;
                }
                return 0;
        }
        else if (ret == E_TMOUT) {
                if (rem != NULL) {
                        rem->tv_sec = 0;
                        rem->tv_nsec = 0;
                }
                return 0;
        }

        return -EFAULT;
}