common/misc.c

   1 /*
   2
   3   G N O K I I
   4
   5   A Linux/Unix toolset and driver for Nokia mobile phones.
   6
   7   Released under the terms of the GNU GPL, see file COPYING for more details.
   8
   9 */
  10
  11 #include <string.h>\r
  12 #include <ctype.h>\r
  13 #include <time.h>\r
  14
  15 #ifndef WIN32
  16   #include <sys/types.h>
  17   #include <sys/stat.h>
  18   #include <stdlib.h>
  19   #include <fcntl.h>
  20   #include <signal.h>
  21   #include <unistd.h>
  22   #include <errno.h>
  23 #endif\r
  24 \r
  25 #include "misc.h"\r
  26 #include "gsm-common.h"\r
  27
  28 #ifndef HAVE_TIMEOPS
  29
  30 /* FIXME: I have timersub defined in sys/time.h :-( PJ
  31    FIXME: Jano wants this function too... PJ
  32
  33 int timersub(struct timeval *a, struct timeval *b, struct timeval *result) {
  34   do {
  35     (result)->tv_sec = (a)->tv_sec - (b)->tv_sec;
  36     (result)->tv_usec = (a)->tv_usec - (b)->tv_usec;
  37     if ((result)->tv_usec < 0) {
  38       --(result)->tv_sec;
  39       (result)->tv_usec += 1000000;
  40     }
  41   } while (0);
  42 }
  43 */
  44
  45 #endif
  46
  47 int GetLine(FILE *File, char *Line, int count) {
  48
  49   char *ptr;
  50
  51   if (fgets(Line, count, File)) {
  52     ptr=Line+strlen(Line)-1;
  53
  54     while ( (*ptr == '\n' || *ptr == '\r') && ptr>=Line) *ptr--='\0';
  55
  56     return strlen(Line);
  57   } else return -1;
  58 }
  59
  60 /*
  61  * like atoi, but of a non-null-terminated string of a specified portion
  62  */
  63 int mem_to_int(const char str[], int len)
  64 {
  65   char aux[81];
  66
  67   strncpy(aux, str, len);
  68   aux[len]=0;
  69   return( atoi(aux) );
  70 }
  71
  72 /*
  73  * make hexdump of Message
  74  */
  75 #ifdef DEBUG
  76 void hexdump(u16 MessageLength, u8 *MessageBuffer)
  77 {
  78
  79   int count;
  80   int n=0;
  81   char string1[80]="";
  82   char string2[80]="";
  83   char hex1[10];
  84   char hex2[10];
  85
  86   for (count = 0; count < MessageLength; count ++)
  87   {
  88     n++;
  89
  90     switch (MessageBuffer[count]) {
  91       case 0x09:
  92         sprintf(hex1,"%02x  ",MessageBuffer[count]);
  93         strcpy(hex2,".");
  94         break;
  95       default:
  96         if (isprint(MessageBuffer[count]))
  97           sprintf(hex1,"%02x%c ",MessageBuffer[count],MessageBuffer[count]);
  98         else
  99           sprintf(hex1,"%02x  ",MessageBuffer[count]);
 100
 101         if (isprint(MessageBuffer[count])) sprintf(hex2,"%c",MessageBuffer[count]);
 102                                       else strcpy(hex2,".");
 103         break;
 104     }
 105
 106     if ( n!=15 && count != MessageLength-1 ) hex1[3]='|';
 107
 108     strcat(string1,hex1);
 109     strcat(string2,hex2);
 110
 111     if ( n==15 || count == MessageLength-1 )
 112     {
 113       fprintf(stdout,"%-60s%03x %s\n",string1,count+1,string2);
 114       strcpy(string1,"");
 115       strcpy(string2,"");
 116       n=0;
 117     }
 118   }//for count
 119
 120   if (n!=0) fprintf (stdout,_("\n"));
 121
 122   fflush(stdout);
 123 }
 124
 125 void txhexdump(u16 MessageLength, u8 *MessageBuffer)
 126 {
 127   int count;
 128   int n=0;
 129
 130   for (count = 0; count < MessageLength; count ++)
 131    {
 132     n++;
 133     fprintf(stdout,_("%02x"),MessageBuffer[count]);
 134     switch (MessageBuffer[count]) {
 135       case 0x09:
 136         fprintf(stdout,_(" |"));
 137         break;
 138       default:
 139         if (isprint(MessageBuffer[count])) fprintf(stdout, _("%c|"),MessageBuffer[count]);
 140                                       else fprintf(stdout,_(" |"));
 141         break;
 142     }
 143
 144     if (n==18)
 145     {
 146       fprintf (stdout,_("\n"));
 147       n=0;
 148     }
 149    }//for count
 150
 151   if (n!=0) fprintf (stdout,_("\n"));
 152
 153   fflush(stdout);
 154 }
 155 #endif
 156
 157 #ifndef WIN32
 158
 159 #define max_buf_len 128
 160 #define lock_path "/var/lock/LCK.."
 161
 162 /* Lock the device. Return allocated string with a lock name */
 163 char *lock_device(const char* port)
 164 {
 165         char *lock_file = NULL;
 166         char buffer[max_buf_len];
 167         char *aux = rindex(port, '/');
 168         int fd, len = strlen(aux) + strlen(lock_path);
 169
 170         memset(buffer, 0, sizeof(buffer));
 171         lock_file = calloc(len + 1, 1);
 172         if (!lock_file) {
 173                 fprintf(stderr, _("Cannot lock device\n"));
 174                 return NULL;
 175         }
 176         /* I think we don't need to use strncpy, as we should have enough
 177          * buffer due to strlen results
 178          */
 179         strcpy(lock_file, lock_path);
 180         strcat(lock_file, aux);
 181
 182         /* Check for the stale lockfile.
 183          * The code taken from minicom by Miquel van Smoorenburg */
 184         if ((fd = open(lock_file, O_RDONLY)) >= 0) {
 185                 char buf[max_buf_len];
 186                 int pid, n = 0;
 187
 188                 n = read(fd, buf, sizeof(buf) - 1);
 189                 close(fd);
 190                 if (n > 0) {
 191                         pid = -1;
 192                         if (n == 4)
 193                                 /* Kermit-style lockfile. */
 194                                 pid = *(int *)buf;
 195                         else {
 196                                 /* Ascii lockfile. */
 197                                 buf[n] = 0;
 198                                 sscanf(buf, "%d", &pid);
 199                         }
 200                         if (pid > 0 && kill((pid_t)pid, 0) < 0 && errno == ESRCH) {
 201                                 fprintf(stderr, _("Lockfile is stale. Overriding it..\n"));
 202                                 sleep(1);
 203                                 unlink(lock_file);
 204                         } else
 205                                 n = 0;
 206                 }
 207                 if (n == 0) {
 208                         free(lock_file);
 209                         fprintf(stderr, _("Device is already locked.\n"));
 210                         return NULL;
 211                 }
 212         }
 213
 214         /* Try to create a new file, with 0644 mode */
 215         fd = open(lock_file, O_CREAT | O_EXCL, 0644);
 216         if (fd == -1) {
 217                 free(lock_file);
 218                 fprintf(stderr, _("Cannot lock device\n"));
 219                 return NULL;
 220         }
 221         sprintf(buffer, "%10ld gnokii\n", (long)getpid());
 222         write(fd, buffer, strlen(buffer));
 223         close(fd);
 224         return lock_file;
 225 }
 226
 227 /* Removes lock and frees memory */
 228 bool unlock_device(char *lock_file)
 229 {
 230         int err;
 231
 232         if (!lock_file) {
 233                 fprintf(stderr, _("Cannot unlock device\n"));
 234                 return false;
 235         }
 236         err = unlink(lock_file);
 237         free(lock_file);
 238         return (err + 1);
 239 }
 240 #endif /* WIN32 */