/**
 * kernel mutex implementation
 *
 * Copyright (C) 2010 Freie Universität Berlin
 *
 * This file subject to the terms and conditions of the GNU General Public
 * License. See the file LICENSE in the top level directory for more details.
 *
 * @ingroup kernel
 * @{
 * @file
 * @author Kaspar Schleiser <kaspar.schleiser@fu-berlin.de>
 * @}
 */

#include <stdio.h>
#include "mutex.h"
#include "atomic.h"
#include "queue.h"
#include "tcb.h"
#include "kernel.h"
#include "sched.h"
<<<<<<< HEAD
=======
#include <irq.h>
>>>>>>> master

//#define ENABLE_DEBUG
#include <debug.h>

int mutex_init(struct mutex_t* mutex) {
    mutex->val = 0;

    mutex->queue.priority = 0;
    mutex->queue.data = 0;
    mutex->queue.next = NULL;

    return 1;
}

int mutex_trylock(struct mutex_t* mutex) {
<<<<<<< HEAD
    return (atomic_set_return(&mutex->val, thread_pid ) == 0);
}

int prio() {
    return active_thread->priority;
}

int mutex_lock(struct mutex_t* mutex) {
   DEBUG("%s: trying to get mutex. val: %u\n", active_thread->name, mutex->val);

    if (atomic_set_return(&mutex->val,thread_pid) != 0) {
=======
    DEBUG("%s: trylocking to get mutex. val: %u\n", active_thread->name, mutex->val);
    return atomic_set_return(&mutex->val, 1 ) == 0;
}

int mutex_lock(struct mutex_t* mutex) {
    DEBUG("%s: trying to get mutex. val: %u\n", active_thread->name, mutex->val);

    if (atomic_set_return(&mutex->val,1) != 0) {
>>>>>>> master
        // mutex was locked.
        mutex_wait(mutex);
    }
    return 1;
}

<<<<<<< HEAD
void mutex_unlock(struct mutex_t* mutex, int yield) {
    DEBUG("%s: unlocking mutex. val: %u pid: %u\n", active_thread->name, mutex->val, thread_pid);
    int me_value;

    if (inISR()) {
        me_value = 0;
        yield = MUTEX_INISR;
    } else {
        me_value = thread_pid;
    }
                
    if (atomic_set_return(&mutex->val,0) != me_value ) {
        // there were waiters.
        mutex_wake_waiters(mutex, yield);
    }
}

void mutex_wait(struct mutex_t *mutex) {
    dINT();
=======
void mutex_wait(struct mutex_t *mutex) {
    int irqstate = disableIRQ();
>>>>>>> master
    DEBUG("%s: Mutex in use. %u\n", active_thread->name, mutex->val);
    if (mutex->val == 0) {
        // somebody released the mutex. return.
        mutex->val = thread_pid;
        DEBUG("%s: mutex_wait early out. %u\n", active_thread->name, mutex->val);
<<<<<<< HEAD
        eINT();
=======
        restoreIRQ(irqstate);
>>>>>>> master
        return;
    }

    sched_set_status((tcb*)active_thread, STATUS_MUTEX_BLOCKED);

    queue_node_t n;
    n.priority = (unsigned int) active_thread->priority;
    n.data = (unsigned int) active_thread;
    n.next = NULL;

<<<<<<< HEAD
    DEBUG("%s: Adding node to mutex queue: prio: %u data: %u\n", active_thread->name, n.priority, n.data);
=======
    DEBUG("%s: Adding node to mutex queue: prio: %u\n", active_thread->name, n.priority);
>>>>>>> master

    queue_priority_add(&(mutex->queue), &n);

    restoreIRQ(irqstate);

    thread_yield();

    /* we were woken up by scheduler. waker removed us from queue. we have the mutex now. */
}

<<<<<<< HEAD
void mutex_wake_waiters(struct mutex_t *mutex, int flags) {
    if ( ! (flags & MUTEX_INISR)) dINT();
    DEBUG("%s: waking up waiters.\n", active_thread->name);

    queue_node_t *next = queue_remove_head(&(mutex->queue));
    tcb* process = (tcb*)next->data;

    sched_set_status(process, STATUS_PENDING);

    if ( mutex->queue.next != NULL) {
        mutex->val = -1;
    } else {
        mutex->val = process->pid;
    }

    DEBUG("%s: waiters woken up.\n", active_thread->name);

    /* If called from process, reenable interrupts, yield if requested */
    if (! (flags & MUTEX_INISR)) {
        eINT();
        if (flags & MUTEX_YIELD) thread_yield();
    } else {
       sched_context_switch_request = 1; 
    }
=======
void mutex_unlock(struct mutex_t* mutex, int yield) {
    DEBUG("%s: unlocking mutex. val: %u pid: %u\n", active_thread->name, mutex->val, thread_pid);
    int irqstate = disableIRQ();
  
    if (mutex->val != 0) {
        if (mutex->queue.next) {
            queue_node_t *next = queue_remove_head(&(mutex->queue));
            tcb* process = (tcb*)next->data;
            DEBUG("%s: waking up waiter %s.\n", process->name);
            sched_set_status(process, STATUS_PENDING);

            sched_switch(active_thread->priority, process->priority, inISR());
        } else {
            mutex->val = 0;
        }
    }

    restoreIRQ(irqstate);
>>>>>>> master
}