1 #include "fosa_threads_and_signals.h"
2 #include "fosa_clocks_and_timers.h"
3 #include "fosa_mutexes_and_condvars.h"
4 #include "fosa_app_def_sched.h"
8 //#include <time.h> // for nanosleep
11 #define printf rtl_printf
12 void * thread_code(void *arg) {
13 struct timespec req={.tv_sec=1, .tv_nsec=0};
14 printf("Thread executing\n");
16 printf("Thread terminating\n");
20 /////////////////////////////////////////////////////////////
21 // Simple test program for FOSA
23 // It just checks that the different functions can be called
24 // and that they return appropriate values
25 /////////////////////////////////////////////////////////////
27 void *main_app(void *args) {
28 //////////////////////////////////
29 // Test clock functions
30 //////////////////////////////////
32 printf("--------------------------------------------------\n");
33 printf("test get_time\n");
35 struct timespec current_time;
38 fosa_clock_id_t cpu_clock;
40 err=fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
41 printf("fosa_clock_get_time for CLOCK_REALTIME sec=%d nsec=%d err=%d\n",
42 current_time.tv_sec, current_time.tv_nsec,err);
44 fosa_thread_get_cputime_clock(fosa_thread_self(), &cpu_clock);
45 err=fosa_clock_get_time(cpu_clock, ¤t_time);
46 printf("fosa_clock_get_time for CPU-time clock sec=%d nsec=%d err=%d\n",
47 current_time.tv_sec, current_time.tv_nsec,err);
50 /////////////////////////////////////////////
51 // Test thread ids, attributes and creation
52 ////////////////////////////////////////////
55 printf("--------------------------------------------------\n");
56 printf("test thread ids and thread creation\n");
59 struct timespec req={.tv_sec=2, .tv_nsec=0};
60 frsh_thread_id_t tid1=fosa_thread_self();
61 frsh_thread_id_t tid2=fosa_thread_self();
62 printf("equal thread comparison=%d\n",fosa_thread_equal(tid1,tid2));
64 frsh_thread_attr_t th_attr;
66 err=frsh_thread_attr_init(&th_attr);
67 printf("thread attributes object initialized, err=%d\n",err);
69 err=frsh_thread_attr_set_stacksize(&th_attr,40000);
70 printf("thread attr set stack size to 40000, err=%d\n",err);
72 err=frsh_thread_attr_get_stacksize(&th_attr,&stsize);
73 printf("thread attr get stack size=%d, err=%d\n",stsize,err);
75 err=fosa_thread_attr_set_prio(&th_attr,27);
76 printf("thread attr set prio to 27, err=%d\n",err);
78 err=fosa_thread_attr_get_prio(&th_attr,&prio);
79 printf("thread attr get prio=%d, err=%d\n",prio,err);
81 err=fosa_thread_create (&tid2, &th_attr, thread_code, NULL);
82 printf("creating thread with default attributes err=%d\n",err);
86 err=frsh_thread_attr_destroy(&th_attr);
87 printf("thread attributes object destroyed, err=%d\n",err);
89 //////////////////////////////////
91 //////////////////////////////////
93 printf("--------------------------------------------------\n");
94 printf("test signals\n");
96 frsh_signal_t received;
97 frsh_signal_info_t sigvalue, value_received;
98 struct timespec timeout;
99 frsh_signal_t sig=FOSA_SIGNAL_MIN+1;
100 frsh_signal_t timer_sig=FOSA_SIGNAL_MIN+3;
101 frsh_signal_t siglist[2];
104 siglist[1]=timer_sig;
109 sigvalue.sival_int=55;
111 err=fosa_set_accepted_signals(siglist,2);
112 printf("two signals in set of accepted signals, err=%d\n",err);
114 err=fosa_signal_timedwait(siglist,1,&received,&value_received,&timeout);
115 printf("timed wait not implemented; timeoutcode=%d\n",err);
117 err=fosa_signal_queue(sig, sigvalue,fosa_thread_self());
118 printf("signal queued with value 55, err=%d\n",err);
120 err=fosa_signal_wait(siglist,1,&received, &value_received);
121 printf("timeoutcode=%d signal received=%d value=%d\n",
122 err,received,value_received.sival_int);
125 //////////////////////////////////
126 // Test timers and signals
127 //////////////////////////////////
129 printf("--------------------------------------------------\n");
130 printf("test timers and signals\n");
132 frsh_signal_info_t timer_info;
133 fosa_timer_id_t timerid;
134 struct timespec timerval, remaining_time;
136 timer_info.sival_int=88;
138 timerval.tv_nsec=300000000;
141 err=fosa_timer_create
142 (FOSA_CLOCK_REALTIME, timer_sig, timer_info,&timerid);
143 printf("timer created, err=%d\n",err);
145 err=fosa_timer_arm(timerid,false,&timerval);
146 printf("timer armed for 1.3 secs, err=%d\n",err);
148 fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
149 printf("current time sec=%d nsec=%d\n",
150 current_time.tv_sec, current_time.tv_nsec);
151 printf("wait for timer to expire...\n");
153 siglist[0]=timer_sig;
154 err=fosa_signal_wait(siglist,1,&received, &value_received);
155 printf("timeoutcode=%d signal received=%d value=%d\n",
156 err,received,value_received.sival_int);
158 fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
159 printf("current time sec=%d nsec=%d\n",
160 current_time.tv_sec, current_time.tv_nsec);
164 err=fosa_timer_arm(timerid,false,&timerval);
165 printf("timer armed for 6 secs, err=%d\n",err);
168 printf("sleeping 1 second\n");
169 nanosleep(&timerval, NULL);
171 err=fosa_timer_get_remaining_time(timerid, &remaining_time);
172 printf("timer remaining time sec=%d nsec=%d, err=%d\n",
173 remaining_time.tv_sec, remaining_time.tv_nsec, err);
175 printf("sleeping 1 second\n");
176 nanosleep(&timerval, NULL);
178 err=fosa_timer_disarm(timerid,&remaining_time);
179 printf("timer disarmed, remaining time sec=%d nsec=%d, err=%d\n",
180 remaining_time.tv_sec, remaining_time.tv_nsec, err);
182 err=fosa_timer_get_remaining_time(timerid, &remaining_time);
183 printf("timer remaining time after disarm (0?) sec=%d nsec=%d, err=%d\n",
184 remaining_time.tv_sec, remaining_time.tv_nsec, err);
186 fosa_timer_delete(timerid);
189 //////////////////////////////////
190 // Test thread-specific data
191 //////////////////////////////////
193 printf("--------------------------------------------------\n");
194 printf("test thread-specific data\n");
198 frsh_thread_id_t tid=fosa_thread_self();
200 err=fosa_key_create(&key);
201 printf("key created=%d. err=%d\n",key,err);
203 fosa_thread_set_specific_data (key, tid, (void *) (&value));
204 printf("specific data set to 333. err=%d\n",err);
206 fosa_thread_get_specific_data (key, tid, &obtained);
207 printf("obtained thread specific data=%d\n",*((int *)obtained));
210 //////////////////////////////////
212 //////////////////////////////////
214 printf("--------------------------------------------------\n");
215 printf("test priorities\n");
218 err=fosa_thread_set_prio(fosa_thread_self(),14);
219 printf("priority set to 14. err=%d\n",err);
221 err=fosa_thread_get_prio(fosa_thread_self(),&prio);
222 printf("prio=%d. err=%d\n",prio,err);
225 //////////////////////////////////
227 //////////////////////////////////
229 printf("--------------------------------------------------\n");
230 printf("test mutexes\n");
235 err=fosa_mutex_init(&lock,24);
236 printf("mutex initialized with ceiling 24. err=%d\n",err);
238 err=fosa_mutex_set_prioceiling(&lock,24,&old);
239 printf("mutex priority ceiling changed to 24. old=%d. err=%d\n",old,err);
241 err=fosa_mutex_get_prioceiling(&lock,&old);
242 printf("mutex priority ceiling is=%d. err=%d\n",old,err);
244 err=fosa_mutex_lock(&lock);
245 printf("mutex locked. err=%d\n",err);
247 err=fosa_mutex_unlock(&lock);
248 printf("mutex unlocked. err=%d\n",err);
250 err=fosa_mutex_trylock(&lock);
251 printf("mutex try locked. err=%d\n",err);
253 err=fosa_mutex_unlock(&lock);
254 printf("mutex unlocked. err=%d\n",err);
256 //////////////////////////////////
257 // Test Condition variables
258 //////////////////////////////////
260 printf("--------------------------------------------------\n");
261 printf("test condition variables\n");
265 err=fosa_cond_init(&cond);
266 printf("condvar initialized. err=%d\n",err);
268 err=fosa_cond_signal(&cond);
269 printf("cond signalled. err=%d\n",err);
271 err=fosa_cond_broadcast(&cond);
272 printf("cond broadcast. err=%d\n",err);
274 fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
275 printf("current time sec=%d nsec=%d\n",
276 current_time.tv_sec, current_time.tv_nsec);
278 current_time.tv_sec=current_time.tv_sec+2;
280 fosa_mutex_lock(&lock);
281 err=fosa_cond_timedwait(&cond,&lock,¤t_time);
282 fosa_mutex_unlock(&lock);
283 printf("cond timedwait with timeout=2 sec. err=%d\n",err);
285 fosa_clock_get_time(FOSA_CLOCK_REALTIME, ¤t_time);
286 printf("current time sec=%d nsec=%d\n",
287 current_time.tv_sec, current_time.tv_nsec);
289 err=fosa_mutex_destroy(&lock);
290 printf("mutex destroyed. err=%d\n",err);
292 err=fosa_cond_destroy(&cond);
293 printf("cond destroyed. err=%d\n",err);
295 ////////////////////////////////////////
296 // Test Application-defined scheduling
297 ///////////////////////////////////////
299 printf("--------------------------------------------------\n");
300 printf("test application-defined scheduling\n");
302 frsh_thread_attr_t th1_attr;
305 err=frsh_thread_attr_init(&th1_attr);
306 printf("thread attributes object initialized, err=%d\n",err);
308 err=fosa_thread_attr_set_appscheduled(&th1_attr,true);
309 printf("thread attr set appsched, err=%d\n",err);
311 err=fosa_thread_attr_get_appscheduled(&th1_attr,&is_appsched);
312 printf("thread attr get appsched=%d, err=%d\n",is_appsched,err);
318 static pthread_t main_thread;
320 int init_module (void) {
321 return pthread_create(&main_thread, 0, main_app, 0);
324 void cleanup_module(void) {
325 pthread_delete_np(main_thread);