| 0,0 → 1,158 |
|---|
| /* |
| * Copyright (C) 2006 Jakub Jermar |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| /** @addtogroup libc |
| * @{ |
| */ |
| /** @file |
| */ |
| |
| #include <thread.h> |
| #include <libc.h> |
| #include <stdlib.h> |
| #include <libarch/faddr.h> |
| #include <kernel/proc/uarg.h> |
| #include <psthread.h> |
| #include <string.h> |
| #include <async.h> |
| |
| #include <stdio.h> |
| |
| |
| #ifndef THREAD_INITIAL_STACK_PAGES_NO |
| #define THREAD_INITIAL_STACK_PAGES_NO 1 |
| #endif |
| |
| static LIST_INITIALIZE(thread_garbage); |
| |
| extern char _tdata_start; |
| extern char _tdata_end; |
| extern char _tbss_start; |
| extern char _tbss_end; |
| |
| /** Create Thread Local storage area, return pointer to TCB(ThreadControlBlock) |
| * |
| * !! The code requires, that sections .tdata and .tbss are adjacent. |
| * It may be changed in the future. |
| */ |
| tcb_t * __make_tls(void) |
| { |
| void *data; |
| tcb_t *tcb; |
| size_t tls_size = &_tbss_end - &_tdata_start; |
| |
| tcb = __alloc_tls(&data, tls_size); |
| |
| memcpy(data, &_tdata_start, &_tdata_end - &_tdata_start); |
| memset(data + (&_tbss_start-&_tdata_start), 0, &_tbss_end-&_tbss_start); |
| return tcb; |
| } |
| |
| void __free_tls(tcb_t *tcb) |
| { |
| size_t tls_size = &_tbss_end - &_tdata_start; |
| __free_tls_arch(tcb, tls_size); |
| } |
| |
| /** Main thread function. |
| * |
| * This function is called from __thread_entry() and is used |
| * to call the thread's implementing function and perform cleanup |
| * and exit when thread returns back. Do not call this function |
| * directly. |
| * |
| * @param uarg Pointer to userspace argument structure. |
| * |
| * TODO: Thread stack pages memory leak |
| */ |
| void __thread_main(uspace_arg_t *uarg) |
| { |
| psthread_data_t *pt; |
| |
| pt = psthread_setup(); |
| __tcb_set(pt->tcb); |
| |
| uarg->uspace_thread_function(uarg->uspace_thread_arg); |
| free(uarg->uspace_stack); |
| free(uarg); |
| |
| /* If there is a manager, destroy it */ |
| async_destroy_manager(); |
| psthread_teardown(pt); |
| |
| thread_exit(0); |
| } |
| |
| /** Create userspace thread. |
| * |
| * This function creates new userspace thread and allocates userspace |
| * stack and userspace argument structure for it. |
| * |
| * @param function Function implementing the thread. |
| * @param arg Argument to be passed to thread. |
| * @param name Symbolic name of the thread. |
| * |
| * @return TID of the new thread on success or -1 on failure. |
| */ |
| int thread_create(void (* function)(void *), void *arg, char *name) |
| { |
| char *stack; |
| uspace_arg_t *uarg; |
| |
| stack = (char *) malloc(getpagesize()*THREAD_INITIAL_STACK_PAGES_NO); |
| if (!stack) |
| return -1; |
| |
| uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t)); |
| if (!uarg) { |
| free(stack); |
| return -1; |
| } |
| |
| uarg->uspace_entry = (void *) FADDR(__thread_entry); |
| uarg->uspace_stack = (void *) stack; |
| uarg->uspace_thread_function = function; |
| uarg->uspace_thread_arg = arg; |
| uarg->uspace_uarg = uarg; |
| |
| return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name); |
| } |
| |
| /** Terminate current thread. |
| * |
| * @param status Exit status. Currently not used. |
| */ |
| void thread_exit(int status) |
| { |
| __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status); |
| } |
| |
| /** @} |
| */ |
| |
| |