139 lines
2.6 KiB
C
139 lines
2.6 KiB
C
/*
|
|
* thread_linux.c
|
|
*
|
|
* Copyright 2013-2021 Michael Zillgith
|
|
*
|
|
* This file is part of Platform Abstraction Layer (libpal)
|
|
* for libiec61850, libmms, and lib60870.
|
|
*/
|
|
|
|
#include <pthread.h>
|
|
#include <semaphore.h>
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include "hal_thread.h"
|
|
#include "lib_memory.h"
|
|
|
|
|
|
struct sThread {
|
|
ThreadExecutionFunction function;
|
|
void* parameter;
|
|
pthread_t pthread;
|
|
int state;
|
|
bool autodestroy;
|
|
};
|
|
|
|
Semaphore
|
|
Semaphore_create(int initialValue)
|
|
{
|
|
Semaphore self = GLOBAL_MALLOC(sizeof(sem_t));
|
|
|
|
if(-1 ==sem_init((sem_t*) self, 0, initialValue))
|
|
{
|
|
fprintf(stderr, "Error creating semaphore: %s\n", strerror(errno));
|
|
GLOBAL_FREEMEM(self);
|
|
return NULL;
|
|
}
|
|
|
|
return self;
|
|
}
|
|
|
|
/* Wait until semaphore value is more than zero. Then decrease the semaphore value. */
|
|
void
|
|
Semaphore_wait(Semaphore self)
|
|
{
|
|
for(int i = 0; i < 16; i++)
|
|
{
|
|
if(0 == sem_wait((sem_t*) self))
|
|
{
|
|
return;
|
|
}
|
|
else
|
|
{
|
|
fprintf(stderr, "Error waiting for semaphore: cnt=%d, err:%s\n", i, strerror(errno));
|
|
}
|
|
}
|
|
}
|
|
|
|
void
|
|
Semaphore_post(Semaphore self)
|
|
{
|
|
for(int i = 0; i < 16; i++)
|
|
{
|
|
if(0 == sem_post((sem_t*) self))
|
|
{
|
|
return;
|
|
}
|
|
else
|
|
{
|
|
fprintf(stderr, "Error posting semaphore: cnt=%d, err:%s\n", i, strerror(errno));
|
|
}
|
|
}
|
|
}
|
|
|
|
void
|
|
Semaphore_destroy(Semaphore self)
|
|
{
|
|
sem_destroy((sem_t*) self);
|
|
GLOBAL_FREEMEM(self);
|
|
}
|
|
|
|
Thread
|
|
Thread_create(ThreadExecutionFunction function, void* parameter, bool autodestroy)
|
|
{
|
|
Thread thread = (Thread) GLOBAL_MALLOC(sizeof(struct sThread));
|
|
|
|
if (thread != NULL) {
|
|
thread->parameter = parameter;
|
|
thread->function = function;
|
|
thread->state = 0;
|
|
thread->autodestroy = autodestroy;
|
|
}
|
|
|
|
return thread;
|
|
}
|
|
|
|
static void*
|
|
destroyAutomaticThread(void* parameter)
|
|
{
|
|
Thread thread = (Thread) parameter;
|
|
|
|
thread->function(thread->parameter);
|
|
|
|
GLOBAL_FREEMEM(thread);
|
|
|
|
pthread_exit(NULL);
|
|
}
|
|
|
|
void
|
|
Thread_start(Thread thread)
|
|
{
|
|
if (thread->autodestroy == true) {
|
|
pthread_create(&thread->pthread, NULL, destroyAutomaticThread, thread);
|
|
pthread_detach(thread->pthread);
|
|
}
|
|
else
|
|
pthread_create(&thread->pthread, NULL, thread->function, thread->parameter);
|
|
|
|
thread->state = 1;
|
|
}
|
|
|
|
void
|
|
Thread_destroy(Thread thread)
|
|
{
|
|
if (thread->state == 1) {
|
|
pthread_join(thread->pthread, NULL);
|
|
}
|
|
|
|
GLOBAL_FREEMEM(thread);
|
|
}
|
|
|
|
void
|
|
Thread_sleep(int millies)
|
|
{
|
|
usleep(millies * 1000);
|
|
}
|
|
|