fwp/lib/fwp/fwp_utils.c

   1 /**************************************************************************/
   2 /* ---------------------------------------------------------------------- */
   3 /* Copyright (C) 2006 - 2008 FRESCOR consortium partners:                 */
   4 /*                                                                        */
   5 /*   Universidad de Cantabria,              SPAIN                         */
   6 /*   University of York,                    UK                            */
   7 /*   Scuola Superiore Sant'Anna,            ITALY                         */
   8 /*   Kaiserslautern University,             GERMANY                       */
   9 /*   Univ. Politécnica  Valencia,           SPAIN                        */
  10 /*   Czech Technical University in Prague,  CZECH REPUBLIC                */
  11 /*   ENEA                                   SWEDEN                        */
  12 /*   Thales Communication S.A.              FRANCE                        */
  13 /*   Visual Tools S.A.                      SPAIN                         */
  14 /*   Rapita Systems Ltd                     UK                            */
  15 /*   Evidence                               ITALY                         */
  16 /*                                                                        */
  17 /*   See http://www.frescor.org for a link to partners' websites          */
  18 /*                                                                        */
  19 /*          FRESCOR project (FP6/2005/IST/5-034026) is funded             */
  20 /*       in part by the European Union Sixth Framework Programme          */
  21 /*       The European Union is not liable of any use that may be          */
  22 /*       made of this code.                                               */
  23 /*                                                                        */
  24 /*                                                                        */
  25 /*  This file is part of FWP (Frescor WLAN Protocol)                      */
  26 /*                                                                        */
  27 /* FWP is free software; you can redistribute it and/or modify it         */
  28 /* under terms of the GNU General Public License as published by the      */
  29 /* Free Software Foundation; either version 2, or (at your option) any    */
  30 /* later version.  FWP is distributed in the hope that it will be         */
  31 /* useful, but WITHOUT ANY WARRANTY; without even the implied warranty    */
  32 /* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU    */
  33 /* General Public License for more details. You should have received a    */
  34 /* copy of the GNU General Public License along with FWP; see file        */
  35 /* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave,  */
  36 /* Cambridge, MA 02139, USA.                                              */
  37 /*                                                                        */
  38 /* As a special exception, including FWP header files in a file,          */
  39 /* instantiating FWP generics or templates, or linking other files        */
  40 /* with FWP objects to produce an executable application, does not        */
  41 /* by itself cause the resulting executable application to be covered     */
  42 /* by the GNU General Public License. This exception does not             */
  43 /* however invalidate any other reasons why the executable file might be  */
  44 /* covered by the GNU Public License.                                     */
  45 /**************************************************************************/
  46 #include "fwp_utils.h"
  47
  48 #include <sched.h>
  49 /*#include <stdlib.h>*/
  50
  51 /*const int prio_to_ac[8] = {2,3,3,2,1,1,0,0};
  52 const unsigned int ac_to_tos[4] = {224,160,96,64};
  53 const char *ac_to_text[4] = {[AC_VO] = "AC_VO", [AC_VI] = "AC_VI",
  54                              [AC_BE] = "AC_BE", [AC_BK] = "AC_BK", };
  55 */
  56
  57 void fwp_timespec_add (struct timespec *sum, const struct timespec *left,
  58               const struct timespec *right)
  59 {
  60         sum->tv_sec = left->tv_sec + right->tv_sec;
  61         sum->tv_nsec = left->tv_nsec + right->tv_nsec;
  62
  63         if (sum->tv_nsec >= 1000000000){
  64                 ++sum->tv_sec;
  65                 sum->tv_nsec -= 1000000000;
  66         }
  67 }
  68
  69 void fwp_timespec_sub (struct timespec *diff, const struct timespec *left,
  70               const struct timespec *right)
  71 {
  72         diff->tv_sec = left->tv_sec - right->tv_sec;
  73         diff->tv_nsec = left->tv_nsec - right->tv_nsec;
  74
  75         if (diff->tv_nsec < 0){
  76                   --diff->tv_sec;
  77                   diff->tv_nsec += 1000000000;
  78         }
  79 }
  80
  81 void fwp_timespec_modulo(struct timespec *remainder, struct timespec *dividend,
  82                                 struct timespec *dividor)
  83 {
  84         long long a, b, res;
  85
  86         a = dividend->tv_sec * SEC_TO_USEC + dividend->tv_nsec / USEC_TO_NSEC;
  87         b = dividor->tv_sec * SEC_TO_USEC + dividor->tv_nsec / USEC_TO_NSEC;
  88         res = a % b;
  89         remainder->tv_sec = res / SEC_TO_USEC;
  90         remainder->tv_nsec = ( res % SEC_TO_USEC ) * USEC_TO_NSEC;
  91 }
  92
  93 int fwp_set_rt_prio(int priority)
  94 {
  95         int maxpri, minpri;
  96         static struct sched_param param;
  97
  98         if ((maxpri = sched_get_priority_max(SCHED_FIFO)) == -1) {
  99                 FWP_ERROR("sched_get_priority_max call failed: %s\n",
 100                                 strerror(errno));
 101                 return -1;
 102         }
 103
 104         if ((minpri = sched_get_priority_min(SCHED_FIFO)) == -1) {
 105                 FWP_ERROR("sched_get_priority_min call failed: %s\n",
 106                                 strerror(errno));
 107                 return -1;
 108         }
 109
 110         if (priority > maxpri)  {
 111                 FWP_ERROR("parameter %d is greater than the maximal allowed"
 112                                 " priority %d.\n", priority, maxpri);
 113                 errno = EINVAL;
 114                 return -1;
 115         }
 116
 117         if (priority < minpri)  {
 118                 FWP_ERROR("priority parameter %d is lower than the minimal "
 119                                 "allowed priority %d.\n", priority, minpri);
 120                 errno = EINVAL;
 121                 return -1;
 122         }
 123
 124         param.sched_priority = priority;
 125
 126         if (sched_setscheduler(0, SCHED_FIFO, &param) == -1) {
 127                 /*FWP_ERROR("sched_setscheduler call failed: %s\n",
 128                                 strerror(errno));*/
 129                 return -1;
 130         }
 131
 132         return 0;
 133 }
 134
 135 int fwp_create_unix_socket(char *path, struct sockaddr_un *addr)
 136 {
 137         int sockfd;
 138
 139         if ((sockfd = socket(AF_UNIX, SOCK_DGRAM, 0)) == -1){
 140                 FWP_ERROR("socket error: %s", strerror(errno));
 141                 return (-1);
 142         }
 143
 144         bzero(addr, sizeof(addr));
 145         addr->sun_family = AF_UNIX;
 146         strcpy(addr->sun_path, path);
 147
 148         unlink(path);
 149
 150         if (bind(sockfd, (struct sockaddr*)addr,
 151                  sizeof(*addr)) == -1) {
 152                         FWP_ERROR("fwp_open_unix_socket - bind error: %s", strerror(errno));
 153                         return (-1);
 154         }
 155
 156         return sockfd;
 157 }
 158
 159 int fwp_create_inet_socket(unsigned int port, struct sockaddr_in *addr)
 160 {
 161         int sockfd;
 162
 163         if ((sockfd = socket(AF_INET, SOCK_DGRAM, 0)) == -1){
 164                 FWP_ERROR("socket error: %s", strerror(errno));
 165                 return (-1);
 166         }
 167
 168         addr->sin_family = AF_INET;
 169         addr->sin_addr.s_addr = INADDR_ANY;
 170         addr->sin_port = htons(port);
 171
 172         if (bind(sockfd, (struct sockaddr*)addr,
 173                  sizeof(*addr)) == -1) {
 174
 175                 FWP_ERROR("bind error: %s", strerror(errno));
 176                 return (-1);
 177         }
 178
 179         return sockfd;
 180 }
 181
 182 /*void block_signals(void)
 183 {
 184         sigset_t sigset;
 185         int ret;
 186         sigemptyset(&sigset);
 187         sigaddset(&sigset, SIGINT);
 188         sigaddset(&sigset, SIGTERM);
 189         ret = pthread_sigmask(SIG_BLOCK, &sigset, NULL);
 190         if (ret != 0) {
 191                 FWP_ERROR("pthread_sigmask failed: %s", strerror(errno));
 192                 exit(1);
 193         }
 194 }
 195 */