mdsms.c

   1 #include "config.h"
   2 #ifndef lint
   3 static char rcsid[] ATTR_UNUSED = "$Id$";
   4 #endif
   5
   6 #include "setup.h"
   7
   8 #include <stdio.h>
   9 #include <stdlib.h>
  10 #include <string.h>
  11 #include <signal.h>
  12 #include <stdarg.h>
  13 #include <limits.h>
  14 #include <ctype.h>
  15 #include <string.h>
  16 #include <termios.h>
  17 #include <unistd.h>
  18 #include <assert.h>
  19 #include <sys/types.h>
  20 #include <sys/stat.h>
  21 #include <fcntl.h>
  22 #include <errno.h>
  23 #include <signal.h>
  24 #include <time.h>
  25
  26 #ifdef HAVE_GETOPT_LONG
  27 #include <getopt.h>
  28 #else
  29 #include "getopt.h"
  30 #endif
  31
  32 #define NELEM(x) (sizeof((x))/sizeof(*(x)))
  33
  34 #ifndef DEBUG
  35 #define dbg(cmd)
  36 #else
  37 #define dbg(cmd) cmd
  38 #endif
  39 /* ANSI C does not allow macro with variable arguments */
  40 #define dO stderr
  41 #define dB(a) dbg(fprintf a)
  42
  43 #define d1(n1)          dB((dO,n1         ))
  44 #define d2(n1,n2)       dB((dO,n1,n2      ))
  45 #define d3(n1,n2,n3)    dB((dO,n1,n2,n3   ))
  46 #define d4(n1,n2,n3,n4) dB((dO,n1,n2,n3,n4))
  47
  48 static const char version[]="This is Nokia 9110 logo SMS sender (" PACKAGE " " VERSION ")\n";
  49
  50 static int verbose
  51 #ifdef DEBUG
  52         =0xFFFF
  53 #endif
  54         ;
  55 static char *pname;
  56 static int dis_cleanup=0,devfd=-1;
  57
  58 static char *phone,*logoname,*device,*logname,*lockfile,*smsc,*maxretry,*readtime,*chartime,*cmdtime,*baud,*gsmnet;
  59 static long maxretryn=DEF_MAXRETRY,readtimen=DEF_READTIME,chartimen=DEF_CHARTIME,cmdtimen=DEF_CMDTIME,baudn=DEF_BAUD;
  60
  61 static char *devicename; /* path stripped */
  62 static char lockreal[512],locked;
  63
  64 static struct termios restios,tios;
  65 static char restios_yes;
  66 static FILE *logf;
  67
  68 static void vlogmsg(
  69 #ifndef PRINTF_WORKS_PM
  70                 char outerr,
  71 #endif
  72                 const char *fmt,va_list ap)
  73 {
  74 time_t stamp;
  75 char *ctm,*s;
  76 pid_t mypid=-1;
  77 char host[LINE_MAX];
  78
  79         if (!logf) return;
  80         if (mypid==-1) {
  81                 mypid=getpid();
  82                 if (gethostname(host,sizeof(host))) strcpy(host,"<ERROR>");
  83                 }
  84         time(&stamp);
  85         ctm=ctime(&stamp);
  86         if ((s=strchr(ctm,'\n'))) *s='\0';
  87         fprintf(logf,"%s %s %s[%d]: ",ctm,host,pname,mypid);
  88         vfprintf(logf,fmt,ap);
  89 #ifndef PRINTF_WORKS_PM
  90         if (outerr) fputs(strerror(errno),logf);
  91 #endif
  92         fputc('\n',logf);
  93         fflush(logf);
  94 }
  95
  96 static void logmsg(const char *fmt,...)
  97 {
  98 va_list ap;
  99         va_start(ap,fmt);
 100         vlogmsg(
 101 #ifndef PRINTF_WORKS_PM
 102                 0,
 103 #endif
 104                 fmt,ap);
 105         va_end(ap);
 106 }
 107
 108 static void error(const char *fmt,...)
 109 {
 110 va_list ap;
 111 char fatal=*fmt;
 112 #ifndef PRINTF_WORKS_PM
 113 char pm,*nfmt;
 114 size_t fmtl;
 115 #endif
 116
 117         if (fatal=='!' || fatal=='.' || fatal=='\n') fmt++;
 118         else fatal=0;
 119
 120 #ifndef PRINTF_WORKS_PM
 121         if (!(nfmt=strdup(fmt))) return;
 122         fmtl=strlen(fmt);
 123         if ((pm=(fmtl>=2 && !strcmp(fmt+fmtl-2,"%m")))) nfmt[fmtl-2]='\0';
 124 #endif
 125
 126         fprintf(stderr,"%s: ",pname);
 127         va_start(ap,fmt);
 128         vfprintf(stderr,
 129 #ifdef PRINTF_WORKS_PM
 130                 fmt
 131 #else
 132                 nfmt
 133 #endif
 134                 ,ap);
 135         if (fatal=='!') vlogmsg(
 136 #ifdef PRINTF_WORKS_PM
 137                 fmt
 138 #else
 139                 pm,nfmt
 140 #endif
 141                 ,ap);
 142         va_end(ap);
 143
 144 #ifndef PRINTF_WORKS_PM
 145         if (pm) {
 146                 fputs(strerror(errno),stderr);
 147                 free(nfmt);
 148                 }
 149 #endif
 150
 151         if (fatal!='\n') fputc((fatal=='.'?'.':'!'),stderr);
 152         fputc('\n',stderr);
 153         if (fatal=='!') exit(EXIT_FAILURE);
 154 }
 155
 156 static void chk(void *p)
 157 {
 158         if (p) return;
 159         error("!Virtual memory exhausted");
 160 }
 161
 162 static void cleanup(void)
 163 {
 164         d1("cleanup()\n");
 165         if (dis_cleanup) return;
 166         if (restios_yes) {
 167                 if (tcsetattr(devfd,TCSANOW,&restios))
 168                         error("Error restoring termios for device: %m");
 169                 restios_yes=0;
 170                 }
 171         if (locked && *lockreal) {
 172                 d2("Removing lockfile \"%s\"\n",lockreal);
 173                 if (unlink(lockreal))
 174                         error("Error removing my device lockfile \"%s\": %m",lockreal);
 175                 locked=0;
 176                 }
 177         dis_cleanup=1;
 178         exit(EXIT_FAILURE);
 179 }
 180
 181 static void usage(void)
 182 {
 183         fprintf(stderr,"\
 184 \n\
 185 %s\
 186 \n\
 187 Usage: " PACKAGE " [-c|--config <cfgfile>] [-d|--device <device>]\n\
 188              [-L|--log <file>] [-b|--baud <rate>]\n\
 189              [-l|--lockfile <lock>] [-s|--smsc <smsc #>] [-m|--maxretry <#>]\n\
 190              [-r|--readtime <sec>] [-t|--chartime <msec>] [-T|--cmdtime <msec>]\n\
 191              [-v|--verbose] [-h|--help] [-V|--version]\n\
 192              <dest. phone> <logo filename> [<GSMnet id>]\n\
 193 \n\
 194  -c, --config\tRead this additional config file\n\
 195 \t\t(def. \"" CONFIG_MAIN "\" and \"$HOME" CONFIG_HOME "\")\n\
 196  -d, --device\tNokia on this serial device (def. \"" DEF_DEVICE "\")\n\
 197  -L, --log\tLog all important messages to this file (def. \"" DEF_LOGNAME "\")\n\
 198  -b, --baud\tSet baudrate, 2400-57600 supported (def. %d)\n\
 199  -l, --lockfile\tLock serial port by this file, \"%%s\" is basename of device\n\
 200 \t\t(def. \"%s\")\n\
 201  -s, --smsc\tUse this SMS Center number (def. query from Nokia 9110)\n\
 202  -m, --maxretry\tMaximum retries of any command before giving up (def. %d)\n\
 203  -r, --readtime\tSeconds for maximum wait time for response (def. %ds)\n\
 204  -t, --chartime\tMilliseconds between each char (def. %dms)\n\
 205  -T, --cmdtime\tMilliseconds before each whole AT command (def. %dms)\n\
 206  -v, --verbose\tIncrease verbosity level, more \"-v\"s give more messages\n\
 207  -h, --help\tPrint a summary of the options\n\
 208  -V, --version\tPrint the version number\n\
 209  <GSMnet id>\t* Oper. logo: Enter custom network code MccMnc, e.g. 23002\n\
 210 \t\t* Oper. logo: Specify \"" WORD_NET "\" to read network code from NOL file\n\
 211 \t\t* Group gfx : Specify \"" WORD_GROUP "\" to send logo as group graphics\n\
 212 \n",version,DEF_BAUD,DEF_LOCKFILE,DEF_MAXRETRY,DEF_READTIME,DEF_CHARTIME,DEF_CMDTIME);
 213         exit(EXIT_FAILURE);
 214 }
 215
 216 static const struct option longopts[]={
 217 {"config"  ,1,0,'c'},
 218 {"device"  ,1,0,'d'},
 219 {"log"     ,1,0,'L'},
 220 {"baud"    ,1,0,'b'},
 221 {"lockfile",1,0,'l'},
 222 {"smsc"    ,1,0,'s'},
 223 {"maxretry",1,0,'m'},
 224 {"readtime",1,0,'r'},
 225 {"chartime",1,0,'t'},
 226 {"cmdtime" ,1,0,'T'},
 227 {"verbose" ,0,0,'v'},
 228 {"help"    ,0,0,'h'},
 229 {"version" ,0,0,'V'}};
 230
 231 static void processargs(int argp,char **args,const char *from);
 232
 233 static char *cfgstack[MAXCFGLOOP];
 234 static unsigned cfgstacki=0;
 235
 236 static void chkfclose(FILE *f,const char *fname)
 237 {
 238         if (fclose(f))
 239                 error("Error closing \"%s\": %m",fname);
 240 }
 241
 242 static void readfile(const char *fname,char quiet)
 243 {
 244 FILE *f;
 245 size_t got;
 246 char *args[MAXCFGARGS],*d,*s,blank,quote;
 247 unsigned argp;
 248 char *buf;
 249 long size;
 250 static unsigned tot=0;
 251
 252         if (tot++>=MAXCFGNUM) {
 253                 if (tot==MAXCFGNUM+1) error("Too many config files to read, max is %d, break-out",MAXCFGNUM);
 254                 return;
 255                 }
 256         if (!(f=fopen(fname,"rt"))) {
 257                 if (!quiet) error("Can't open config file \"%s\" for r/o: %m",fname);
 258                 return;
 259                 }
 260         if (verbose>=2) error(".Reading config file \"%s\"",fname);
 261         if (fseek(f,0,SEEK_END))
 262                 error("Error seeking to end of \"s\": %m",fname);
 263         if ((size=ftell(f))<0)
 264                 size=0,error("Error measuring \"%s\": %m",fname);
 265         if (size>MAXCONFIG)
 266                 error("File \"%s\" is too long, read only %ld bytes",fname,MAXCONFIG);
 267         chk(buf=malloc((size?size:MAXCONFIG)+1));
 268         rewind(f);
 269         got=fread(buf,1,(size?size:MAXCONFIG),f);
 270         if (size && got!=size)
 271                 error("File \"%s\" read error, got only %u bytes of %ld",fname,got,size);
 272         chkfclose(f,fname);
 273         buf[got]='\0';
 274         args[0]=pname;
 275         for (argp=1,d=s=buf,blank=1,quote=0;s<buf+got;s++) {
 276 char c=*s;
 277
 278                 if (!quote && isspace(c)) {
 279                         if (!blank) {
 280                                 *d='\0';
 281                                 blank=1;
 282                                 if (verbose>=2) error("\nConfig \"%s\": arg#%d: %s",fname,argp-1,args[argp-1]);
 283                                 }
 284                         continue;
 285                         }
 286                 if (blank) {
 287                         if (argp>=NELEM(args)-1) {
 288                                 error("Too many arguments in \"%s\", from offset %d ignored",fname,s-buf);
 289                                 break;
 290                                 }
 291                         args[argp++]=s;
 292                         d=s;
 293                         blank=0;
 294                         }
 295                 if (c=='\\') { *d++=*++s; continue; }
 296                 if (c=='"' || c=='\'') {
 297                         if (!quote   ) { quote=c; continue; }
 298                         if ( quote==c) { quote=0; continue; }
 299                         /* FALLTHRU */
 300                         }
 301                 *d++=c;
 302                 }
 303         args[argp]=NULL;
 304         processargs(argp,args,fname);
 305         free(buf);
 306 }
 307
 308 static struct {
 309         const char c;
 310         char **const var;
 311         unsigned stamp;
 312         } optset[]={
 313                 { 'd',&device   },
 314                 { 'L',&logname  },
 315                 { 'b',&baud     },
 316                 { 'l',&lockfile },
 317                 { 's',&smsc     },
 318                 { 'm',&maxretry },
 319                 { 'r',&readtime },
 320                 { 't',&chartime },
 321                 { 'T',&cmdtime  },
 322         };
 323
 324 static void processargs(int argp,char **args,const char *from)
 325 {
 326 int optc;
 327 static unsigned seq=0;
 328 int i;
 329
 330         seq++;
 331         optarg=NULL; optind=0; /* FIXME: Possible portability problem. */
 332         while ((optc=getopt_long(argp,args,"c:d:L:l:s:m:r:t:T:fvhV",longopts,NULL))!=EOF) switch (optc) {
 333                 case 'c':
 334                         if (cfgstacki>=NELEM(cfgstack)) {
 335                                 error("Looping (%d) during attempt to read config file \"%s\", break-out",NELEM(cfgstack),optind);
 336                                 break;
 337                                 }
 338                         chk(cfgstack[cfgstacki++]=strdup(optarg));
 339                         break;
 340                 case 'd': case 'L': case 'b': case 'l': case 's': case 'm': case 'r': case 't': case 'T':
 341                         for (i=0;i<NELEM(optset);i++)
 342                                 if (optset[i].c==optc) {
 343                                         if (optset[i].stamp && optset[i].stamp!=seq) {
 344                                                 assert(!!*optset[i].var);
 345                                                 break;
 346                                                 }
 347                                         free(*optset[i].var);
 348                                         chk(*optset[i].var=strdup(optarg));
 349                                         optset[i].stamp=seq;
 350                                         break;
 351                                         }
 352                         assert(i<NELEM(optset));
 353                         break;
 354                 case 'v':
 355                         verbose++;
 356                         break;
 357                 case 'V':
 358                         fprintf(stderr,version);
 359                         exit(EXIT_FAILURE);
 360                 default:
 361                         if (optc!='h')
 362                                 error("\nLast getopt(3) error occured during parsing option %d from \"%s\"! Follows help:",optind-1,from);
 363                         usage();
 364                         break;
 365                 }
 366         if (!phone && optind<argp) {
 367 char *s,*s1;
 368
 369                 chk(phone=strdup(args[optind++]));
 370                 for (s=(s1=phone)+(*phone=='+');*s && s-s1<MAXNUMLEN;s++)
 371                         if (!isdigit(*s))
 372                                 error("!Invalid digit '%c' in destination phone number - at offset %d of option %d from \"%s\": %s",
 373                                         *s,s-phone,optind,from,args[optind]);
 374                 if (*s)
 375                         error("!Destination phone number too long, max. %d digits allowed in option %d from \"%s\": %s",
 376                                 s-s1,optind,from,args[optind]);
 377                 }
 378         if (!logoname && optind<argp)
 379                 chk(logoname=strdup(args[optind++]));
 380         if (!gsmnet && optind<argp) {
 381 char *s,*d,e=0;
 382
 383                 chk(gsmnet=strdup(args[optind++]));
 384                 if (strcasecmp(gsmnet,WORD_NET) && strcasecmp(gsmnet,WORD_GROUP)) {
 385                         for (d=s=gsmnet;*s;s++) {
 386                                 if (isdigit(*s)) { *d++=*s; continue; }
 387                                 if (isspace(*s)) continue;
 388                                 error("\nInvalid characted '%c' in GSMnet at offs %d: %s",
 389                                         *s,s-gsmnet,args[optind]);
 390                                 e=1;
 391                                 break;
 392                                 }
 393                         if ((d-gsmnet)!=5) {
 394                                 error("\nGSMnet is required to have exactly 5 digits or to be\n\
 395 either \"" WORD_NET "\" or \"" WORD_GROUP "\", but found length %d: %s",
 396                                         d-gsmnet,args[optind]);
 397                                 e=1;
 398                                 }
 399                         if (!e) *d='\0';
 400                         else {
 401                                 error("\nGSMnet option %d from \"%s\" rejected due to previous errors: %s",
 402                                         optind,from,args[optind]);
 403                                 free(gsmnet);
 404                                 gsmnet=NULL;
 405                                 }
 406                         }
 407                 }
 408         while (optind<argp)
 409                 error("\nExcessive option %d from \"%s\" ignored: %s",optind,from,args[optind]);
 410         while (cfgstacki) {
 411 char *s=cfgstack[--cfgstacki];
 412
 413                 assert(cfgstacki>=0);
 414                 readfile(s,0);
 415                 free(s);
 416                 assert(cfgstacki>=0 && cfgstacki<NELEM(cfgstack));
 417                 }
 418 }
 419
 420 static const struct {
 421         char **var;
 422         const char *name;
 423         } nullcheck[]={
 424                 {&phone,"destination phone number"},
 425 #if 0
 426                 {&logoname,"logo filename"},
 427                 {&gsmnet,"GSM operator network code"},
 428                 {&device,"device for communication"},
 429 #endif
 430         };
 431 static char **emptycheck[]={&logname,&smsc,&logoname,&gsmnet};
 432
 433 static void lockclose(int fd)
 434 {
 435         if (close(fd))
 436                 error("Error closing lockfile \"%s\"",lockreal);
 437 }
 438
 439 static inline void lockdevice(void)
 440 {
 441 int fd=-1;
 442 char buf[64];
 443 ssize_t got;
 444 int delay=0;
 445 char empty=0;
 446 pid_t pid;
 447
 448         for (;;) {
 449                 if (fd!=-1) lockclose(fd);
 450 recheck:
 451                 if (delay) sleep(delay);
 452                 delay=DEVLOCK_PERIOD;
 453                 if (verbose>=3) error(".Checking the lockfile \"%s\"..",lockreal);
 454                 if ((fd=open(lockreal,O_RDONLY))==-1) break;
 455                 if ((got=read(fd,buf,sizeof(buf)-1))<=0) {
 456 isempty:
 457                         if (empty>=DEVLOCK_MAXEMPTY) {
 458                                 error(".Lockfile \"%s\" is still not valid, removing it",lockreal);
 459                                 goto remove;
 460                                 }
 461                         empty++;
 462                         continue;
 463                         }
 464                 assert(got<sizeof(buf));
 465                 buf[got]='\0';
 466                 if (sscanf(buf,"%d",&pid)!=1) goto isempty;
 467                 empty=0;
 468                 errno=0;
 469                 if (kill(pid,0) && errno!=ESRCH && errno!=EPERM)
 470                         error("Error during checking consciousness of PID %d: %m",pid);
 471                 if (errno!=ESRCH) continue;
 472                 error(".Lockfile \"%s\" is stale (PID %d), removing it",lockreal,pid);
 473 remove:
 474                 lockclose(fd);
 475                 if (unlink(lockreal))
 476                         error("Error removing foreign lockfile \"%s\": %m",lockreal);
 477                 break;
 478                 }
 479         errno=0;
 480         if ((fd=open(lockreal,O_WRONLY|O_CREAT|O_EXCL,0644))==-1) {
 481                 if (errno==EEXIST) goto recheck;
 482                 error("!Error creating lockfile \"%s\": %m",lockreal);
 483                 }
 484         locked=1;
 485         got=VARPRINTF(buf,"%010d\n",getpid()); assert(got==11);
 486         if (write(fd,buf,got)!=got)
 487                 error("!Error writing data to lockfile \"%s\": %m",lockreal);
 488         lockclose(fd);
 489 }
 490
 491 static char wasalarm=0;
 492 static void sigalarm(int signo)
 493 {
 494         signal(SIGALRM,(RETSIGTYPE (*)(int))sigalarm);
 495         wasalarm=1;
 496         if (verbose>=1) error("Timed out");
 497 }
 498
 499 static void blocking(char yes)
 500 {
 501 static char state=-1;
 502         if (state==yes) return;
 503         if (fcntl(devfd,F_SETFL,(yes?0:O_NONBLOCK)))
 504                 error("!fcntl() on device for %sblocking mode: %m",(yes?"":"non-"));
 505         state=yes;
 506 }
 507
 508 static const char *record;
 509 static char *catchdata;
 510 static size_t catchdatal,catchdatasiz;
 511
 512 static void catched(const char *end)
 513 {
 514 size_t len;
 515 void *p;
 516
 517         if (!record) return;
 518         assert(end>=record);
 519         if ((p=memchr(record,'\n',end-record))) end=p;
 520         if ((len=end-record)) {
 521                 if (catchdatal+len>catchdatasiz)
 522                         chk(catchdata=realloc(catchdata,
 523                                 (catchdatasiz=MAX(LINE_MAX,(catchdatal+len)*2))));
 524                 memcpy(catchdata+catchdatal,record,len);
 525                 catchdatal+=len;
 526                 }
 527         record=(p?NULL:end);
 528         assert(catchdatal<=catchdatasiz);
 529 }
 530
 531 static int retrycnt=0;
 532 static void retrying(void)
 533 {
 534         if (++retrycnt>maxretryn) error("!Maximum command retry count (%d) exceeded",maxretryn);
 535         if (verbose>=2) error(".Retrying phase, %d out of %d..",retrycnt,maxretryn);
 536 }
 537
 538 static char *devcmd(const char *term,const char *catch,const char *send,...)
 539 {
 540 size_t l,bufl,terml,catchl,fragl,offs;
 541 char buf[LINE_MAX];
 542 ssize_t got;
 543 char *hit,*s;
 544 va_list ap;
 545 char errout;
 546
 547         if (!term) term="\nOK\n";
 548         if ((errout=(*send=='!'))) send++;
 549         if (0) {
 550 err:
 551                 alarm(0);
 552                 if (errout) return(NULL);
 553                 retrying();
 554                 }
 555         catchdatal=0;
 556         va_start(ap,send);
 557         l=VARVPRINTF(buf,send,ap); bufl=l+1;
 558         va_end(ap);
 559         if (bufl>=sizeof(buf)-1) error("!Command too big (%d>%d)",bufl,sizeof(buf)-1);
 560         if (verbose>=2) error(".devcmd(send=\"%s\",term=\"%s\",catch=\"%s\")",buf,term,catch);
 561         buf[l]='\r'; buf[l+1]='\n';
 562         for (offs=0,got=0;offs<bufl;offs++) {
 563                 alarm(MAXSENDTIME);
 564                 usleep((offs?chartimen:cmdtimen)*1000);
 565                 if (!offs && tcflush(devfd,TCIOFLUSH))
 566                         error("Error flushing I/O queue of device: %m");
 567                 if (write(devfd,buf+offs,1)!=1) break;
 568                 got++;
 569                 if (tcdrain(devfd))
 570                         error("Error forcing output of char %d of cmd \"%s\": %m",offs,buf);
 571                 }
 572         alarm(0);
 573         if (got!=bufl) {
 574                 error("Wrote only %d of %d bytes of command: %m",got,bufl);
 575                 goto err;
 576                 }
 577
 578         if (!(terml=strlen(term))) {
 579                 assert(!catch);
 580                 return(NULL);
 581                 }
 582         if (catch) {
 583                 catchl=strlen(catch);
 584                 fragl=MAX(terml,catchl);
 585                 }
 586         else fragl=terml;
 587         fragl=MAX(fragl,MAX(strlen(ERROR_SUBSTR1),strlen(ERROR_SUBSTR2)));
 588         bufl=0;
 589         record=NULL;
 590         wasalarm=0;
 591         alarm(readtimen);
 592         for (;;) {
 593                 blocking(0);
 594                 errno=0;
 595                 got=read(devfd,buf+bufl,sizeof(buf)-1-bufl);
 596                 if (got==-1 && errno==EAGAIN) {
 597                         blocking(1);
 598                         errno=0;
 599                         got=read(devfd,buf+bufl,1);
 600                         }
 601                 if (got<=0) {
 602                         if (wasalarm) error("!Maximum response timeout (%ds) exceeded",readtimen);
 603                         error("Couldn't read device data (ret=%d): %m",got);
 604                         goto err;
 605                         }
 606                 s=buf+bufl;
 607                 bufl+=got;
 608                 /* FIXME: '\0' conversion */
 609                 while (buf+bufl>s && (s=memchr(s,'\r',buf+bufl-s))) *s='\n';
 610                 catched(buf+bufl); assert(!record || record==buf+bufl);
 611                 assert(bufl<sizeof(buf));
 612                 if (bufl>=fragl) {
 613                         buf[bufl]='\0';
 614                         assert(strlen(buf)==bufl);
 615                         /* d3(">%s|%s<\n",buf,term); */
 616                         if (strstr(buf,ERROR_SUBSTR1) || strstr(buf,ERROR_SUBSTR2)) {
 617                                 error("Found ERROR response on command \"%s\"",send);
 618                                 goto err;
 619                                 }
 620                         if (catch && bufl>=catchl && (hit=strstr(buf,catch))) {
 621                                 record=hit+catchl;
 622                                 catched(buf+bufl); assert(!record || record==buf+bufl);
 623                                 }
 624                         if (         bufl>= terml && (hit=strstr(buf,term))) break;
 625                         memmove(buf,buf+bufl-(fragl-1),fragl-1);
 626                         bufl=fragl-1;
 627                         if (record) record=buf+bufl;
 628                         }
 629                 }
 630         alarm(0);
 631         if (!catchdatal) {
 632                 if (!catch) return(NULL);
 633                 error("Data requested on command \"%s\" but no found after term \"%s\"",send,term);
 634                 goto err;
 635                 }
 636         assert(!!catch);
 637         record=buf;
 638         buf[0]='\0';
 639         catched(buf+1);
 640         if (verbose>=2) error(".Returning data \"%s\" for cmd \"%s\"",catchdata,send);
 641         return(catchdata);
 642 }
 643
 644 static inline char tohex(unsigned char x)
 645 {
 646         x&=0x0F;
 647         if (x<10) return(x   +'0');
 648                   return(x-10+'A');
 649 }
 650
 651 static inline void textconv(char *d,unsigned char *s,size_t len)
 652 {
 653         while (len--) {
 654                 *d++=tohex(*s>>4U);
 655                 *d++=tohex(*s    );
 656                 s++;
 657                 }
 658         *d='\0';
 659 }
 660
 661 static inline void smscset(void)
 662 {
 663 char *s,*t,*e,*serr;
 664 long l;
 665
 666         if (smsc) devcmd(NULL,NULL,"\r\nAT+CSCA=\"%s\"",smsc);
 667         s=devcmd(NULL,"\n+CSCA:","\r\nAT+CSCA?");
 668         while (isspace(*s)) s++;
 669         if (!*s || !strcmp(s,"EMPTY"))
 670                 error("!No SMS set in Nokia found");
 671         if (verbose>=1) error("\nFound default SMSC in Nokia: %s",s);
 672         if (*s!='"') error("!No left-quote found in: %s",s);
 673         if (!(t=strrchr(s+1,'"'))) error("!No right-quote found in: %s",s);
 674         e=t++;
 675         while (isspace(*t)) t++;
 676         if (*t++!=',') error("!No comma found after quotes in: %s",s);
 677         while (isspace(*t)) t++;
 678         l=strtol(t,&serr,10);
 679         if ((l!=ADDR_NAT && l!=ADDR_INT) || (serr && *serr))
 680                 error("!Type parse error in: %s",s);
 681         if (l==ADDR_NAT || s[1]=='+') s++;
 682         else *s='+';
 683         *e='\0';
 684         if (verbose>=2) error("\nDecoded SMSC address: %s",s);
 685 }
 686
 687 /* Logo format shamelessly stolen from GNokii-0.3.0: http://www.gnokii.org/
 688  * Beware - Nokia Smart Messaging specification 1.0.0 and 2.0.0 is incompatible
 689  * with Nokia current product line implementation
 690  * http://www.forum.nokia.com/developers/smartmsg/download/ssm2_0_0.pdf
 691  */
 692
 693 static char hexdata[140*2+1];
 694
 695 static inline void logoread(void)
 696 {
 697 FILE *f;
 698 char buf[32+140*8+1];
 699 unsigned char bin[140]={
 700         0x06, /* UDH length */
 701         0x05, /* IEI */
 702         0x04, /* IEDL */
 703         0x15, 0x83, /* dest port (group gfx) */
 704         0x00, 0x00  /* src port (unused) */
 705         };
 706 size_t got,r,w;
 707 ssize_t chars,bits;
 708 char gsmnetf[10];
 709 int sizex,sizey,bit;
 710
 711 #define WORD(n) (((unsigned char)buf[(n)])|(((unsigned char)buf[(n)+1])<<8))
 712
 713         if (!(f=fopen(logoname,"rb")))
 714                 error("!Cannot open logo file \"%s\" for r/o: %m",logoname);
 715         got=fread(buf,1,sizeof(buf),f);
 716              if (got>=20 && !memcmp(buf,"NOL",4)) {
 717                 VARPRINTF2(gsmnetf,"%03.3u%02.2u",WORD(6),WORD(8));
 718                 assert(strlen(gsmnetf)==5);
 719                 r=10;
 720                 if (verbose>=1) error(".Reading NOL file \"%s\", GSMnet \"%s\", word@4=%d..",
 721                         logoname,gsmnetf,WORD(4));
 722                 }
 723         else if (got>=16 && !memcmp(buf,"NGG",4)) {
 724                 r=6;
 725                 if (verbose>=1) error(".Reading NGG file \"%s\", word@4=%d..",
 726                         logoname,gsmnetf,WORD(4));
 727                 }
 728         else error("!Unknown file format of logo file \"%s\"");
 729         if (!strcasecmp(gsmnet,WORD_NET)) {
 730                 if (!*gsmnetf) error("!NOL network code detection requested but NOL file not loaded, please specify network code");
 731                 gsmnet=gsmnetf;
 732                 }
 733         if (!strcasecmp(gsmnet,WORD_GROUP) || !*gsmnet) {
 734                 error("\nSending logo as: group graphics");
 735                 gsmnet=NULL;
 736                 }
 737         else {
 738                 error("\nSending logo as: operator logo for \"%s\"",gsmnet);
 739                 bin[4]=0x82; /* dest port 0x1582 */
 740                 }
 741
 742         sizex=WORD(r); sizey=WORD(r+2);
 743         if (verbose>=2) error(".Magic words: @+4=%d, @+6=%d, @+8=%d",
 744                         WORD(r+4),WORD(r+6),WORD(r+8));
 745         r+=10;
 746         if (sizex<1 || sizex>255
 747          || sizey<1 || sizey>255) error("!Invalid size: %dx%d",sizex,sizey);
 748         chars=((bits=sizex*sizey)+7)/8;
 749         if (r+bits>got) error("!Logo file \"%s\" too short - actual=%d, need(%dx%d)=%d",
 750                 logoname,got,sizex,sizey,r+chars);
 751         else if (r+bits<got)
 752                 if (verbose>=1) error("Ignoring trailing garbage in \"%s\", used only %d bytes",logoname,r+bits);
 753         if ((got=(7+(gsmnet?3:0)+4+chars))>140)
 754                 error("!SMS size would be %d bytes but 140 is maximum",got);
 755         w=7;
 756         if (gsmnet) {
 757                 bin[w++]=((gsmnet[1]&0x0F)<<4)|(gsmnet[0]&0x0F);
 758                 bin[w++]=0xF0                 |(gsmnet[2]&0x0F);
 759                 bin[w++]=((gsmnet[4]&0x0F)<<4)|(gsmnet[3]&0x0F);
 760                 }
 761         bin[w++]=0x00; /* RFU by Nokia */
 762         bin[w++]=sizex; bin[w++]=sizey;
 763         bin[w++]=0x01; /* one B/W plane */
 764         while (chars--) {
 765                 bin[w]=0;
 766                 for (bit=0x80;(bits>0) && (bit>0);bits--,bit>>=1) {
 767                         if (buf[r]!='0' && buf[r]!='1')
 768                                 error("!Invalid character (neither '0' nor '1')in logo file \"%s\" at offset 0x%X",
 769                                         logoname,r);
 770                         if (buf[r++]=='1') bin[w]|=bit;
 771                         }
 772                 w++;
 773                 }
 774         assert(chars==-1); assert(bits==0); assert(w==got); assert(w<=140);
 775         textconv(hexdata,bin,w);
 776         if (verbose>=2) error("\nWill send hexdata: %s",hexdata);
 777 }
 778
 779 static struct {
 780         char **sp;
 781         long *ip;
 782         const char *const msg;
 783         } numarg[]={
 784                 { &maxretry,&maxretryn,"maxretry" },
 785                 { &readtime,&readtimen,"readtime" },
 786                 { &chartime,&chartimen,"chartime" },
 787                 { &cmdtime ,&cmdtimen ,"cmdtime"  },
 788                 { &baud    ,&baudn    ,"baud"     },
 789         };
 790
 791 int main(int argc,char **argv)
 792 {
 793 char *s;
 794 int i;
 795 unsigned fatal=0;
 796 speed_t portbaud;
 797
 798         if ((s=strrchr((pname=*argv),'/'))) pname=s+1;
 799         atexit(cleanup);
 800         signal(SIGTERM,(RETSIGTYPE (*)(int))cleanup);
 801         signal(SIGQUIT,(RETSIGTYPE (*)(int))cleanup);
 802         signal(SIGINT ,(RETSIGTYPE (*)(int))cleanup);
 803         signal(SIGHUP ,(RETSIGTYPE (*)(int))cleanup);
 804         processargs(argc,argv,"<command-line>");
 805         if ((s=getenv("HOME"))) {
 806 size_t l=strlen(s);
 807 char *buf=malloc(l+50);
 808
 809                 memcpy(buf,s,l);
 810                 strcpy(buf+l,CONFIG_HOME);
 811                 readfile(buf,1);
 812                 free(buf);
 813                 }
 814         readfile(CONFIG_MAIN,1);
 815
 816         for (i=0;i<NELEM(nullcheck);i++)
 817                 if (!*nullcheck[i].var) {
 818                         error("Missing parameter \"%s\"",nullcheck[i].name);
 819                         fatal++;
 820                         }
 821         if (fatal) error("!Previous error%s considered unrecoverable",(fatal==1?"":"s"));
 822         for (i=0;i<NELEM(emptycheck);i++)
 823                 if (*emptycheck[i] && !**emptycheck[i]) {
 824                         free(*emptycheck[i]);
 825                              *emptycheck[i]=NULL;
 826                         }
 827         if (!logname) logname=DEF_LOGNAME;
 828         if (!lockfile) lockfile=DEF_LOCKFILE;
 829         if (!device) device=DEF_DEVICE;
 830         logoread();
 831
 832         for (i=0;i<NELEM(numarg);i++) {
 833 char *serr;
 834                 if (!*numarg[i].sp) continue;
 835                 *numarg[i].ip=strtol(*numarg[i].sp,&serr,0);
 836                 if (*numarg[i].ip<0 || *numarg[i].ip>=LONG_MAX || !serr || *serr)
 837                         error("!Number parse error for parameter \"%s\" of \"%s\" at: %s",
 838                                 numarg[i].msg,*numarg[i].sp,serr);
 839                 }
 840
 841         if (!strchr(device,'/')) {
 842 size_t l=strlen(device);
 843                 chk(s=malloc(5+l+1));
 844                 strcpy(s,"/dev/");
 845                 strcpy(s+5,device);
 846                 free(device);
 847                 device=s;
 848                 }
 849         devicename=strrchr(device,'/')+1; assert(!!(devicename-1));
 850         for (i=0,s=lockfile;*s;s++) {
 851                 if (*s!='%') continue;
 852                 s++;
 853                 if (*s=='%') continue;
 854                 if (*s=='s') {
 855                         if (i) error("!Only one \"%%s\" permitted in lockfile format-string");
 856                         i=1; continue;
 857                         }
 858                 error("!Invalid format-character '%c' in lockfile format-string, only \"%%s\" allowed",*s);
 859                 }
 860
 861         if (*logname) {
 862                 if (!(logf=fopen(logname,"a")))
 863                         error("!Error opening log \"%s\" for append: %m",logname);
 864                 logmsg("Starting up: " PACKAGE " " VERSION);
 865                 }
 866         switch (baudn) {
 867                 case  2400: portbaud= B2400; break;
 868                 case  4800: portbaud= B4800; break;
 869                 case  9600: portbaud= B9600; break;
 870                 case 19200: portbaud=B19200; break;
 871                 case 38400: portbaud=B38400; break;
 872                 case 57600: portbaud=B57600; break;
 873                 default:
 874                         error("!Specified baudrate %d is not supported",baudn);
 875                 }
 876         if (verbose>=2) error(".Will use baudrate %d with hexval 0x%X",baudn,portbaud);
 877
 878         if (lockfile && *lockfile && VARPRINTF(lockreal,lockfile,devicename)>0) {
 879 time_t start,end;
 880                 if (verbose>=1) error(".Locking device \"%s\" by \"%s\"..",device,lockreal);
 881                 time(&start);
 882                 lockdevice();
 883                 time(&end);
 884                 if ((end-=start)>LOCKREPORT)
 885                         logmsg("Device lock succeeded after %d seconds",end);
 886                 }
 887         if (verbose>=1) error(".Opening device \"%s\"..",device);
 888         if ((devfd=open(device,O_RDWR|O_NDELAY))<0)
 889                 error("!Cannot open device \"%s\" for rw-access: %m",device);
 890
 891         if (tcgetattr(devfd,&restios))
 892                 error("Unable to get termios settings: %m");
 893         else {
 894                 restios.c_cflag=(restios.c_cflag&~(CBAUD|CBAUDEX))|B0|HUPCL;
 895                 restios_yes=1;
 896                 }
 897         tios.c_iflag=IGNBRK|IGNPAR|IXON|IXOFF;
 898         tios.c_oflag=0;
 899         tios.c_cflag=CS8|CREAD|CLOCAL|HUPCL|portbaud;
 900         tios.c_lflag=IEXTEN|NOFLSH;
 901         memset(tios.c_cc,_POSIX_VDISABLE,sizeof(tios.c_cc));
 902         tios.c_cc[VTIME]=0;
 903         tios.c_cc[VMIN ]=1;
 904             cfsetispeed(&tios,portbaud);
 905         if (cfsetospeed(&tios,portbaud)|cfsetispeed(&tios,portbaud))
 906                 error("Error setting termios baudrate on device: %m");
 907         if (tcflush(devfd,TCIOFLUSH))
 908                 error("Error flushing termios (TCIOFLUSH) on device: %m");
 909         if (tcsetattr(devfd,TCSANOW,&tios))
 910                 error("!Unable to set initial termios device settings: %m");
 911
 912         signal(SIGALRM,(RETSIGTYPE (*)(int))sigalarm);
 913         do {
 914                 devcmd("",NULL,"\r\nAT\033");
 915                 devcmd(NULL,NULL,"\r\nAT");
 916                 smscset();
 917                 devcmd(NULL,NULL,"\r\nAT+CSMP=81,,0,245");
 918                 devcmd("\n> ",NULL,"\r\nAT+CMGS=\"%s\"",phone);
 919                 if (!(s=devcmd(NULL,"\n+CMGS:","!%s\032",hexdata))) {
 920                         retrying();
 921                         continue;
 922                         }
 923                 devcmd(NULL,NULL,"\r\nAT+CSMP=17,,0,0");
 924                 devcmd(NULL,NULL,"\r\nAT");
 925                 } while (0);
 926         while (isspace(*s)) s++;
 927         if (verbose>=1) error("\nMessage successfuly sent with MR: %s",s);
 928         devcmd(NULL,NULL,"\r\nAT");
 929
 930         logmsg("SMS sent (after %d retries), message reference: %s",retrycnt,s);
 931         return(EXIT_SUCCESS);
 932 }