34 lines
991 B
C++
34 lines
991 B
C++
#include "Semaphore.h"
|
|
#include "kernel/Globals.h"
|
|
|
|
void Semaphore::p() {
|
|
// Lock to allow deterministic operations on counter
|
|
this->lock.acquire();
|
|
|
|
if (this->counter > 0) {
|
|
// Semaphore can be acquired
|
|
this->counter = this->counter - 1;
|
|
this->lock.release();
|
|
} else {
|
|
// Block and manage thread in semaphore queue until it's woken up by v() again
|
|
this->waitQueue.enqueue(scheduler.get_active());
|
|
this->lock.release();
|
|
scheduler.block(); // Moves to next thread
|
|
}
|
|
}
|
|
|
|
void Semaphore::v() {
|
|
this->lock.acquire();
|
|
|
|
if (!this->waitQueue.isEmpty()) {
|
|
// Semaphore stays busy and unblocks next thread to work in critical section
|
|
Thread* next = (Thread*)this->waitQueue.dequeue();
|
|
this->lock.release();
|
|
scheduler.deblock(next);
|
|
} else {
|
|
// No more threads want to work so free semaphore
|
|
this->counter = this->counter + 1;
|
|
this->lock.release();
|
|
}
|
|
}
|