2008-03-01 03:45:59 +03:00
|
|
|
#include <sys/thread.h>
|
2008-04-11 21:03:57 +04:00
|
|
|
#include <sys/kmem.h>
|
2008-02-26 23:36:04 +03:00
|
|
|
|
2008-04-21 21:29:47 +04:00
|
|
|
#ifdef DEBUG_SUBSYSTEM
|
|
|
|
#undef DEBUG_SUBSYSTEM
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define DEBUG_SUBSYSTEM S_THREAD
|
|
|
|
|
2008-02-26 23:36:04 +03:00
|
|
|
/*
|
|
|
|
* Thread interfaces
|
|
|
|
*/
|
|
|
|
typedef struct thread_priv_s {
|
|
|
|
unsigned long tp_magic; /* Magic */
|
2008-05-12 22:54:08 +04:00
|
|
|
int tp_name_size; /* Name size */
|
|
|
|
char *tp_name; /* Name (without _thread suffix) */
|
2008-02-26 23:36:04 +03:00
|
|
|
void (*tp_func)(void *); /* Registered function */
|
|
|
|
void *tp_args; /* Args to be passed to function */
|
|
|
|
size_t tp_len; /* Len to be passed to function */
|
|
|
|
int tp_state; /* State to start thread at */
|
|
|
|
pri_t tp_pri; /* Priority to start threat at */
|
|
|
|
} thread_priv_t;
|
|
|
|
|
2008-02-27 22:09:51 +03:00
|
|
|
static int
|
2008-02-26 23:36:04 +03:00
|
|
|
thread_generic_wrapper(void *arg)
|
|
|
|
{
|
|
|
|
thread_priv_t *tp = (thread_priv_t *)arg;
|
|
|
|
void (*func)(void *);
|
|
|
|
void *args;
|
|
|
|
|
2008-04-21 21:29:47 +04:00
|
|
|
ASSERT(tp->tp_magic == TP_MAGIC);
|
2008-02-26 23:36:04 +03:00
|
|
|
func = tp->tp_func;
|
|
|
|
args = tp->tp_args;
|
|
|
|
set_current_state(tp->tp_state);
|
2008-04-11 21:03:57 +04:00
|
|
|
set_user_nice((kthread_t *)get_current(), PRIO_TO_NICE(tp->tp_pri));
|
2008-05-12 22:54:08 +04:00
|
|
|
kmem_free(tp->tp_name, tp->tp_name_size);
|
|
|
|
kmem_free(tp, sizeof(thread_priv_t));
|
2008-02-26 23:36:04 +03:00
|
|
|
|
|
|
|
if (func)
|
|
|
|
func(args);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
__thread_exit(void)
|
|
|
|
{
|
2008-04-21 21:29:47 +04:00
|
|
|
ENTRY;
|
|
|
|
EXIT;
|
2008-04-04 08:44:16 +04:00
|
|
|
do_exit(0);
|
2008-04-21 21:29:47 +04:00
|
|
|
/* Unreachable */
|
2008-02-26 23:36:04 +03:00
|
|
|
}
|
2008-02-27 22:09:51 +03:00
|
|
|
EXPORT_SYMBOL(__thread_exit);
|
2008-02-26 23:36:04 +03:00
|
|
|
|
|
|
|
/* thread_create() may block forever if it cannot create a thread or
|
|
|
|
* allocate memory. This is preferable to returning a NULL which Solaris
|
|
|
|
* style callers likely never check for... since it can't fail. */
|
|
|
|
kthread_t *
|
2008-03-10 22:25:20 +03:00
|
|
|
__thread_create(caddr_t stk, size_t stksize, thread_func_t func,
|
2008-04-04 08:44:16 +04:00
|
|
|
const char *name, void *args, size_t len, int *pp,
|
|
|
|
int state, pri_t pri)
|
2008-02-26 23:36:04 +03:00
|
|
|
{
|
2008-04-11 21:03:57 +04:00
|
|
|
thread_priv_t *tp;
|
2008-02-26 23:36:04 +03:00
|
|
|
DEFINE_WAIT(wait);
|
2008-04-04 08:44:16 +04:00
|
|
|
struct task_struct *tsk;
|
2008-05-12 22:54:08 +04:00
|
|
|
char *p;
|
2008-04-21 21:29:47 +04:00
|
|
|
ENTRY;
|
2008-02-26 23:36:04 +03:00
|
|
|
|
|
|
|
/* Option pp is simply ignored */
|
|
|
|
/* Variable stack size unsupported */
|
2008-04-21 21:29:47 +04:00
|
|
|
ASSERT(stk == NULL);
|
2008-02-26 23:36:04 +03:00
|
|
|
|
2008-04-11 21:03:57 +04:00
|
|
|
tp = kmem_alloc(sizeof(thread_priv_t), KM_SLEEP);
|
|
|
|
if (tp == NULL)
|
2008-04-21 21:29:47 +04:00
|
|
|
RETURN(NULL);
|
2008-02-26 23:36:04 +03:00
|
|
|
|
2008-04-11 21:03:57 +04:00
|
|
|
tp->tp_magic = TP_MAGIC;
|
2008-05-12 22:54:08 +04:00
|
|
|
tp->tp_name_size = strlen(name) + 1;
|
|
|
|
|
|
|
|
tp->tp_name = kmem_alloc(tp->tp_name_size, KM_SLEEP);
|
|
|
|
if (tp->tp_name == NULL) {
|
|
|
|
kmem_free(tp, sizeof(thread_priv_t));
|
|
|
|
RETURN(NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
strncpy(tp->tp_name, name, tp->tp_name_size);
|
|
|
|
|
|
|
|
/* Strip trailing "_thread" from passed name which will be the func
|
|
|
|
* name since the exposed API has no parameter for passing a name.
|
|
|
|
*/
|
|
|
|
p = strstr(tp->tp_name, "_thread");
|
|
|
|
if (p)
|
|
|
|
p[0] = '\0';
|
|
|
|
|
2008-04-11 21:03:57 +04:00
|
|
|
tp->tp_func = func;
|
|
|
|
tp->tp_args = args;
|
|
|
|
tp->tp_len = len;
|
|
|
|
tp->tp_state = state;
|
|
|
|
tp->tp_pri = pri;
|
2008-02-26 23:36:04 +03:00
|
|
|
|
2008-05-12 22:54:08 +04:00
|
|
|
tsk = kthread_create(thread_generic_wrapper, (void *)tp, tp->tp_name);
|
2008-04-04 08:44:16 +04:00
|
|
|
if (IS_ERR(tsk)) {
|
2008-04-21 21:29:47 +04:00
|
|
|
CERROR("Failed to create thread: %ld\n", PTR_ERR(tsk));
|
|
|
|
RETURN(NULL);
|
2008-04-04 08:44:16 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
wake_up_process(tsk);
|
2008-04-21 21:29:47 +04:00
|
|
|
RETURN((kthread_t *)tsk);
|
2008-02-26 23:36:04 +03:00
|
|
|
}
|
2008-02-27 22:09:51 +03:00
|
|
|
EXPORT_SYMBOL(__thread_create);
|