--- /dev/null
+#include "fosa_threads_and_signals.h"
+#include "fosa_clocks_and_timers.h"
+#include "fosa_mutexes_and_condvars.h"
+#include "fosa_app_def_sched.h"
+#include <rtl.h>
+//#include <unistd.h>
+//#include <stdio.h>
+//#include <time.h> // for nanosleep
+
+
+#define printf rtl_printf
+void * thread_code(void *arg) {
+ struct timespec req={.tv_sec=1, .tv_nsec=0};
+ printf("Thread executing\n");
+ nanosleep(&req, 0);
+ printf("Thread terminating\n");
+ return NULL;
+}
+
+/////////////////////////////////////////////////////////////
+// Simple test program for FOSA
+//
+// It just checks that the different functions can be called
+// and that they return appropriate values
+/////////////////////////////////////////////////////////////
+
+int init_module(void) {
+ //////////////////////////////////
+ // Test clock functions
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test get_time\n");
+
+ struct timespec current_time;
+ int err;
+ void * obtained;
+ fosa_clock_id_t cpu_clock;
+
+ err=fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
+ printf("fosa_clock_get_time for CLOCK_REALTIME sec=%d nsec=%d err=%d\n",
+ current_time.tv_sec, current_time.tv_nsec,err);
+
+ fosa_thread_get_cputime_clock(fosa_thread_self(), &cpu_clock);
+ err=fosa_clock_get_time(cpu_clock, ¤t_time);
+ printf("fosa_clock_get_time for CPU-time clock sec=%d nsec=%d err=%d\n",
+ current_time.tv_sec, current_time.tv_nsec,err);
+
+
+ /////////////////////////////////////////////
+ // Test thread ids, attributes and creation
+ ////////////////////////////////////////////
+
+
+ printf("--------------------------------------------------\n");
+ printf("test thread ids and thread creation\n");
+
+ int stsize, prio;
+ struct timespec req={.tv_sec=2, .tv_nsec=0};
+ frsh_thread_id_t tid1=fosa_thread_self();
+ frsh_thread_id_t tid2=fosa_thread_self();
+ printf("equal thread comparison=%d\n",fosa_thread_equal(tid1,tid2));
+
+ frsh_thread_attr_t th_attr;
+
+ err=frsh_thread_attr_init(&th_attr);
+ printf("thread attributes object initialized, err=%d\n",err);
+
+ err=frsh_thread_attr_set_stacksize(&th_attr,40000);
+ printf("thread attr set stack size to 40000, err=%d\n",err);
+
+ err=frsh_thread_attr_get_stacksize(&th_attr,&stsize);
+ printf("thread attr get stack size=%d, err=%d\n",stsize,err);
+
+ err=fosa_thread_attr_set_prio(&th_attr,27);
+ printf("thread attr set prio to 27, err=%d\n",err);
+
+ err=fosa_thread_attr_get_prio(&th_attr,&prio);
+ printf("thread attr get prio=%d, err=%d\n",prio,err);
+
+ err=fosa_thread_create (&tid2, &th_attr, thread_code, NULL);
+ printf("creating thread with default attributes err=%d\n",err);
+
+ nanosleep(&req,0);
+
+ err=frsh_thread_attr_destroy(&th_attr);
+ printf("thread attributes object destroyed, err=%d\n",err);
+
+ //////////////////////////////////
+ // Test signals
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test signals\n");
+
+ frsh_signal_t received;
+ frsh_signal_info_t sigvalue, value_received;
+ struct timespec timeout;
+ frsh_signal_t sig=FOSA_SIGNAL_MIN+1;
+ frsh_signal_t timer_sig=FOSA_SIGNAL_MIN+3;
+ frsh_signal_t siglist[2];
+
+ siglist[0]=sig;
+ siglist[1]=timer_sig;
+
+ timeout.tv_sec=1;
+ timeout.tv_nsec=0;
+
+ sigvalue.sival_int=55;
+
+ err=fosa_set_accepted_signals(siglist,2);
+ printf("two signals in set of accepted signals, err=%d\n",err);
+
+ err=fosa_signal_timedwait(siglist,1,&received,&value_received,&timeout);
+ printf("timed wait not implemented; timeoutcode=%d\n",err);
+
+ err=fosa_signal_queue(sig, sigvalue,fosa_thread_self());
+ printf("signal queued with value 55, err=%d\n",err);
+
+ err=fosa_signal_wait(siglist,1,&received, &value_received);
+ printf("timeoutcode=%d signal received=%d value=%d\n",
+ err,received,value_received.sival_int);
+
+
+ //////////////////////////////////
+ // Test timers and signals
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test timers and signals\n");
+
+ frsh_signal_info_t timer_info;
+ fosa_timer_id_t timerid;
+ struct timespec timerval, remaining_time;
+
+ timer_info.sival_int=88;
+ timerval.tv_sec=1;
+ timerval.tv_nsec=300000000;
+
+
+ err=fosa_timer_create
+ (FOSA_CLOCK_REALTIME, timer_sig, timer_info,&timerid);
+ printf("timer created, err=%d\n",err);
+
+ err=fosa_timer_arm(timerid,false,&timerval);
+ printf("timer armed for 1.3 secs, err=%d\n",err);
+
+ fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
+ printf("current time sec=%d nsec=%d\n",
+ current_time.tv_sec, current_time.tv_nsec);
+ printf("wait for timer to expire...\n");
+
+ siglist[0]=timer_sig;
+ err=fosa_signal_wait(siglist,1,&received, &value_received);
+ printf("timeoutcode=%d signal received=%d value=%d\n",
+ err,received,value_received.sival_int);
+
+ fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
+ printf("current time sec=%d nsec=%d\n",
+ current_time.tv_sec, current_time.tv_nsec);
+
+ timerval.tv_sec=6;
+ timerval.tv_nsec=0;
+ err=fosa_timer_arm(timerid,false,&timerval);
+ printf("timer armed for 6 secs, err=%d\n",err);
+
+ timerval.tv_sec=1;
+ printf("sleeping 1 second\n");
+ nanosleep(&timerval, NULL);
+
+ err=fosa_timer_get_remaining_time(timerid, &remaining_time);
+ printf("timer remaining time sec=%d nsec=%d, err=%d\n",
+ remaining_time.tv_sec, remaining_time.tv_nsec, err);
+
+ printf("sleeping 1 second\n");
+ nanosleep(&timerval, NULL);
+
+ err=fosa_timer_disarm(timerid,&remaining_time);
+ printf("timer disarmed, remaining time sec=%d nsec=%d, err=%d\n",
+ remaining_time.tv_sec, remaining_time.tv_nsec, err);
+
+ err=fosa_timer_get_remaining_time(timerid, &remaining_time);
+ printf("timer remaining time after disarm (0?) sec=%d nsec=%d, err=%d\n",
+ remaining_time.tv_sec, remaining_time.tv_nsec, err);
+
+ fosa_timer_delete(timerid);
+
+
+ //////////////////////////////////
+ // Test thread-specific data
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test thread-specific data\n");
+
+ int value=333;
+ int key;
+ frsh_thread_id_t tid=fosa_thread_self();
+
+ err=fosa_key_create(&key);
+ printf("key created=%d. err=%d\n",key,err);
+
+ fosa_thread_set_specific_data (key, tid, (void *) (&value));
+ printf("specific data set to 333. err=%d\n",err);
+
+ fosa_thread_get_specific_data (key, tid, &obtained);
+ printf("obtained thread specific data=%d\n",*((int *)obtained));
+
+
+ //////////////////////////////////
+ // Test Priorities
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test priorities\n");
+
+
+ err=fosa_thread_set_prio(fosa_thread_self(),14);
+ printf("priority set to 14. err=%d\n",err);
+
+ err=fosa_thread_get_prio(fosa_thread_self(),&prio);
+ printf("prio=%d. err=%d\n",prio,err);
+
+
+ //////////////////////////////////
+ // Test Mutexes
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test mutexes\n");
+
+ frsh_mutex_t lock;
+ int old;
+
+ err=fosa_mutex_init(&lock,24);
+ printf("mutex initialized with ceiling 24. err=%d\n",err);
+
+ err=fosa_mutex_set_prioceiling(&lock,24,&old);
+ printf("mutex priority ceiling changed to 24. old=%d. err=%d\n",old,err);
+
+ err=fosa_mutex_get_prioceiling(&lock,&old);
+ printf("mutex priority ceiling is=%d. err=%d\n",old,err);
+
+ err=fosa_mutex_lock(&lock);
+ printf("mutex locked. err=%d\n",err);
+
+ err=fosa_mutex_unlock(&lock);
+ printf("mutex unlocked. err=%d\n",err);
+
+ err=fosa_mutex_trylock(&lock);
+ printf("mutex try locked. err=%d\n",err);
+
+ err=fosa_mutex_unlock(&lock);
+ printf("mutex unlocked. err=%d\n",err);
+
+ //////////////////////////////////
+ // Test Condition variables
+ //////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test condition variables\n");
+
+ fosa_cond_t cond;
+
+ err=fosa_cond_init(&cond);
+ printf("condvar initialized. err=%d\n",err);
+
+ err=fosa_cond_signal(&cond);
+ printf("cond signalled. err=%d\n",err);
+
+ err=fosa_cond_broadcast(&cond);
+ printf("cond broadcast. err=%d\n",err);
+
+ fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
+ printf("current time sec=%d nsec=%d\n",
+ current_time.tv_sec, current_time.tv_nsec);
+
+ current_time.tv_sec=current_time.tv_sec+2;
+
+ fosa_mutex_lock(&lock);
+ err=fosa_cond_timedwait(&cond,&lock,¤t_time);
+ fosa_mutex_unlock(&lock);
+ printf("cond timedwait with timeout=2 sec. err=%d\n",err);
+
+ fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
+ printf("current time sec=%d nsec=%d\n",
+ current_time.tv_sec, current_time.tv_nsec);
+
+ err=fosa_mutex_destroy(&lock);
+ printf("mutex destroyed. err=%d\n",err);
+
+ err=fosa_cond_destroy(&cond);
+ printf("cond destroyed. err=%d\n",err);
+
+ ////////////////////////////////////////
+ // Test Application-defined scheduling
+ ///////////////////////////////////////
+
+ printf("--------------------------------------------------\n");
+ printf("test application-defined scheduling\n");
+
+ frsh_thread_attr_t th1_attr;
+ bool is_appsched;
+
+ err=frsh_thread_attr_init(&th1_attr);
+ printf("thread attributes object initialized, err=%d\n",err);
+
+ err=fosa_thread_attr_set_appscheduled(&th1_attr,true);
+ printf("thread attr set appsched, err=%d\n",err);
+
+ err=fosa_thread_attr_get_appscheduled(&th1_attr,&is_appsched);
+ printf("thread attr get appsched=%d, err=%d\n",is_appsched,err);
+
+
+
+ return 0;
+
+}