1 //----------------------------------------------------------------------
2 // Copyright (C) 2006 - 2007 by the FRESCOR consortium:
4 // Universidad de Cantabria, SPAIN
5 // University of York, UK
6 // Scuola Superiore Sant'Anna, ITALY
7 // Kaiserslautern University, GERMANY
8 // Univ. Politecnica Valencia, SPAIN
9 // Czech Technical University in Prague, CZECH REPUBLIC
11 // Thales Communication S.A. FRANCE
12 // Visual Tools S.A. SPAIN
13 // Rapita Systems Ltd UK
16 // See http://www.frescor.org
18 // The FRESCOR project (FP6/2005/IST/5-034026) is funded
19 // in part by the European Union Sixth Framework Programme
20 // The European Union is not liable of any use that may be
24 // based on previous work (FSF) done in the FIRST project
26 // Copyright (C) 2005 Mälardalen University, SWEDEN
27 // Scuola Superiore S.Anna, ITALY
28 // Universidad de Cantabria, SPAIN
29 // University of York, UK
31 // This file is part of FOSA (Frsh Operating System Abstraction)
33 // FOSA is free software; you can redistribute it and/or modify it
34 // under terms of the GNU General Public License as published by the
35 // Free Software Foundation; either version 2, or (at your option) any
36 // later version. FOSA is distributed in the hope that it will be
37 // useful, but WITHOUT ANY WARRANTY; without even the implied warranty
38 // of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
39 // General Public License for more details. You should have received a
40 // copy of the GNU General Public License along with FOSA; see file
41 // COPYING. If not, write to the Free Software Foundation, 675 Mass Ave,
42 // Cambridge, MA 02139, USA.
44 // As a special exception, including FOSA header files in a file,
45 // instantiating FOSA generics or templates, or linking other files
46 // with FOSA objects to produce an executable application, does not
47 // by itself cause the resulting executable application to be covered
48 // by the GNU General Public License. This exception does not
49 // however invalidate any other reasons why the executable file might be
50 // covered by the GNU Public License.
51 // -----------------------------------------------------------------------
53 //==============================================
54 // ******** ****** ******** **********
55 // **///// /** ** **////// /** /**
56 // ** /** ** /** /** /**
57 // ******* /** ** /********* /**********
58 // **//// /** ** ////////** /**//////**
59 // ** /** ** /** /** /**
60 // ** /** ** ******** /** /**
61 // // /******/ //////// // //
63 // FOSA(Frescor Operating System Adaptation layer)
64 //================================================
66 #ifdef CONFIG_LONGJUMP
68 #include <fosa_long_jump.h>
71 LONGJMP_MAGIC = 0x01234567,
74 int jmp_used_signals [LONGJMP_NSIG] = {[0 ... (LONGJMP_NSIG - 1)] = 0};
75 pthread_mutex_t signal_pool_m = PTHREAD_MUTEX_INITIALIZER
78 int fosa_long_jump_save_context
79 (fosa_long_jump_context_t * context)
84 // Save the actual signal mask & mark the jump as still not performed
85 pthread_sigmask (SIG_SETMASK, NULL, &(context -> jmp_sigmask));
86 context -> jmp_hasexecuted = false;
88 if (setjmp (context -> jmp_context) == LONGJMP_MAGIC) {
89 #ifndef CONFIG_LONGJUMP_FREE_SIGNALS
90 pthread_sigmask (SIG_SETMASK, &(context -> jmp_sigmask), NULL);
92 context -> jmp_hasexecuted = true;
98 int fosa_long_jump_was_performed
99 (const fosa_long_jump_context_t * context, int * jumped)
101 if (!context && !jumped)
104 *jumped = context -> jmp_hasexecuted? 1:0;
109 void jmp_handler (int signo, siginfo_t *info, void *context)
111 fosa_long_jump_context_t *jmp_info = (fosa_long_jump_context_t *) info -> si_value.sival_ptr;
114 #ifdef CONFIG_LONGJUMP_FREE_SIGNALS
115 // Restore the signal mask
116 pthread_sigmask (SIG_SETMASK, &(context -> jmp_sigmask), NULL);
120 sigaddset (&set, signo);
121 pthread_sigmask (SIG_BLOCK, &sigmask, NULL);
123 pthread_mutex_lock (&signal_pool_m);
124 jmp_used_signals [signo] = 0;
125 pthread_mutex_unlock (&signal_pool_m);
128 // Restore the saved context
129 longjmp (jmp_info -> jmp_context, LONGJMP_MAGIC);
134 int fosa_long_jump_install_handler
135 (fosa_signal_t *signal, fosa_thread_id_t *handler)
141 // Find the first usable signal
142 pthread_mutex_lock (&signal_pool_m);
143 for (i = 0; i < LONGJMP_NSIG && jmp_used_signals [i]; i++);
144 if (i >= LONGJMP_NSIG) {
145 pthread_mutex_unlock (&signal_pool_m);
149 jmp_used_signals [i] = 1;
150 pthread_mutex_unlock (&signal_pool_m);
152 *signal = LONGJMP_FIRSTSIG + i;
153 *handler = pthread_self ();
155 // intall the jump handler
156 sa.sa_flags = SA_SIGINFO;
157 sigfillset (&sa.sa_mask);
158 sa.sa_sigaction = jmp_handler;
159 sigaction (*signal, &sa, NULL);
161 // unmask the signal for the calling thread
162 sigemptyset (&sigmask);
163 sigaddset (&sigmask, *signal);
164 pthread_sigmask (SIG_UNBLOCK, &sigmask, NULL);
169 #endif /* CONFIG_LONGJUMP */