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 <unistd.h>
  49 #include <sched.h>
  50 /*#include <stdlib.h>*/
  51 #include "fwp_debug.h"
  52 #include <errno.h>
  53
  54 /*const int prio_to_ac[8] = {2,3,3,2,1,1,0,0};
  55 const unsigned int ac_to_tos[4] = {224,160,96,64};
  56 const char *ac_to_text[4] = {[AC_VO] = "AC_VO", [AC_VI] = "AC_VI",
  57                              [AC_BE] = "AC_BE", [AC_BK] = "AC_BK", };
  58 */
  59
  60 void fwp_timespec_add (struct timespec *sum, const struct timespec *left,
  61               const struct timespec *right)
  62 {
  63         sum->tv_sec = left->tv_sec + right->tv_sec;
  64         sum->tv_nsec = left->tv_nsec + right->tv_nsec;
  65
  66         if (sum->tv_nsec >= 1000000000){
  67                 ++sum->tv_sec;
  68                 sum->tv_nsec -= 1000000000;
  69         }
  70 }
  71
  72 void fwp_timespec_sub (struct timespec *diff, const struct timespec *left,
  73               const struct timespec *right)
  74 {
  75         diff->tv_sec = left->tv_sec - right->tv_sec;
  76         diff->tv_nsec = left->tv_nsec - right->tv_nsec;
  77
  78         if (diff->tv_nsec < 0){
  79                   --diff->tv_sec;
  80                   diff->tv_nsec += 1000000000;
  81         }
  82 }
  83
  84 void fwp_timespec_modulo(struct timespec *remainder, struct timespec *dividend,
  85                                 struct timespec *dividor)
  86 {
  87         long long a, b, res;
  88
  89         a = dividend->tv_sec * SEC_TO_USEC + dividend->tv_nsec / USEC_TO_NSEC;
  90         b = dividor->tv_sec * SEC_TO_USEC + dividor->tv_nsec / USEC_TO_NSEC;
  91         res = a % b;
  92         remainder->tv_sec = res / SEC_TO_USEC;
  93         remainder->tv_nsec = ( res % SEC_TO_USEC ) * USEC_TO_NSEC;
  94 }
  95
  96 int fwp_set_rt_prio(int priority)
  97 {
  98         int maxpri, minpri;
  99         static struct sched_param param;
 100
 101         if ((maxpri = sched_get_priority_max(SCHED_FIFO)) == -1) {
 102                 FWP_ERROR("sched_get_priority_max call failed: %s\n",
 103                                 strerror(errno));
 104                 return -1;
 105         }
 106
 107         if ((minpri = sched_get_priority_min(SCHED_FIFO)) == -1) {
 108                 FWP_ERROR("sched_get_priority_min call failed: %s\n",
 109                                 strerror(errno));
 110                 return -1;
 111         }
 112
 113         if (priority > maxpri)  {
 114                 FWP_ERROR("parameter %d is greater than the maximal allowed"
 115                                 " priority %d.\n", priority, maxpri);
 116                 errno = EINVAL;
 117                 return -1;
 118         }
 119
 120         if (priority < minpri)  {
 121                 FWP_ERROR("priority parameter %d is lower than the minimal "
 122                                 "allowed priority %d.\n", priority, minpri);
 123                 errno = EINVAL;
 124                 return -1;
 125         }
 126
 127         param.sched_priority = priority;
 128
 129         if (sched_setscheduler(0, SCHED_FIFO, &param) == -1) {
 130                 /*FWP_ERROR("sched_setscheduler call failed: %s\n",
 131                                 strerror(errno));*/
 132                 return -1;
 133         }
 134
 135         return 0;
 136 }
 137
 138 int fwp_create_unix_socket(char *path, struct sockaddr_un *addr)
 139 {
 140         int sockfd;
 141
 142         if ((sockfd = socket(AF_UNIX, SOCK_DGRAM, 0)) == -1){
 143                 FWP_ERROR("socket error: %s", strerror(errno));
 144                 return (-1);
 145         }
 146
 147         bzero(addr, sizeof(addr));
 148         addr->sun_family = AF_UNIX;
 149         strcpy(addr->sun_path, path);
 150
 151         unlink(path);
 152
 153         if (bind(sockfd, (struct sockaddr*)addr,
 154                  sizeof(*addr)) == -1) {
 155                         FWP_ERROR("fwp_open_unix_socket - bind error: %s", strerror(errno));
 156                         return (-1);
 157         }
 158
 159         return sockfd;
 160 }
 161
 162 int fwp_create_inet_socket(unsigned int port, struct sockaddr_in *addr)
 163 {
 164         int sockfd;
 165
 166         if ((sockfd = socket(AF_INET, SOCK_DGRAM, 0)) == -1){
 167                 FWP_ERROR("socket error: %s", strerror(errno));
 168                 return (-1);
 169         }
 170
 171         addr->sin_family = AF_INET;
 172         addr->sin_addr.s_addr = INADDR_ANY;
 173         addr->sin_port = htons(port);
 174
 175         if (bind(sockfd, (struct sockaddr*)addr,
 176                  sizeof(*addr)) == -1) {
 177
 178                 FWP_ERROR("bind error: %s", strerror(errno));
 179                 return (-1);
 180         }
 181
 182         return sockfd;
 183 }
 184
 185 /*void block_signals(void)
 186 {
 187         sigset_t sigset;
 188         int ret;
 189         sigemptyset(&sigset);
 190         sigaddset(&sigset, SIGINT);
 191         sigaddset(&sigset, SIGTERM);
 192         ret = pthread_sigmask(SIG_BLOCK, &sigset, NULL);
 193         if (ret != 0) {
 194                 FWP_ERROR("pthread_sigmask failed: %s", strerror(errno));
 195                 exit(1);
 196         }
 197 }
 198 */