]> rtime.felk.cvut.cz Git - frescor/fosa.git/blobdiff - src_partikle/fosa_clocks_and_timers.c
FOSA-PaRTiKle implementation
[frescor/fosa.git] / src_partikle / fosa_clocks_and_timers.c
index bfa0e70176de3f375994006d86889298979afccf..dc536e4ab37e16763d343015e77f06512ba55aad 100644 (file)
@@ -1,9 +1,61 @@
-/** fosa_clocks_and_timers.c
- *
- * < description >
- * < author >
- * < date >
- */
+// -----------------------------------------------------------------------
+//  Copyright (C) 2006 - 2007 FRESCOR consortium partners:
+//
+//    Universidad de Cantabria,              SPAIN
+//    University of York,                    UK
+//    Scuola Superiore Sant'Anna,            ITALY
+//    Kaiserslautern University,             GERMANY
+//    Univ. Politecnica  Valencia,           SPAIN
+//    Czech Technical University in Prague,  CZECH REPUBLIC
+//    ENEA                                   SWEDEN
+//    Thales Communication S.A.              FRANCE
+//    Visual Tools S.A.                      SPAIN
+//    Rapita Systems Ltd                     UK
+//    Evidence                               ITALY
+//    
+//    See http://www.frescor.org for a link to partners' websites
+//
+//           FRESCOR project (FP6/2005/IST/5-034026) is funded
+//        in part by the European Union Sixth Framework Programme
+//        The European Union is not liable of any use that may be
+//        made of this code.
+//
+//  This file is part of the FRSH implementation
+//
+//  FRSH is free software; you can  redistribute it and/or  modify
+//  it under the terms of  the GNU General Public License as published by
+//  the Free Software Foundation;  either  version 2, or (at  your option)
+//  any later version.
+//
+//  FRSH  is distributed  in  the hope  that  it  will  be useful,  but
+//  WITHOUT  ANY  WARRANTY;     without  even the   implied   warranty  of
+//  MERCHANTABILITY  or  FITNESS FOR  A  PARTICULAR PURPOSE. See  the  GNU
+//  General Public License for more details.
+//
+//  You should have  received a  copy of  the  GNU  General Public License
+//  distributed  with  FRSH;  see file COPYING.   If not,  write to the
+//  Free Software  Foundation,  59 Temple Place  -  Suite 330,  Boston, MA
+//  02111-1307, USA.
+//
+//  As a special exception, if you include this header file into source
+//  files to be compiled, this header file does not by itself cause
+//  the resulting executable to be covered by the GNU General Public
+//  License.  This exception does not however invalidate any other
+//  reasons why the executable file might be covered by the GNU General
+//  Public License.
+// -----------------------------------------------------------------------
+//==============================================
+//  ********  ******    ********  **********
+//  **///// /**    **  **//////  /**     /**
+//  **      /**    ** /**        /**     /**
+//  ******* /**    ** /********* /**********
+//  **////  /**    ** ////////** /**//////**
+//  **      /**    **        /** /**     /**
+//  **      /**    **  ********  /**     /**
+//  //       /******/  ////////   //      // 
+//
+// FOSA(Frescor Operating System Adaptation layer)
+//================================================
 
 #include <fosa_clocks_and_timers.h>
 
@@ -19,28 +71,49 @@ int fosa_clock_get_time(fosa_clock_id_t clockid, struct timespec *current_time)
 }
 
 
-
-int fosa_thread_get_cputime_clock(frsh_thread_id_t tid, fosa_clock_id_t *clockid)
+int fosa_thread_get_cputime_clock(fosa_thread_id_t tid, fosa_clock_id_t *clockid)
 {
-//     if (tid == thread_invalid) 
-//             return FOSA_EINVAL;
-       
-       *clockid = CLOCK_THREAD_CPUTIME_ID;
-       return 0;
+  return pthread_getcpuclockid (tid, clockid);
 }
 
+
+
+
 /*************************
  * Timing: Timers
  *************************/
+// #define FRSH_DEADLINE_NEWJOB_TIMEOUT   0x00050000
+void void_handler (int signo) {};
 int fosa_timer_create
-                (fosa_clock_id_t clockid, frsh_signal_t signal, frsh_signal_info_t info,
-                 fosa_timer_id_t *timerid);
+    (fosa_clock_id_t clockid, fosa_signal_t signal, fosa_signal_info_t info,
+     fosa_timer_id_t *timerid)
+ {
+       struct sigevent se;
+       struct sigaction act;
+
+       // Assumption: the signal should accept queued values
+       act.sa_handler = void_handler;
+       sigfillset (&act.sa_mask);      
+       act.sa_flags = SA_SIGINFO;      // accept signal queuing
+       sigaction (signal, &act, NULL);
+       
+       se.sigev_notify = SIGEV_SIGNAL;
+       se.sigev_signo = signal;
+       
+       se.sigev_value.sival_int = info.sival_int;
+       se.sigev_value.sival_ptr = info.sival_ptr;
+
+       return timer_create (clockid, &se, timerid);
+/*
+       if ((info.sival_int & 0xFFFF0000) == FRSH_DEADLINE_NEWJOB_TIMEOUT)
+               printf ("\n\ndeadline %d timer created: info=0x%x, signal=%d ()\n\n", *timerid, info.sival_int, signal);
+*/
+}
+
 
 int fosa_timer_delete(fosa_timer_id_t timerid)
 {
-       if (timer_delete (timerid))
-               return FOSA_EINVAL;
-       return 0;
+       return timer_delete (timerid);
 }
 
 
@@ -48,20 +121,26 @@ int fosa_timer_arm
                (fosa_timer_id_t timerid, bool abstime,
                 const struct timespec *value)
 {
-       struct itimerspec value = 
+       struct timespec now;
+       
+       clock_gettime (CLOCK_REALTIME, &now);
+       
+//     printf ("(0x%x): Arm timer (%d). abstime=%d, value={%ld,%ld}, now={%ld, %ld}\n",\
+//             pthread_self (), timerid, abstime, value -> tv_sec, value -> tv_nsec, now.tv_sec, now.tv_nsec);
+
+       struct itimerspec tvalue =
        {
                .it_value = (struct timespec) *value,
-               .it_interval = 0,
-       }
+               .it_interval = {0,0},
+       };
        
-       if (timer_settime (timerid, abstime, &value, NULL))
+       if (timer_settime (timerid, abstime, &tvalue, NULL))
                return EINVAL;
        
        return 0;
 }
 
 
-// TODO: CPU-clock ???
 int fosa_timer_get_remaining_time
                (fosa_timer_id_t timerid, struct timespec *remaining_time)
 {
@@ -74,16 +153,17 @@ int fosa_timer_get_remaining_time
        return 0;
 }
 
+
 int fosa_timer_disarm(fosa_timer_id_t timerid, struct timespec
                *remaining_time)
 {
        struct itimerspec null_timer, old;
        
        // NULL timer -> disarm
-       value = (struct itimerspec) {
+       null_timer = (struct itimerspec) {
                .it_value = {0, 0},
                .it_interval = 0,
-       }
+       };
        
        if (timer_settime (timerid, 0, &null_timer, &old))
                return EINVAL;
@@ -93,3 +173,4 @@ int fosa_timer_disarm(fosa_timer_id_t timerid, struct timespec
                
        return 0;
 }
+