/tmp/l4check/full_tree/trunk/l4/pkg/dde_linux/lib/src/sched.c

Go to the documentation of this file.

/* $Id: sched.c 24881 2006-02-13 16:11:13Z ch12 $ */
/*****************************************************************************/
/* (c) 2003 Technische Universitaet Dresden
 * This file is part of DROPS, which is distributed under the terms of the
 * GNU General Public License 2. Please see the COPYING file for details.
 */

/* L4 */
#include <l4/sys/syscalls.h>
#include <l4/thread/thread.h>
#include <l4/semaphore/semaphore.h>

#include <l4/dde_linux/dde.h>

/* Linux */
#include <linux/sched.h>

/* local */
#include "internal.h"
#include "__config.h"
#include "fastcall.h"

static inline int try_to_wake_up(struct task_struct *p, int synchronous)
{
  p->state = TASK_RUNNING;

  /* unlock process' self_lock if it's not already running (i.e. current) */
  /* XXX what about other processes running? */
  if (current != p)
    l4semaphore_up(&p->dde_sem);

  return 1;
}

inline int FASTCALL(wake_up_process(struct task_struct *p))
{
  return try_to_wake_up(p, 0);
}

static void process_timeout(unsigned long __data)
{
  struct task_struct *p = (struct task_struct *) __data;

  wake_up_process(p);
}

signed long FASTCALL(schedule_timeout(signed long timeout))
{
  struct timer_list timer;
  unsigned long expire;

  switch (timeout)
    {
    case MAX_SCHEDULE_TIMEOUT:
      /*
       * These two special cases are useful to be comfortable
       * in the caller. Nothing more. We could take
       * MAX_SCHEDULE_TIMEOUT from one of the negative value
       * but I' d like to return a valid offset (>=0) to allow
       * the caller to do everything it want with the retval.
       */
      schedule();
      goto out;
    default:
      /*
       * Another bit of PARANOID. Note that the retval will be
       * 0 since no piece of kernel is supposed to do a check
       * for a negative retval of schedule_timeout() (since it
       * should never happens anyway). You just have the printk()
       * that will tell you if something is gone wrong and where.
       */
      if (timeout < 0)
        {
          LOG_Error("schedule_timeout: wrong timeout "
                    "value %lx", timeout);
          current->state = TASK_RUNNING;
          goto out;
        }
    }

  expire = timeout + jiffies;

  init_timer(&timer);
  timer.expires = expire;
  timer.data = (unsigned long) current;
  timer.function = process_timeout;

  add_timer(&timer);
  schedule();
  del_timer_sync(&timer);

  timeout = expire - jiffies;

out:
  return timeout < 0 ? 0 : timeout;
}

void schedule(void)
{

  switch (current->state)
    {
    case TASK_RUNNING:
      /* release CPU on any way */
#if SCHED_YIELD_OPT
      l4thread_usleep(SCHED_YIELD_TO);
#else
      l4_yield();
#endif
      break;

    case TASK_UNINTERRUPTIBLE:
    case TASK_INTERRUPTIBLE:
      /* lock yourself on current semaphore */
      l4semaphore_down(&current->dde_sem);
      break;

    default:
      Panic("current->state unknown (%ld)\n", current->state);
    }
}

static inline void __wake_up_common(wait_queue_head_t * q, unsigned int mode,
                                    int nr_exclusive, const int sync)
{
  struct list_head *tmp, *head;
  struct task_struct *p;

  CHECK_MAGIC_WQHEAD(q);
  head = &q->task_list;
  WQ_CHECK_LIST_HEAD(head);
  tmp = head->next;
  while (tmp != head)
    {
      unsigned int state;
      wait_queue_t *curr = list_entry(tmp, wait_queue_t, task_list);

      tmp = tmp->next;
      CHECK_MAGIC(curr->__magic);
      p = curr->task;
      state = p->state;
      if (state & mode)
        {
          WQ_NOTE_WAKER(curr);
          if (try_to_wake_up(p, sync) && curr->flags && !--nr_exclusive)
            break;
        }
    }
}

void FASTCALL(__wake_up(wait_queue_head_t * q, unsigned int mode, int nr))
{
  if (q)
    {
      unsigned long flags;
      wq_read_lock_irqsave(&q->lock, flags);
      __wake_up_common(q, mode, nr, 0);
      wq_read_unlock_irqrestore(&q->lock, flags);
    }
}

void FASTCALL(__wake_up_sync(wait_queue_head_t * q, unsigned int mode, int nr))
{
  if (q)
    {
      unsigned long flags;
      wq_read_lock_irqsave(&q->lock, flags);
      __wake_up_common(q, mode, nr, 1);
      wq_read_unlock_irqrestore(&q->lock, flags);
    }
}

#define SLEEP_ON_VAR                         \
        unsigned long flags;                 \
        wait_queue_t wait;                   \
        init_waitqueue_entry(&wait, current);

#define SLEEP_ON_HEAD                          \
        wq_write_lock_irqsave(&q->lock,flags); \
        __add_wait_queue(q, &wait);            \
        wq_write_unlock(&q->lock);

#define SLEEP_ON_TAIL                              \
        wq_write_lock_irq(&q->lock);               \
        __remove_wait_queue(q, &wait);             \
        wq_write_unlock_irqrestore(&q->lock,flags);

void FASTCALL(interruptible_sleep_on(wait_queue_head_t * q))
{
  SLEEP_ON_VAR current->state = TASK_INTERRUPTIBLE;

  SLEEP_ON_HEAD schedule();
  SLEEP_ON_TAIL
}

long FASTCALL(interruptible_sleep_on_timeout(wait_queue_head_t * q, long timeout))
{
  SLEEP_ON_VAR current->state = TASK_INTERRUPTIBLE;

  SLEEP_ON_HEAD timeout = schedule_timeout(timeout);
  SLEEP_ON_TAIL return timeout;
}

void FASTCALL(sleep_on(wait_queue_head_t * q))
{
  SLEEP_ON_VAR current->state = TASK_UNINTERRUPTIBLE;

  SLEEP_ON_HEAD schedule();
  SLEEP_ON_TAIL
}

long FASTCALL(sleep_on_timeout(wait_queue_head_t * q, long timeout))
{
  SLEEP_ON_VAR current->state = TASK_UNINTERRUPTIBLE;

  SLEEP_ON_HEAD timeout = schedule_timeout(timeout);
  SLEEP_ON_TAIL return timeout;
}

void daemonize(void) {
  LOGd(DEBUG_MSG, "dde: dummy daemonize() call");
}

void yield(void)
{
  set_current_state(TASK_RUNNING);
//      sys_sched_yield();
  schedule();
}

void __cond_resched(void)
{
  set_current_state(TASK_RUNNING);
  schedule();
}

---