Subversion Repositories HelenOS-historic

Rev

Rev 1129 | Rev 1392 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2006 Jakub Jermar
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29. #include <thread.h>
  30. #include <libc.h>
  31. #include <stdlib.h>
  32. #include <arch/faddr.h>
  33. #include <kernel/proc/uarg.h>
  34. #include <psthread.h>
  35. #include <string.h>
  36.  
  37. #include <stdio.h>
  38.  
  39.  
  40. #ifndef THREAD_INITIAL_STACK_PAGES_NO
  41. #define THREAD_INITIAL_STACK_PAGES_NO 1
  42. #endif
  43.  
  44.  
  45. extern char _tdata_start;
  46. extern char _tdata_end;
  47. extern char _tbss_start;
  48. extern char _tbss_end;
  49.  
  50. /** Create Thread Local storage area, return pointer to TCB(ThreadControlBlock)
  51.  *
  52.  * !! The code requires, that sections .tdata and .tbss are adjacent.
  53.  *    It may be changed in the future.
  54.  */
  55. tcb_t * __make_tls(void)
  56. {
  57.     void *data;
  58.     tcb_t *tcb;
  59.     size_t tls_size = &_tbss_end - &_tdata_start;
  60.    
  61.     tcb = __alloc_tls(&data, tls_size);
  62.    
  63.     memcpy(data, &_tdata_start, &_tdata_end - &_tdata_start);
  64.     memset(data + (&_tbss_start-&_tdata_start), &_tbss_end-&_tbss_start, 0);
  65.  
  66.     return tcb;
  67. }
  68.  
  69. void __free_tls(tcb_t *tcb)
  70. {
  71.     size_t tls_size = &_tbss_end - &_tdata_start;
  72.     __free_tls_arch(tcb, tls_size);
  73. }
  74.  
  75. /** Main thread function.
  76.  *
  77.  * This function is called from __thread_entry() and is used
  78.  * to call the thread's implementing function and perform cleanup
  79.  * and exit when thread returns back. Do not call this function
  80.  * directly.
  81.  *
  82.  * @param uarg Pointer to userspace argument structure.
  83.  */
  84. void __thread_main(uspace_arg_t *uarg)
  85. {
  86.     tcb_t *tcb;
  87.     /* This should initialize the area according to TLS specicification */
  88.     tcb = __make_tls();
  89.     __tcb_set(tcb);
  90.     psthread_setup(tcb);
  91.  
  92.     uarg->uspace_thread_function(uarg->uspace_thread_arg);
  93.     free(uarg->uspace_stack);
  94.     free(uarg);
  95.  
  96.     psthread_teardown(tcb->pst_data);
  97.     __free_tls(tcb);
  98.  
  99.     thread_exit(0);
  100. }
  101.  
  102. /** Create userspace thread.
  103.  *
  104.  * This function creates new userspace thread and allocates userspace
  105.  * stack and userspace argument structure for it.
  106.  *
  107.  * @param function Function implementing the thread.
  108.  * @param arg Argument to be passed to thread.
  109.  * @param name Symbolic name of the thread.
  110.  *
  111.  * @param TID of the new thread on success or -1 on failure.
  112.  */
  113. int thread_create(void (* function)(void *), void *arg, char *name)
  114. {
  115.     char *stack;
  116.     uspace_arg_t *uarg;
  117.  
  118.     stack = (char *) malloc(getpagesize()*THREAD_INITIAL_STACK_PAGES_NO);
  119.     if (!stack)
  120.         return -1;
  121.        
  122.     uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t));
  123.     if (!uarg) {
  124.         free(stack);
  125.         return -1;
  126.     }
  127.    
  128.     uarg->uspace_entry = (void *) FADDR(__thread_entry);
  129.     uarg->uspace_stack = (void *) stack;
  130.     uarg->uspace_thread_function = function;
  131.     uarg->uspace_thread_arg = arg;
  132.     uarg->uspace_uarg = uarg;
  133.    
  134.     return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name);
  135. }
  136.  
  137. /** Terminate current thread.
  138.  *
  139.  * @param stat Exit status. Currently not used.
  140.  */
  141. void thread_exit(int status)
  142. {
  143.     __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
  144. }
  145.