source: rtems-libbsd/rtemsbsd/powerpc/include/linux/kthread.h @ 0de65a8

/*-
 * 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_ */