mirror of
https://git.rtems.org/rtems-libbsd/
synced 2025-05-13 23:19:24 +08:00
28ee86a9b0
Imported from Freescale Linux repository git://git.freescale.com/ppc/upstream/linux.git commit 2774c204cd8bfc56a200ff4dcdfc9cdf5b6fc161. Linux compatibility layer is partly from FreeBSD.
138 lines
4.0 KiB
C
138 lines
4.0 KiB
C
/*-
|
|
* Copyright (c) 2010 Isilon Systems, Inc.
|
|
* Copyright (c) 2010 iX Systems, Inc.
|
|
* Copyright (c) 2010 Panasas, Inc.
|
|
* Copyright (c) 2013, 2014 Mellanox Technologies, Ltd.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice unmodified, this list of conditions, and the following
|
|
* disclaimer.
|
|
* 2. 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.
|
|
*
|
|
* 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.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
#ifndef _LINUX_KTHREAD_H_
|
|
#define _LINUX_KTHREAD_H_
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/kthread.h>
|
|
#include <sys/sleepqueue.h>
|
|
|
|
#include <machine/rtems-bsd-thread.h>
|
|
|
|
#include <linux/slab.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/threads.h>
|
|
|
|
#define KTHREAD_LOCK(task) mtx_lock(&(task)->lock)
|
|
#define KTHREAD_UNLOCK(task) mtx_unlock(&(task)->lock)
|
|
|
|
static inline void
|
|
_kthread_fn(void *arg)
|
|
{
|
|
struct task_struct *task;
|
|
struct thread *c;
|
|
|
|
task = arg;
|
|
task_struct_set(curthread, task);
|
|
c = task->task_thread;
|
|
sleepq_lock(c);
|
|
while (task->state == TASK_DORMANT)
|
|
sleepq_wait(c, 0);
|
|
sleepq_release(c);
|
|
if (task->should_stop == 0)
|
|
task->task_ret = task->task_fn(task->task_data);
|
|
KTHREAD_LOCK(task);
|
|
task->should_stop = TASK_STOPPED;
|
|
wakeup(task);
|
|
KTHREAD_UNLOCK(task);
|
|
kthread_exit();
|
|
}
|
|
|
|
static inline struct task_struct *
|
|
_kthread_create(int (*threadfn)(void *data), void *data)
|
|
{
|
|
struct task_struct *task;
|
|
|
|
task = kzalloc(sizeof(*task), GFP_KERNEL);
|
|
task->task_fn = threadfn;
|
|
task->task_data = data;
|
|
mtx_init(&task->lock, "kthread", NULL, MTX_DEF);
|
|
|
|
return (task);
|
|
}
|
|
|
|
#define kthread_create(fn, data, fmt, ...) \
|
|
({ \
|
|
struct task_struct *_task; \
|
|
\
|
|
_task = _kthread_create((fn), (data)); \
|
|
if (kthread_add(_kthread_fn, _task, NULL, &_task->task_thread, \
|
|
0, 0, fmt, ## __VA_ARGS__)) { \
|
|
kfree(_task); \
|
|
_task = NULL; \
|
|
} else \
|
|
task_struct_set(_task->task_thread, _task); \
|
|
_task; \
|
|
})
|
|
|
|
#define kthread_should_stop() current->should_stop
|
|
|
|
static inline int
|
|
kthread_stop(struct task_struct *task)
|
|
{
|
|
|
|
KTHREAD_LOCK(task);
|
|
task->should_stop = TASK_SHOULD_STOP;
|
|
wake_up_process(task);
|
|
while (task->should_stop != TASK_STOPPED)
|
|
msleep(task, &task->lock, PWAIT, "kstop", hz);
|
|
KTHREAD_UNLOCK(task);
|
|
return task->task_ret;
|
|
}
|
|
|
|
static inline void
|
|
kthread_bind(struct task_struct *task, unsigned int cpu)
|
|
{
|
|
/* FIXME */
|
|
rtems_id task_id = rtems_bsd_get_task_id(task->task_thread);
|
|
rtems_id sched_id;
|
|
rtems_status_code sc;
|
|
rtems_task_priority prio;
|
|
|
|
sc = rtems_scheduler_ident(cpu, &sched_id);
|
|
if (sc != RTEMS_SUCCESSFUL)
|
|
panic("kthread_bind: scheduler ident");
|
|
|
|
sc = rtems_task_set_priority(task_id, RTEMS_CURRENT_PRIORITY, &prio);
|
|
if (sc != RTEMS_SUCCESSFUL)
|
|
panic("kthread_bind: get priority");
|
|
|
|
sc = rtems_task_set_scheduler(task_id, sched_id, prio);
|
|
if (sc != RTEMS_SUCCESSFUL)
|
|
panic("kthread_bind: set scheduler");
|
|
}
|
|
|
|
#endif /* _LINUX_KTHREAD_H_ */
|