[c05290e] | 1 | /*
|
---|
[df4ed85] | 2 | * Copyright (c) 2006 Jakub Jermar
|
---|
[c05290e] | 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.
|
---|
[b2951e2] | 27 | */
|
---|
| 28 |
|
---|
[afbe96a] | 29 | /** @addtogroup libc
|
---|
[b2951e2] | 30 | * @{
|
---|
| 31 | */
|
---|
| 32 | /** @file
|
---|
[47b7006] | 33 | */
|
---|
[c05290e] | 34 |
|
---|
| 35 | #include <libc.h>
|
---|
[76d0981d] | 36 | #include <stdbool.h>
|
---|
[e5a1f82f] | 37 | #include <stdlib.h>
|
---|
[afbe96a] | 38 | #include <libarch/faddr.h>
|
---|
[bc1f1c2] | 39 | #include <fibril.h>
|
---|
[0aae87a6] | 40 | #include <stack.h>
|
---|
[19f857a] | 41 | #include <str.h>
|
---|
[80649a91] | 42 | #include <async.h>
|
---|
[2902e1bb] | 43 | #include <errno.h>
|
---|
| 44 | #include <as.h>
|
---|
[6340b4d2] | 45 |
|
---|
| 46 | #include "../private/thread.h"
|
---|
| 47 | #include "../private/fibril.h"
|
---|
[29a9f62] | 48 |
|
---|
[81e55099] | 49 | /** Main thread function.
|
---|
| 50 | *
|
---|
| 51 | * This function is called from __thread_entry() and is used
|
---|
| 52 | * to call the thread's implementing function and perform cleanup
|
---|
[47b7006] | 53 | * and exit when thread returns back.
|
---|
[81e55099] | 54 | *
|
---|
[3fcea34] | 55 | * @param arg Fibril pointer.
|
---|
[47b7006] | 56 | *
|
---|
[81e55099] | 57 | */
|
---|
[3fcea34] | 58 | static void __thread_main(void *arg)
|
---|
[e5a1f82f] | 59 | {
|
---|
[3fcea34] | 60 | fibril_t *fibril = arg;
|
---|
[40abf56a] | 61 |
|
---|
[3fcea34] | 62 | assert(!__tcb_is_set());
|
---|
[40abf56a] | 63 | assert(fibril);
|
---|
[a35b458] | 64 |
|
---|
[47b7006] | 65 | __tcb_set(fibril->tcb);
|
---|
[a35b458] | 66 |
|
---|
[3fcea34] | 67 | fibril->func(fibril->arg);
|
---|
[2902e1bb] | 68 | /*
|
---|
| 69 | * XXX: we cannot free the userspace stack while running on it
|
---|
| 70 | *
|
---|
| 71 | * free(uarg->uspace_stack);
|
---|
| 72 | * free(uarg);
|
---|
| 73 | */
|
---|
[a35b458] | 74 |
|
---|
[514d561] | 75 | fibril_teardown(fibril);
|
---|
[e5a1f82f] | 76 | thread_exit(0);
|
---|
| 77 | }
|
---|
[c05290e] | 78 |
|
---|
[81e55099] | 79 | /** Create userspace thread.
|
---|
| 80 | *
|
---|
| 81 | * This function creates new userspace thread and allocates userspace
|
---|
| 82 | * stack and userspace argument structure for it.
|
---|
| 83 | *
|
---|
| 84 | * @param function Function implementing the thread.
|
---|
| 85 | * @param arg Argument to be passed to thread.
|
---|
| 86 | * @param name Symbolic name of the thread.
|
---|
[201abde] | 87 | * @param tid Thread ID of the newly created thread.
|
---|
[81e55099] | 88 | *
|
---|
[201abde] | 89 | * @return Zero on success or a code from @ref errno.h on failure.
|
---|
[81e55099] | 90 | */
|
---|
[3fcea34] | 91 | errno_t thread_create(errno_t (*func)(void *), void *arg, const char *name)
|
---|
[c05290e] | 92 | {
|
---|
[40abf56a] | 93 | fibril_t *fibril = fibril_alloc();
|
---|
[3fcea34] | 94 | if (!fibril)
|
---|
[40abf56a] | 95 | return ENOMEM;
|
---|
[3fcea34] | 96 |
|
---|
| 97 | fibril->func = func;
|
---|
| 98 | fibril->arg = arg;
|
---|
[40abf56a] | 99 |
|
---|
[0aae87a6] | 100 | size_t stack_size = stack_size_get();
|
---|
[2902e1bb] | 101 | void *stack = as_area_create(AS_AREA_ANY, stack_size,
|
---|
[3b8a990] | 102 | AS_AREA_READ | AS_AREA_WRITE | AS_AREA_CACHEABLE | AS_AREA_GUARD |
|
---|
[6aeca0d] | 103 | AS_AREA_LATE_RESERVE, AS_AREA_UNPAGED);
|
---|
[2902e1bb] | 104 | if (stack == AS_MAP_FAILED) {
|
---|
[514d561] | 105 | fibril_teardown(fibril);
|
---|
[2902e1bb] | 106 | return ENOMEM;
|
---|
[e5a1f82f] | 107 | }
|
---|
[a35b458] | 108 |
|
---|
[3fcea34] | 109 | uintptr_t sp = arch_thread_prepare(stack, stack_size, __thread_main,
|
---|
| 110 | fibril);
|
---|
[a35b458] | 111 |
|
---|
[3fcea34] | 112 | errno_t rc = (errno_t) __SYSCALL4(SYS_THREAD_CREATE,
|
---|
| 113 | (sysarg_t) FADDR(__thread_entry), sp,
|
---|
| 114 | (sysarg_t) name, (sysarg_t) str_size(name));
|
---|
[a35b458] | 115 |
|
---|
[2902e1bb] | 116 | if (rc != EOK) {
|
---|
[f6d2c81] | 117 | /*
|
---|
| 118 | * Failed to create a new thread.
|
---|
[2902e1bb] | 119 | * Free up the allocated data.
|
---|
[f6d2c81] | 120 | */
|
---|
[2902e1bb] | 121 | as_area_destroy(stack);
|
---|
[f6d2c81] | 122 | }
|
---|
[a35b458] | 123 |
|
---|
[f6d2c81] | 124 | return rc;
|
---|
[c05290e] | 125 | }
|
---|
| 126 |
|
---|
[81e55099] | 127 | /** Terminate current thread.
|
---|
| 128 | *
|
---|
[096ba7a] | 129 | * @param status Exit status. Currently not used.
|
---|
[47b7006] | 130 | *
|
---|
[81e55099] | 131 | */
|
---|
[c05290e] | 132 | void thread_exit(int status)
|
---|
| 133 | {
|
---|
| 134 | __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
|
---|
[a35b458] | 135 |
|
---|
[47b7006] | 136 | /* Unreachable */
|
---|
[76d0981d] | 137 | while (true)
|
---|
[1433ecda] | 138 | ;
|
---|
[c05290e] | 139 | }
|
---|
[01ff41c] | 140 |
|
---|
[dd655970] | 141 | /** Get current thread ID.
|
---|
| 142 | *
|
---|
| 143 | * @return Current thread ID.
|
---|
| 144 | */
|
---|
[201abde] | 145 | thread_id_t thread_get_id(void)
|
---|
[dd655970] | 146 | {
|
---|
[201abde] | 147 | thread_id_t thread_id;
|
---|
| 148 |
|
---|
| 149 | (void) __SYSCALL1(SYS_THREAD_GET_ID, (sysarg_t) &thread_id);
|
---|
| 150 |
|
---|
| 151 | return thread_id;
|
---|
[dd655970] | 152 | }
|
---|
| 153 |
|
---|
[582a0b8] | 154 | /** Wait unconditionally for specified number of microseconds
|
---|
| 155 | *
|
---|
| 156 | */
|
---|
[bd41ac52] | 157 | void thread_usleep(usec_t usec)
|
---|
[582a0b8] | 158 | {
|
---|
| 159 | (void) __SYSCALL1(SYS_THREAD_USLEEP, usec);
|
---|
| 160 | }
|
---|
| 161 |
|
---|
| 162 | /** Wait unconditionally for specified number of seconds
|
---|
| 163 | *
|
---|
| 164 | */
|
---|
[bd41ac52] | 165 | void thread_sleep(sec_t sec)
|
---|
[582a0b8] | 166 | {
|
---|
| 167 | /*
|
---|
[bd41ac52] | 168 | * Sleep in 1000 second steps to support full argument range
|
---|
[582a0b8] | 169 | */
|
---|
| 170 | while (sec > 0) {
|
---|
| 171 | unsigned int period = (sec > 1000) ? 1000 : sec;
|
---|
[a35b458] | 172 |
|
---|
[bd41ac52] | 173 | thread_usleep(SEC2USEC(period));
|
---|
[582a0b8] | 174 | sec -= period;
|
---|
| 175 | }
|
---|
| 176 | }
|
---|
| 177 |
|
---|
[afbe96a] | 178 | /** @}
|
---|
[b2951e2] | 179 | */
|
---|