fault/fm-common/sources/fmThread.cpp
Dean Troyer 6cd8940170 StarlingX open source release updates
Signed-off-by: Dean Troyer <dtroyer@gmail.com>
2018-05-31 07:36:00 -07:00

98 lines
1.8 KiB
C++

//
// Copyright (c) 2014 Wind River Systems, Inc.
//
// SPDX-License-Identifier: Apache-2.0
//
#include <stdio.h>
#include <pthread.h>
#include <unistd.h>
#include <string.h>
#include <errno.h>
#include "fmThread.h"
#include "fmLog.h"
struct thread_struct {
FmThreadFunctionT fn;
void *cntx;
};
static void * ThreadProcL(void * lpParameter ) {
thread_struct * p = (thread_struct *) lpParameter;
p->fn(p->cntx);
delete p;
return 0;
}
#define FM_MSEC_PER_SEC 1000
#define FM_NSEC_PER_MILSEC 1000000
static void our_sleep(unsigned int msec) {
struct timespec req;
struct timespec left;
memset(&left,0,sizeof(left));
req.tv_sec = msec / FM_MSEC_PER_SEC;
req.tv_nsec = (msec % FM_MSEC_PER_SEC) * FM_NSEC_PER_MILSEC;
while (nanosleep(&req,&left)==-1 && errno==EINTR) {
req = left;
}
}
extern "C" {
bool fmCreateThread(FmThreadFunctionT fn, void *usrData) {
int rt = 0;
pthread_t p_thread;
pthread_attr_t attr;
//Initialize the thread attributes with the default values
rt =pthread_attr_init(&attr);
if (rt != 0){
FM_ERROR_LOG("Initialize the thread attributes failed:error=%d",rt);
return false;
}
// could change the default values here
rt =pthread_attr_setstacksize(&attr, FM_THREAD_STACK_SIZE);
if (rt != 0){
FM_ERROR_LOG("pthread_attr_setstacksize failed:error=%d",rt);
return false;
}
thread_struct * p = new thread_struct;
if (p == NULL){
FM_ERROR_LOG("Can't allocate the thread struct");
return false;
}
p->fn = fn;
p->cntx = usrData;
rt= pthread_create(&p_thread,&attr,ThreadProcL,p);
if (rt != 0){
FM_ERROR_LOG("Failed to create the thread:error=%d",rt);
delete p;
return false;
}
return true;
}
bool fmThreadSleep(unsigned int msec) {
our_sleep(msec);
return true;
}
}