364 lines
7.8 KiB
C
364 lines
7.8 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2006-2018, RT-Thread Development Team
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2010-03-22 Bernard first version
|
||
|
|
*/
|
||
|
|
#include <finsh.h>
|
||
|
|
|
||
|
|
#include "finsh_vm.h"
|
||
|
|
#include "finsh_ops.h"
|
||
|
|
#include "finsh_var.h"
|
||
|
|
|
||
|
|
/* stack */
|
||
|
|
union finsh_value finsh_vm_stack[FINSH_STACK_MAX];
|
||
|
|
/* text segment */
|
||
|
|
uint8_t text_segment[FINSH_TEXT_MAX];
|
||
|
|
|
||
|
|
union finsh_value* finsh_sp; /* stack pointer */
|
||
|
|
uint8_t* finsh_pc; /* PC */
|
||
|
|
|
||
|
|
/* syscall list, for dynamic system call register */
|
||
|
|
struct finsh_syscall_item* global_syscall_list = NULL;
|
||
|
|
|
||
|
|
// #define FINSH_VM_DISASSEMBLE
|
||
|
|
void finsh_vm_run()
|
||
|
|
{
|
||
|
|
uint8_t op;
|
||
|
|
|
||
|
|
/* if you want to disassemble the byte code, please define FINSH_VM_DISASSEMBLE */
|
||
|
|
#ifdef FINSH_VM_DISASSEMBLE
|
||
|
|
void finsh_disassemble();
|
||
|
|
finsh_disassemble();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* set sp(stack pointer) to the beginning of stack */
|
||
|
|
finsh_sp = &finsh_vm_stack[0];
|
||
|
|
|
||
|
|
/* set pc to the beginning of text segment */
|
||
|
|
finsh_pc = &text_segment[0];
|
||
|
|
|
||
|
|
while ((finsh_pc - &text_segment[0] >= 0) &&
|
||
|
|
(finsh_pc - &text_segment[0] < FINSH_TEXT_MAX))
|
||
|
|
{
|
||
|
|
/* get op */
|
||
|
|
op = *finsh_pc++;
|
||
|
|
|
||
|
|
/* call op function */
|
||
|
|
op_table[op]();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef RT_USING_HEAP
|
||
|
|
void finsh_syscall_append(const char* name, syscall_func func)
|
||
|
|
{
|
||
|
|
/* create the syscall */
|
||
|
|
struct finsh_syscall_item* item;
|
||
|
|
|
||
|
|
item = (struct finsh_syscall_item*)rt_malloc(sizeof(struct finsh_syscall_item));
|
||
|
|
if (item != RT_NULL)
|
||
|
|
{
|
||
|
|
item->next = NULL;
|
||
|
|
item->syscall.name = rt_strdup(name);
|
||
|
|
item->syscall.func = func;
|
||
|
|
|
||
|
|
if (global_syscall_list == NULL)
|
||
|
|
{
|
||
|
|
global_syscall_list = item;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
item->next = global_syscall_list;
|
||
|
|
global_syscall_list = item;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
struct finsh_syscall* finsh_syscall_lookup(const char* name)
|
||
|
|
{
|
||
|
|
struct finsh_syscall* index;
|
||
|
|
struct finsh_syscall_item* item;
|
||
|
|
|
||
|
|
for (index = _syscall_table_begin; index < _syscall_table_end; FINSH_NEXT_SYSCALL(index))
|
||
|
|
{
|
||
|
|
if (strcmp(index->name, name) == 0)
|
||
|
|
return index;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* find on syscall list */
|
||
|
|
item = global_syscall_list;
|
||
|
|
while (item != NULL)
|
||
|
|
{
|
||
|
|
if (strncmp(item->syscall.name, name, strlen(name)) == 0)
|
||
|
|
{
|
||
|
|
return &(item->syscall);
|
||
|
|
}
|
||
|
|
|
||
|
|
item = item->next;
|
||
|
|
}
|
||
|
|
|
||
|
|
return NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef FINSH_VM_DISASSEMBLE
|
||
|
|
void finsh_disassemble()
|
||
|
|
{
|
||
|
|
uint8_t *pc, op;
|
||
|
|
|
||
|
|
pc = &text_segment[0];
|
||
|
|
while (*pc != 0)
|
||
|
|
{
|
||
|
|
op = *pc;
|
||
|
|
switch (op)
|
||
|
|
{
|
||
|
|
case FINSH_OP_ADD_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("addb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SUB_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("subb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_DIV_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("divb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MOD_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("modb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MUL_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("mulb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_AND_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("andb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_OR_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("orb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_XOR_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("xorb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_BITWISE_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("bwb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHL_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shlb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHR_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shrb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldb %d\n", *pc++);
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldb [0x%x]\n", FINSH_GET32(pc));
|
||
|
|
pc += 4;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_ST_BYTE:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("stb\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_ADD_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("addw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SUB_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("subw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_DIV_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("divw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MOD_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("modw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MUL_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("mulw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_AND_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("andw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_OR_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("orw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_XOR_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("xorw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_BITWISE_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("bww\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHL_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shlw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHR_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shrw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldw %d\n", FINSH_GET16(pc));
|
||
|
|
pc += 2;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldw [0x%x]\n", FINSH_GET32(pc));
|
||
|
|
pc += 4;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_ST_WORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("stw\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_ADD_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("addd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SUB_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("subd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_DIV_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("divd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MOD_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("modd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_MUL_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("muld\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_AND_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("andd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_OR_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ord\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_XOR_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("xord\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_BITWISE_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("bwd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHL_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shld\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SHR_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("shrd\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldd 0x%x\n", FINSH_GET32(pc));
|
||
|
|
pc += 4;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldd [0x%x]\n", FINSH_GET32(pc));
|
||
|
|
pc += 4;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_ST_DWORD:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("std\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_POP:
|
||
|
|
rt_kprintf("pop\n");
|
||
|
|
pc ++;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_SYSCALL:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("syscall %d\n", *pc++);
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_BYTE_STACK:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldb [sp]\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_WORD_STACK:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldw [sp]\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
case FINSH_OP_LD_VALUE_DWORD_STACK:
|
||
|
|
pc ++;
|
||
|
|
rt_kprintf("ldd [sp]\n");
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
#endif
|