diff options
| author | Bernard Xiong <[email protected]> | 2018-06-29 22:15:35 +0800 |
|---|---|---|
| committer | GitHub <[email protected]> | 2018-06-29 22:15:35 +0800 |
| commit | 05badde135fb6fc2a12cd9a45ad4be7135a9e1c1 (patch) | |
| tree | 7fd1e1634115b6e5505ec8578b4c2117e4304de5 /components | |
| parent | 0f3820f1b671c56143e8417d4e332b035a7da176 (diff) | |
| parent | 8b8e4489448ee866efb1f42c206b99b3b35c3bb7 (diff) | |
Merge pull request #1588 from heyuanjie87/lwp
Lwp
Diffstat (limited to 'components')
| -rw-r--r-- | components/lwp/arch/arm/cortex-m3/lwp_rvds.S | 14 | ||||
| -rw-r--r-- | components/lwp/arch/arm/cortex-m4/lwp_rvds.S | 14 | ||||
| -rw-r--r-- | components/lwp/arch/arm/cortex-m7/lwp_rvds.S | 13 | ||||
| -rw-r--r-- | components/lwp/lwp.c | 67 | ||||
| -rw-r--r-- | components/lwp/lwp.h | 1 | ||||
| -rw-r--r-- | components/lwp/lwp_mem.c | 11 |
6 files changed, 86 insertions, 34 deletions
diff --git a/components/lwp/arch/arm/cortex-m3/lwp_rvds.S b/components/lwp/arch/arm/cortex-m3/lwp_rvds.S index ff79cfda4b..49470ea03a 100644 --- a/components/lwp/arch/arm/cortex-m3/lwp_rvds.S +++ b/components/lwp/arch/arm/cortex-m3/lwp_rvds.S @@ -34,33 +34,33 @@ IMPORT lwp_set_kernel_sp ;/* -; * void lwp_user_entry(u32 R0_text_addr, u32 R1_data_addr); +; * void lwp_user_entry(args, text, data); ; */ lwp_user_entry PROC EXPORT lwp_user_entry - PUSH {R0-R1} ; push text&data addr. + PUSH {R0-R3} ; push text&data addr. MOV R0, SP ; v1 = SP BL lwp_set_kernel_sp ; lwp_set_kernel_sp(v1) - POP {R0-R1} ; pop app address to R1. - ; set CPU to user-thread mode. MRS R2, CONTROL ORR R2, R2, #0x03 ; use PSP, user-thread mode. MSR CONTROL, R2 + POP {R0-R3} ; pop app address to R1. ; set data address. - MOV R9, R1 + MOV R9, R2 ; run app, only Thumb-mode. - ORR R0, R0, #0x01 - BX R0 + ORR R1, R1, #0x01 + BX R1 ; never reach here! ENDP + ;/* ; * void SVC_Handler(void); ; */ diff --git a/components/lwp/arch/arm/cortex-m4/lwp_rvds.S b/components/lwp/arch/arm/cortex-m4/lwp_rvds.S index 16e81710c1..42fad954ce 100644 --- a/components/lwp/arch/arm/cortex-m4/lwp_rvds.S +++ b/components/lwp/arch/arm/cortex-m4/lwp_rvds.S @@ -34,33 +34,33 @@ IMPORT lwp_set_kernel_sp ;/* -; * void lwp_user_entry(u32 R0_text_addr, u32 R1_data_addr); +; * void lwp_user_entry(args, text, data); ; */ lwp_user_entry PROC EXPORT lwp_user_entry - PUSH {R0-R1} ; push text&data addr. + PUSH {R0-R3} ; push text&data addr. MOV R0, SP ; v1 = SP BL lwp_set_kernel_sp ; lwp_set_kernel_sp(v1) - POP {R0-R1} ; pop app address to R1. - ; set CPU to user-thread mode. MRS R2, CONTROL ORR R2, R2, #0x03 ; use PSP, user-thread mode. MSR CONTROL, R2 + POP {R0-R3} ; pop app address to R1. ; set data address. - MOV R9, R1 + MOV R9, R2 ; run app, only Thumb-mode. - ORR R0, R0, #0x01 - BX R0 + ORR R1, R1, #0x01 + BX R1 ; never reach here! ENDP + ;/* ; * void SVC_Handler(void); ; */ diff --git a/components/lwp/arch/arm/cortex-m7/lwp_rvds.S b/components/lwp/arch/arm/cortex-m7/lwp_rvds.S index 16e81710c1..6c310a3632 100644 --- a/components/lwp/arch/arm/cortex-m7/lwp_rvds.S +++ b/components/lwp/arch/arm/cortex-m7/lwp_rvds.S @@ -34,29 +34,28 @@ IMPORT lwp_set_kernel_sp ;/* -; * void lwp_user_entry(u32 R0_text_addr, u32 R1_data_addr); +; * void lwp_user_entry(args, text, data); ; */ lwp_user_entry PROC EXPORT lwp_user_entry - PUSH {R0-R1} ; push text&data addr. + PUSH {R0-R3} ; push text&data addr. MOV R0, SP ; v1 = SP BL lwp_set_kernel_sp ; lwp_set_kernel_sp(v1) - POP {R0-R1} ; pop app address to R1. - ; set CPU to user-thread mode. MRS R2, CONTROL ORR R2, R2, #0x03 ; use PSP, user-thread mode. MSR CONTROL, R2 + POP {R0-R3} ; pop app address to R1. ; set data address. - MOV R9, R1 + MOV R9, R2 ; run app, only Thumb-mode. - ORR R0, R0, #0x01 - BX R0 + ORR R1, R1, #0x01 + BX R1 ; never reach here! ENDP diff --git a/components/lwp/lwp.c b/components/lwp/lwp.c index 13e2a8f2ef..acd290bc0f 100644 --- a/components/lwp/lwp.c +++ b/components/lwp/lwp.c @@ -25,10 +25,6 @@ #include <rthw.h> #include <dfs_posix.h> -#ifdef RT_USING_FINSH - #include <finsh.h> -#endif - #ifndef RT_USING_DFS #error "lwp need file system(RT_USING_DFS)" #endif @@ -38,11 +34,11 @@ #define DBG_ENABLE #define DBG_SECTION_NAME "[LWP]" #define DBG_COLOR -#define DBG_LEVEL DBG_LOG +#define DBG_LEVEL DBG_WARNING #include <rtdbg.h> extern rt_thread_t rt_current_thread; -extern void lwp_user_entry(const void *text, void *data); +extern void lwp_user_entry(void *args, const void *text, void *data); /** * RT-Thread light-weight process @@ -62,6 +58,43 @@ uint32_t *lwp_get_kernel_sp(void) return user_data->kernel_sp; } +static int lwp_argscopy(struct rt_lwp *lwp, int argc, char **argv) +{ + int size = sizeof(int)*3; /* store argc, argv, NULL */ + int *args; + char *str; + char **new_argv; + int i; + int len; + + for (i = 0; i < argc; i ++) + { + size += (rt_strlen(argv[i]) + 1); + } + size += (sizeof(int) * argc); + + args = (int*)rt_malloc(size); + if (args == RT_NULL) + return -1; + + str = (char*)((int)args + (argc + 3) * sizeof(int)); + new_argv = (char**)&args[2]; + args[0] = argc; + args[1] = (int)new_argv; + + for (i = 0; i < argc; i ++) + { + len = rt_strlen(argv[i]) + 1; + new_argv[i] = str; + rt_memcpy(str, argv[i], len); + str += len; + } + new_argv[i] = 0; + lwp->args = args; + + return 0; +} + static int lwp_load(const char *filename, struct rt_lwp *lwp, uint8_t *load_addr, size_t addr_size) { int fd; @@ -76,8 +109,6 @@ static int lwp_load(const char *filename, struct rt_lwp *lwp, uint8_t *load_addr /* check lwp control block */ RT_ASSERT(lwp != RT_NULL); - memset(lwp, 0x00, sizeof(struct rt_lwp)); - if (load_addr != RT_NULL) { lwp->lwp_type = LWP_TYPE_FIX_ADDR; @@ -279,6 +310,15 @@ static void lwp_cleanup(struct rt_thread *tid) dbg_log(DBG_LOG, "lwp free memory pages\n"); rt_lwp_mem_deinit(lwp); + /* cleanup fd table */ + while (lwp->fdt.maxfd > 0) + { + lwp->fdt.maxfd --; + close(lwp->fdt.maxfd); + } + rt_free(lwp->fdt.fds); + rt_free(lwp->args); + dbg_log(DBG_LOG, "lwp free: %p\n", lwp); rt_free(lwp); @@ -299,7 +339,7 @@ static void lwp_thread(void *parameter) tid->user_data = (rt_uint32_t)lwp; tid->cleanup = lwp_cleanup; - lwp_user_entry(lwp->text_entry, lwp->data); + lwp_user_entry(lwp->args, lwp->text_entry, lwp->data); } struct rt_lwp *rt_lwp_self(void) @@ -307,7 +347,7 @@ struct rt_lwp *rt_lwp_self(void) return (struct rt_lwp *)rt_thread_self()->user_data; } -int exec(char *filename) +int exec(char *filename, int argc, char **argv) { struct rt_lwp *lwp; int result; @@ -324,6 +364,12 @@ int exec(char *filename) dbg_log(DBG_INFO, "lwp malloc : %p, size: %d!\n", lwp, sizeof(struct rt_lwp)); rt_memset(lwp, 0, sizeof(*lwp)); + if (lwp_argscopy(lwp, argc, argv) != 0) + { + rt_free(lwp); + return -ENOMEM; + } + result = lwp_load(filename, lwp, RT_NULL, 0); if (result == RT_EOK) { @@ -348,6 +394,7 @@ int exec(char *filename) } } + rt_free(lwp->args); rt_free(lwp); return -RT_ERROR; diff --git a/components/lwp/lwp.h b/components/lwp/lwp.h index b1ce96455e..0b25cf6917 100644 --- a/components/lwp/lwp.h +++ b/components/lwp/lwp.h @@ -52,6 +52,7 @@ struct rt_lwp uint32_t *kernel_sp; /**< kernel stack point */ struct dfs_fdtable fdt; + void *args; }; struct lwp_header diff --git a/components/lwp/lwp_mem.c b/components/lwp/lwp_mem.c index ca390e4f96..6092dc6ee5 100644 --- a/components/lwp/lwp_mem.c +++ b/components/lwp/lwp_mem.c @@ -28,7 +28,7 @@ #define DBG_ENABLE #define DBG_SECTION_NAME "[LWPMEM]" #define DBG_COLOR -#define DBG_LEVEL DBG_LOG +#define DBG_LEVEL DBG_WARNING #include <rtdbg.h> // todo: remove repleat code @@ -117,13 +117,18 @@ void rt_lwp_mem_deinit(struct rt_lwp *lwp) RT_ASSERT(lwp != RT_NULL); - for (node = lwp->hlist.next; node != &(lwp->hlist); node = node->next) + node = lwp->hlist.next; + + while (node != &(lwp->hlist)) { struct rt_lwp_memheap *lwp_heap; + lwp_heap = rt_list_entry(node, struct rt_lwp_memheap, mlist); - RT_ASSERT(lwp_heap != RT_NULL); + /* update note before free page*/ + node = node->next; + rt_lwp_free_page(lwp, lwp_heap); } } |
