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 inline 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 inline 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 int fwp_set_rt_prio(int priority)
  82 {
  83         int maxpri, minpri;
  84         static struct sched_param param;
  85
  86         if ((maxpri = sched_get_priority_max(SCHED_FIFO)) == -1) {
  87                 FWP_ERROR("sched_get_priority_max call failed: %s\n",
  88                                 strerror(errno));
  89                 return -1;
  90         }
  91
  92         if ((minpri = sched_get_priority_min(SCHED_FIFO)) == -1) {
  93                 FWP_ERROR("sched_get_priority_min call failed: %s\n",
  94                                 strerror(errno));
  95                 return -1;
  96         }
  97
  98         if (priority > maxpri)  {
  99                 FWP_ERROR("parameter %d is greater than the maximal allowed"
 100                                 " priority %d.\n", priority, maxpri);
 101                 errno = EINVAL;
 102                 return -1;
 103         }
 104
 105         if (priority < minpri)  {
 106                 FWP_ERROR("priority parameter %d is lower than the minimal "
 107                                 "allowed priority %d.\n", priority, minpri);
 108                 errno = EINVAL;
 109                 return -1;
 110         }
 111
 112         param.sched_priority = priority;
 113
 114         if (sched_setscheduler(0, SCHED_FIFO, &param) == -1) {
 115                 FWP_ERROR("sched_setscheduler call failed: %s\n",
 116                                 strerror(errno));
 117                 return -1;
 118         }
 119
 120         return 0;
 121 }
 122
 123 int fwp_create_unix_socket(char *path, struct sockaddr_un *addr)
 124 {
 125         int sockfd;
 126
 127         if ((sockfd = socket(AF_UNIX, SOCK_DGRAM, 0)) == -1){
 128                 FWP_ERROR("socket error: %s", strerror(errno));
 129                 return (-1);
 130         }
 131
 132         bzero(addr, sizeof(addr));
 133         addr->sun_family = AF_UNIX;
 134         strcpy(addr->sun_path, path);
 135
 136         unlink(path);
 137
 138         if (bind(sockfd, (struct sockaddr*)addr,
 139                  sizeof(*addr)) == -1) {
 140                         FWP_ERROR("fwp_open_unix_socket - bind error: %s", strerror(errno));
 141                         return (-1);
 142         }
 143
 144         return sockfd;
 145 }
 146
 147 int fwp_create_inet_socket(unsigned int port, struct sockaddr_in *addr)
 148 {
 149         int sockfd;
 150
 151         if ((sockfd = socket(AF_INET, SOCK_DGRAM, 0)) == -1){
 152                 FWP_ERROR("socket error: %s", strerror(errno));
 153                 return (-1);
 154         }
 155
 156         addr->sin_family = AF_INET;
 157         addr->sin_addr.s_addr = INADDR_ANY;
 158         addr->sin_port = htons(port);
 159
 160         if (bind(sockfd, (struct sockaddr*)addr,
 161                  sizeof(*addr)) == -1) {
 162
 163                 FWP_ERROR("bind error: %s", strerror(errno));
 164                 return (-1);
 165         }
 166
 167         return sockfd;
 168 }
 169
 170 /*void block_signals(void)
 171 {
 172         sigset_t sigset;
 173         int ret;
 174         sigemptyset(&sigset);
 175         sigaddset(&sigset, SIGINT);
 176         sigaddset(&sigset, SIGTERM);
 177         ret = pthread_sigmask(SIG_BLOCK, &sigset, NULL);
 178         if (ret != 0) {
 179                 FWP_ERROR("pthread_sigmask failed: %s", strerror(errno));
 180                 exit(1);
 181         }
 182 }
 183 */