Subversion Repositories HelenOS-historic

Rev

Rev 1113 | 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. extern char _tdata_start;
  40. extern char _tdata_end;
  41. extern char _tbss_start;
  42. extern char _tbss_end;
  43.  
  44. /** Create Thread Local storage area, return pointer to TCB(ThreadControlBlock)
  45.  *
  46.  * !! The code requires, that sections .tdata and .tbss are adjacent.
  47.  *    It may be changed in the future.
  48.  */
  49. tcb_t * __make_tls(void)
  50. {
  51.     void *data;
  52.     tcb_t *tcb;
  53.     size_t tls_size = &_tbss_end - &_tdata_start;
  54.    
  55.     tcb = __alloc_tls(&data, tls_size);
  56.    
  57.     memcpy(data, &_tdata_start, &_tdata_end - &_tdata_start);
  58.     memset(data + (&_tbss_start-&_tdata_start), &_tbss_end-&_tbss_start, 0);
  59.  
  60.     return tcb;
  61. }
  62.  
  63. void __free_tls(tcb_t *tcb)
  64. {
  65.     size_t tls_size = &_tbss_end - &_tdata_start;
  66.     __free_tls_arch(tcb, tls_size);
  67. }
  68.  
  69. /** Main thread function.
  70.  *
  71.  * This function is called from __thread_entry() and is used
  72.  * to call the thread's implementing function and perform cleanup
  73.  * and exit when thread returns back. Do not call this function
  74.  * directly.
  75.  *
  76.  * @param uarg Pointer to userspace argument structure.
  77.  */
  78. void __thread_main(uspace_arg_t *uarg)
  79. {
  80.     tcb_t *tcb;
  81.     /* This should initialize the area according to TLS specicification */
  82.     tcb = __make_tls();
  83.     __tcb_set(tcb);
  84.     psthread_setup(tcb);
  85.  
  86.     uarg->uspace_thread_function(uarg->uspace_thread_arg);
  87.     free(uarg->uspace_stack);
  88.     free(uarg);
  89.  
  90.     psthread_teardown(tcb->pst_data);
  91.     __free_tls(tcb);
  92.  
  93.     thread_exit(0);
  94. }
  95.  
  96. /** Create userspace thread.
  97.  *
  98.  * This function creates new userspace thread and allocates userspace
  99.  * stack and userspace argument structure for it.
  100.  *
  101.  * @param function Function implementing the thread.
  102.  * @param arg Argument to be passed to thread.
  103.  * @param name Symbolic name of the thread.
  104.  *
  105.  * @param TID of the new thread on success or -1 on failure.
  106.  */
  107. int thread_create(void (* function)(void *), void *arg, char *name)
  108. {
  109.     char *stack;
  110.     uspace_arg_t *uarg;
  111.  
  112.     stack = (char *) malloc(getpagesize());
  113.     if (!stack)
  114.         return -1;
  115.        
  116.     uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t));
  117.     if (!uarg) {
  118.         free(stack);
  119.         return -1;
  120.     }
  121.    
  122.     uarg->uspace_entry = (void *) FADDR(__thread_entry);
  123.     uarg->uspace_stack = (void *) stack;
  124.     uarg->uspace_thread_function = function;
  125.     uarg->uspace_thread_arg = arg;
  126.     uarg->uspace_uarg = uarg;
  127.    
  128.     return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name);
  129. }
  130.  
  131. /** Terminate current thread.
  132.  *
  133.  * @param stat Exit status. Currently not used.
  134.  */
  135. void thread_exit(int status)
  136. {
  137.     __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
  138. }
  139.