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 #define LONGJMP_MAGIC 0x01234567
72 int jmp_used_signals [LONGJMP_NSIG] = {[0 ... (LONGJMP_NSIG - 1)] = 0};
73 pthread_mutex_t signal_pool_m = PTHREAD_MUTEX_INITIALIZER;
75 extern void fosa_longjmp (fosa_long_jump_context_t ctx, unsigned long magic);
77 int fosa_long_jump_was_performed
78 (const fosa_long_jump_context_t * context, int * jumped)
80 if (!context && !jumped)
83 // printf ("context [6]=%ld\n", (*(context))[6]);
84 *jumped = ((*(context))[6] == LONGJMP_MAGIC);
89 void jmp_handler (int signo, siginfo_t *info, void *context)
91 fosa_long_jump_context_t *jmp_info = (fosa_long_jump_context_t *) info -> si_value.sival_ptr;
93 #ifdef CONFIG_LONGJUMP_FREE_SIGNAL
96 // Restore the signal mask
97 // pthread_sigmask (SIG_SETMASK, &(jmp_info -> jmp_sigmask), NULL);
101 sigaddset (&set, signo);
102 pthread_sigmask (SIG_BLOCK, &sigmask, NULL);
104 pthread_mutex_lock (&signal_pool_m);
105 jmp_used_signals [signo] = 0;
106 pthread_mutex_unlock (&signal_pool_m);
109 // printf ("\t\t\t\t>>> RESTORE CONTEXT <<<\n\n");
110 // Restore the saved context
111 fosa_longjmp (*jmp_info, LONGJMP_MAGIC);
116 int fosa_long_jump_install_handler
117 (fosa_signal_t *signal, fosa_thread_id_t *handler)
123 // Find the first usable signal
124 pthread_mutex_lock (&signal_pool_m);
125 for (i = 0; i < LONGJMP_NSIG && jmp_used_signals [i]; i++);
126 if (i >= LONGJMP_NSIG) {
127 pthread_mutex_unlock (&signal_pool_m);
131 jmp_used_signals [i] = 1;
132 pthread_mutex_unlock (&signal_pool_m);
134 *signal = LONGJMP_FIRSTSIG + i;
135 *handler = pthread_self ();
137 // intall the jump handler
138 sa.sa_flags = SA_SIGINFO;
139 sigfillset (&sa.sa_mask);
140 sa.sa_sigaction = jmp_handler;
141 sigaction (*signal, &sa, NULL);
143 // unmask the signal for the calling thread
144 sigemptyset (&sigmask);
145 sigaddset (&sigmask, *signal);
146 pthread_sigmask (SIG_UNBLOCK, &sigmask, NULL);
151 #endif /* CONFIG_LONGJUMP */