X-Git-Url: https://git.jankratochvil.net/?p=mdsms.git;a=blobdiff_plain;f=mdsms.c;h=845c6297691f88a198dd2a8d495f33aa32cab68f;hp=879424992ac2f897c0c43535df6928801666883a;hb=3b127365dbbc640bc1a0813b24baa925b99f5079;hpb=024c037ad5868decb5d300355ccd6220848ee220 diff --git a/mdsms.c b/mdsms.c index 8794249..845c629 100644 --- a/mdsms.c +++ b/mdsms.c @@ -5,23 +5,57 @@ static char rcsid[] ATTR_UNUSED = "$Id$"; #include "setup.h" +#ifdef HAVE_STDIO_H #include +#endif +#ifdef HAVE_STDLIB_H #include +#endif +#ifdef HAVE_STRING_H #include +#endif +#ifdef HAVE_SIGNAL_H #include +#endif +#ifdef HAVE_STDARG_H #include +#endif +#ifdef HAVE_LIMITS_H #include +#endif +#ifdef HAVE_CTYPE_H #include -#include +#endif +#ifdef HAVE_TERMIOS_H #include +#endif +#ifdef HAVE_UNISTD_H #include +#endif +#ifdef HAVE_ASSERT_H #include +#endif +#ifdef HAVE_SYS_TYPES_H #include +#endif +#ifdef HAVE_SYS_STAT_H #include +#endif +#ifdef HAVE_FCNTL_H #include +#endif +#ifdef HAVE_ERRNO_H #include -#include +#endif +#ifdef HAVE_TIME_H #include +#endif +#ifdef HAVE_SYS_TIME_H +#include +#endif +#ifdef HAVE_SYS_POLL_H +#include +#endif #ifdef HAVE_GETOPT_LONG #include @@ -40,12 +74,16 @@ static char rcsid[] ATTR_UNUSED = "$Id$"; #define dO stderr #define dB(a) dbg(fprintf a) -#define d1(n1) dB((dO,n1 )) -#define d2(n1,n2) dB((dO,n1,n2 )) -#define d3(n1,n2,n3) dB((dO,n1,n2,n3 )) -#define d4(n1,n2,n3,n4) dB((dO,n1,n2,n3,n4)) +#define d1(n1) dB((dO,n1 )) +#define d2(n1,n2) dB((dO,n1,n2 )) +#define d3(n1,n2,n3) dB((dO,n1,n2,n3 )) +#define d4(n1,n2,n3,n4) dB((dO,n1,n2,n3,n4 )) +#define d5(n1,n2,n3,n4,n5) dB((dO,n1,n2,n3,n4,n5 )) +#define d6(n1,n2,n3,n4,n5,n6) dB((dO,n1,n2,n3,n4,n5,n6 )) +#define d7(n1,n2,n3,n4,n5,n6,n7) dB((dO,n1,n2,n3,n4,n5,n6,n7 )) +#define d8(n1,n2,n3,n4,n5,n6,n7,n8) dB((dO,n1,n2,n3,n4,n5,n6,n7,n8)) -static const char version[]="This is MobilDock SMS sender (" PACKAGE " " VERSION ")\n"; +static const char version[]="This is Mobile Device SMS tool (" PACKAGE " " VERSION ")\n"; static int verbose #ifdef DEBUG @@ -55,10 +93,32 @@ static int verbose static char *pname; static int dis_cleanup=0,devfd=-1; -static char *phone,*body,*device,*logname,*lockfile,*smsc,*maxretry,*readtime,*chartime,*cmdtime; +static char *phone,*device,*logname,*lockfile,*smsc,*maxretry,*readtime,*chartime,*cmdtime,*baud,*restore; static int readbody; -static long maxretryn=DEF_MAXRETRY,readtimen=DEF_READTIME,chartimen=DEF_CHARTIME,cmdtimen=DEF_CMDTIME; +static long maxretryn=DEF_MAXRETRY,readtimen=-1,chartimen=DEF_CHARTIME,cmdtimen=DEF_CMDTIME,baudn=DEF_BAUD; static size_t bodylen; +/* --send / --send-mobildock / --receive specific */ +static char *body; +/* --logo-send specific */ +static char *logoname,*gsmnet; + +static enum modenum { + MODE_UNKNOWN=0, +/* must differ from regular char-s */ + MODE_FIRST =0x3400, + MODE_SEND =MODE_FIRST+0, /* --send / --send-mobildock */ + MODE_SEND_MOBILDOCK=MODE_FIRST+1, /* --send-mobildock in before readtimen is set */ + MODE_RECEIVE =MODE_FIRST+2, /* --receive */ + MODE_LOGO_SEND =MODE_FIRST+3 /* --logo-send */ + } mode=MODE_UNKNOWN; +#define MODE_ORDER(x) ((x)-MODE_FIRST) +#define MODE_NAME(x) (longopts[MODE_ORDER((x))].name) +#define MODE_BIT(x) (1<=2 && !strcmp(fmt+fmtl-2,"%m")))) nfmt[fmtl-2]='\0'; -#endif - fprintf(stderr,"%s: ",pname); va_start(ap,fmt); - vfprintf(stderr, -#ifdef PRINTF_WORKS_PM - fmt -#else - nfmt -#endif - ,ap); - if (fatal=='!') vlogmsg( -#ifdef PRINTF_WORKS_PM - fmt -#else - pm,nfmt -#endif - ,ap); + vfprintf(stderr,fmt,ap); + if (fatal=='!') vlogmsg(pm,fatal,fmt,ap); va_end(ap); - -#ifndef PRINTF_WORKS_PM - if (pm) { - fputs(strerror(errno),stderr); - free(nfmt); - } -#endif - + if (pm) { fputs(": ",stderr); fputs(strerror(errno),stderr); } if (fatal!='\n') fputc((fatal=='.'?'.':'!'),stderr); fputc('\n',stderr); if (fatal=='!') exit(EXIT_FAILURE); } -static void chk(void *p) +static void chk(const void *p) { if (p) return; error("!Virtual memory exhausted"); } +static char *devcmd(const char *term,const char *catch,const char *send,...) ATTR_PRINTFORMAT(3,4); + +static void unlockdevice(int hard) +{ + d2("unlockdevice(), locked=%d\n",locked); + if (!locked || !*lockreal) return; + if (!hard && locked>1) { locked--; return; } + d2("Removing lockfile \"%s\"\n",lockreal); + if (unlink(lockreal)) + error("^Error removing my device lockfile \"%s\"",lockreal); + locked=0; +} + static void cleanup(void) { d1("cleanup()\n"); if (dis_cleanup) return; + if (restore) { +char *cmd=restore; + restore=NULL; + devcmd(NULL,NULL,"\r\nAT"); + devcmd(NULL,NULL,cmd); + devcmd(NULL,NULL,"\r\nAT"); + } if (restios_yes) { if (tcsetattr(devfd,TCSANOW,&restios)) - error("Error restoring termios for device: %m"); + error("^Error restoring termios for device"); restios_yes=0; } - if (locked && *lockreal) { - d2("Removing lockfile \"%s\"\n",lockreal); - if (unlink(lockreal)) - error("Error removing my device lockfile \"%s\": %m",lockreal); - locked=0; - } + unlockdevice(1); dis_cleanup=1; exit(EXIT_FAILURE); } @@ -187,35 +229,69 @@ static void usage(void) %s\ \n\ Usage: " PACKAGE " [-c|--config ] [-d|--device ]\n\ - [-L|--log ]\n\ + {--send | --send-mobildock | --receive | --logo-send}\n\ + [-L|--log ] [-b|--baud ]\n\ [-l|--lockfile ] [-s|--smsc ] [-m|--maxretry <#>]\n\ [-r|--readtime ] [-t|--chartime ] [-T|--cmdtime ]\n\ - [-f|--file] [-v|--verbose] [-h|--help] [-V|--version]\n\ - \n\ + [-v|--verbose] [-h|--help] [-V|--version]\n\ + --send / --send-mobildock:\n\ + [-f|--file] \n\ + --receive:\n\ + \n\ + --logo-send:\n\ + []\n\ \n\ -c, --config\tRead this additional config file\n\ \t\t(def. \"" CONFIG_MAIN "\" and \"$HOME" CONFIG_HOME "\")\n\ - -d, --device\tMobilDock on this serial device (def. \"" DEF_DEVICE "\")\n\ + -d, --device\tMobile on this serial device (def. \"" DEF_DEVICE "\")\n\ -L, --log\tLog all important messages to this file (def. \"" DEF_LOGNAME "\")\n\ + -b, --baud\tSet baudrate, 2400-57600 supported (def. %d)\n\ -l, --lockfile\tLock serial port by this file, \"%%s\" is basename of device\n\ \t\t(def. \"%s\")\n\ - -s, --smsc\tUse this SMS Center number (def. query from Siemens A1)\n\ + -s, --smsc\tUse this SMS Center number (def. query from mobile)\n\ -m, --maxretry\tMaximum retries of any command before giving up (def. %d)\n\ - -r, --readtime\tSeconds for maximum wait time for response (def. %ds)\n\ - -t, --chartime\tMilliseconds between each char on baud 19200 (def. %dms)\n\ + -r, --readtime\tSeconds for maximum wait time for response\n\ +\t\t(def. %ds standard, %ds for MobilDock modes, multiplied %dx for long cmds)\n\ + -t, --chartime\tMilliseconds between each char (def. %dms)\n\ -T, --cmdtime\tMilliseconds before each whole AT command (def. %dms)\n\ - -f, --file\tRead contents of message from file instead\n\ -v, --verbose\tIncrease verbosity level, more \"-v\"s give more messages\n\ -h, --help\tPrint a summary of the options\n\ -V, --version\tPrint the version number\n\ -\n",version,DEF_LOCKFILE,DEF_MAXRETRY,DEF_READTIME,DEF_CHARTIME,DEF_CMDTIME); +\n\ +--send / --send-mobildock:\n\ + -f, --file\tRead contents of message from file instead\n\ +--receive:\n\ + \tProgram to run on receive, message will be on stdin\n\ +\t\tFollowing substitutes are recognized:\n\ +\t\t%%p - source phone number\n\ +\t\t%%T - timestamp from SMSC as number of seconds from 1970\n\ +\t\t%%t - ctime(3) style timestamp (e.g. \"Wed Jun 30 21:49:08 1993\")\n\ +--logo-send:\n\ + \t* Oper. logo: Enter custom network code MccMnc, e.g. 23002\n\ +\t\t* Oper. logo: Specify \"" WORD_NET "\" to read network code from NOL file\n\ +\t\t* Group gfx : Specify \"" WORD_GROUP "\" to send logo as group graphics\n\ +\n\ +You may need to use the following line to catch all of this help text:\n\ +./mdsms 2>&1|more\n\ +\n",version,DEF_BAUD,DEF_LOCKFILE,DEF_MAXRETRY, +DEF_READTIME,DEF_READTIME_MOBILDOCK,EXT_READTIME,DEF_CHARTIME,DEF_CMDTIME); exit(EXIT_FAILURE); } static const struct option longopts[]={ +/* Modes has to be in-order on exact positions */ +{"send" ,0,0,MODE_SEND}, +{"send-mobildock",0,0,MODE_SEND_MOBILDOCK}, +{"receive" ,0,0,MODE_RECEIVE}, +{"logo-send" ,0,0,MODE_LOGO_SEND}, +/* Mode aliases may follow in no particular order * + * as long as no non-mode options is between them */ +{"send-md" ,0,0,MODE_SEND_MOBILDOCK}, +{"recv" ,0,0,MODE_RECEIVE}, {"config" ,1,0,'c'}, {"device" ,1,0,'d'}, {"log" ,1,0,'L'}, +{"baud" ,1,0,'b'}, {"lockfile",1,0,'l'}, {"smsc" ,1,0,'s'}, {"maxretry",1,0,'m'}, @@ -235,7 +311,7 @@ static unsigned cfgstacki=0; static void chkfclose(FILE *f,const char *fname) { if (fclose(f)) - error("Error closing \"%s\": %m",fname); + error("^Error closing \"%s\"",fname); } static void readfile(const char *fname,char quiet) @@ -253,16 +329,17 @@ static unsigned tot=0; return; } if (!(f=fopen(fname,"rt"))) { - if (!quiet) error("Can't open config file \"%s\" for r/o: %m",fname); + if (!quiet) error("^Can't open config file \"%s\" for r/o",fname); return; } + if (verbose>=2) error(".Reading config file \"%s\"",fname); if (fseek(f,0,SEEK_END)) - error("Error seeking to end of \"s\": %m",fname); + error("^Error seeking to end of \"%s\"",fname); if ((size=ftell(f))<0) - size=0,error("Error measuring \"%s\": %m",fname); + size=0,error("^Error measuring \"%s\"",fname); if (size>MAXCONFIG) - error("File \"%s\" is too long, read only %ld bytes",fname,MAXCONFIG); + error("File \"%s\" is too long, read only %d bytes",fname,MAXCONFIG); chk(buf=malloc((size?size:MAXCONFIG)+1)); rewind(f); got=fread(buf,1,(size?size:MAXCONFIG),f); @@ -304,6 +381,109 @@ char c=*s; free(buf); } +static struct argstack { + struct argstack *next; + int num,offset; + const char *from; + char *arg[1]; + } *argstack; + +static struct argstack **argstack_tail=&argstack; +static size_t lastargstack_len; +static const char *lastargstack_from; +static int lastargstack_index; + +static size_t argstack_size; +static int argstack_num; + +static void pushargstack(char **args,int num,int offset,const char *from,char stack) +{ +struct argstack *as; +int i; + + if (!num) return; + assert(num>=1); + chk(as=malloc(sizeof(*as)+sizeof(as->arg)*(num-1))); + as->num=num; + as->offset=offset; + if (!from) as->from=NULL; + else chk(as->from=strdup(from)); + for (i=0;iarg[i]=strdup(args[i])); + argstack_size+=strlen(args[i]); + } + argstack_num+=num; + if (stack) { + as->next=argstack; + argstack=as; + } + else { + as->next=NULL; + *argstack_tail=as; + argstack_tail=&as->next; + } +} + +static void pushargstack_one(char *s,char stack) +{ pushargstack(&s,1,0,NULL,stack); } + +static char *nextargstack(void) +{ +static int order=0; +char *r; + + if (argstack && order==argstack->num) { +struct argstack *as=argstack; + if (!(argstack=as->next)) + argstack_tail=&argstack; + order=0; + free((char *)as->from); + lastargstack_from=NULL; + free(as); + } + if (!argstack) { + assert(!argstack_num); assert(!argstack_size); + return(NULL); + } + assert(ordernum); + lastargstack_index=argstack->offset+order; + r=argstack->arg[order++]; + assert(argstack_num>0); argstack_num--; + lastargstack_len=strlen(r); + assert(argstack_size>=lastargstack_len); argstack_size-=lastargstack_len; + lastargstack_from=argstack->from; + return(r); +} + +static char *glueargstack(size_t *destlenp,const char *glue) +{ +size_t gluel=(glue?strlen(glue):0),destlen; +char *dest,*d,*s; + + if (!argstack_num) { + chk(dest=strdup("")); + if (destlenp) *destlenp=0; + return(dest); + } + destlen=argstack_size+(argstack_num-1)*gluel; + if (destlenp) *destlenp=destlen; + chk(dest=malloc(destlen+1)); + for (d=dest;(s=nextargstack());) { + memcpy(d,s,lastargstack_len); + free(s); + d+=lastargstack_len; + if (!argstack_num) break; + if (!glue) continue; + memcpy(d,glue,gluel); + d+=gluel; + assert(d<=dest+destlen); + } + assert(!argstack_num); + assert(d==dest+destlen); + *d='\0'; + return(dest); +} + static struct { const char c; char **const var; @@ -311,6 +491,7 @@ static struct { } optset[]={ { 'd',&device }, { 'L',&logname }, + { 'b',&baud }, { 'l',&lockfile }, { 's',&smsc }, { 'm',&maxretry }, @@ -327,15 +508,15 @@ int i; seq++; optarg=NULL; optind=0; /* FIXME: Possible portability problem. */ - while ((optc=getopt_long(argp,args,"c:d:L:l:s:m:r:t:T:fvhV",longopts,NULL))!=EOF) switch (optc) { + while ((optc=getopt_long(argp,args,"c:d:L:b:l:s:m:r:t:T:fvhV",longopts,NULL))!=EOF) switch (optc) { case 'c': if (cfgstacki>=NELEM(cfgstack)) { - error("Looping (%d) during attempt to read config file \"%s\", break-out",NELEM(cfgstack),optind); + error("Looping (%d) during attempt to read config file \"%s\", break-out",NELEM(cfgstack),from); break; } chk(cfgstack[cfgstacki++]=strdup(optarg)); break; - case 'd': case 'L': case 'l': case 's': case 'm': case 'r': case 't': case 'T': + case 'd': case 'L': case 'b': case 'l': case 's': case 'm': case 'r': case 't': case 'T': for (i=0;i=1) error("Timed out"); } @@ -477,7 +776,7 @@ static void blocking(char yes) static char state=-1; if (state==yes) return; if (fcntl(devfd,F_SETFL,(yes?0:O_NONBLOCK))) - error("!fcntl() on device for %sblocking mode: %m",(yes?"":"non-")); + error("^!fcntl() on device for %sblocking mode",(yes?"":"non-")); state=yes; } @@ -488,40 +787,94 @@ static size_t catchdatal,catchdatasiz; static void catched(const char *end) { size_t len; -void *p; +const char *p1,*p2; if (!record) return; assert(end>=record); - if ((p=memchr(record,'\n',end-record))) end=p; - if ((len=end-record)) { + p1=memchr(record,'\n',end-record); + p2=memchr(record,'\r',end-record); + if (!p1 || (p1 && p2 && p2catchdatasiz) chk(catchdata=realloc(catchdata, - (catchdatasiz=MAX(LINE_MAX,(catchdatal+len)*2)))); + (catchdatasiz=(catchdatal+len)*2))); memcpy(catchdata+catchdatal,record,len); catchdatal+=len; } - record=(p?NULL:end); + record=(p1?NULL:end); assert(catchdatal<=catchdatasiz); } static int retrycnt=0; static void retrying(void) { - if (++retrycnt>maxretryn) error("!Maximum command retry count (%d) exceeded",maxretryn); - if (verbose>=2) error(".Retrying phase, %d out of %d..",retrycnt,maxretryn); + if (maxretryn>=0 && ++retrycnt>maxretryn) error("!Maximum command retry count (%ld) exceeded",maxretryn); + if (verbose>=2) error(".Retrying phase, %d out of %ld..",retrycnt,maxretryn); +} + +static char *reform(const char *s,int slot) +{ +static struct formslot { + char *s; + size_t l; + } arr[3]; +char c,*d; +struct formslot *fs; + + assert(slot>=0 && slot"); + if (!(fs=&arr[slot])->s) + chk(fs->s=malloc(fs->l=LINE_MAX)); + d=fs->s; + for (*d++='"';(c=*s);s++) { + if (d>=fs->s+fs->l-10) { +off_t o=d-fs->s; + chk(fs->s=realloc(fs->s,(fs->l=(fs->l?fs->l*2:LINE_MAX)))); + d=fs->s+o; + } + if (c!='\\' && c!='"' && isprint(c)) { *d++=c; continue; } + *d++='\\'; + switch (c) { + case '\\': case '"': *d++=c; break; + case '\n': *d++='n'; break; + case '\r': *d++='r'; break; + case '\032': *d++='Z'; break; + case '\033': *d++='e'; break; + default: + d+=sprintf(d,"x%02X",(unsigned char)c); + break; + } + } + *d++='"'; *d='\0'; + return(fs->s); } +static char *devcmd(const char *term,const char *catch,const char *send,...) ATTR_PRINTFORMAT(3,4); static char *devcmd(const char *term,const char *catch,const char *send,...) { -size_t l,bufl,terml,catchl,fragl,offs; -char buf[LINE_MAX]; +size_t l,bufl2,terml,catchl,fragl,offs; +static char buf[LINE_MAX]; +static size_t bufl; ssize_t got; char *hit,*s; va_list ap; -char errout; +char errout,extend,convcr; +long alarmtime; +const char *osend; +static const char emptystring[]=""; if (!term) term="\nOK\n"; + convcr=!strchr(term,'\r'); + if (!strcmp(send," ")) send=NULL; /* GCC formatstring-check workaround */ + if (!(osend=send)) send=""; if ((errout=(*send=='!'))) send++; + errout|=(maxretryn==-1); + if ((extend=(*send=='~'))) send++; + alarmtime=readtimen*(extend?EXT_READTIME:1); + d8("devcmd(), alarmtime=%ld, errout=%d, extend=%d, convcr=%d, osend=%p, bufl=%d, buf: %s\n", + alarmtime,errout,extend,convcr,osend,bufl,reform(buf,0)); if (0) { err: alarm(0); @@ -529,26 +882,31 @@ err: retrying(); } catchdatal=0; - va_start(ap,send); - l=VARVPRINTF(buf,send,ap); bufl=l+1; - va_end(ap); - if (bufl>=sizeof(buf)-1) error("!Command too big (%d>%d)",bufl,sizeof(buf)-1); - if (verbose>=2) error(".devcmd(send=\"%s\",term=\"%s\",catch=\"%s\")",buf,term,catch); - buf[l]='\r'; buf[l+1]='\n'; - for (offs=0,got=0;offs=sizeof(buf)-1) error("!Command too big (%d>%d)",bufl,sizeof(buf)-1); + if (verbose>=2) error(".devcmd(send=%s,term=%s,catch=%s,timeout=%ld)", + reform(buf,0),reform(term,1),reform(catch,2),alarmtime); + if (osend) buf[l]='\r'; + for (offs=0,got=0;offss && (s=memchr(s,'\r',buf+bufl-s))) *s='\n'; + while (buf+bufl2>s && (s=memchr(s,'\0',buf+bufl2-s))) *s++=REPL_NULLCHAR; + if (verbose>=2) + error("\nGot chunk of data from device: %s",reform(buf+bufl,0)); + if (convcr) { + s=buf+bufl; + while (buf+bufl2>s && (s=memchr(s,'\r',buf+bufl2-s))) *s++='\n'; + } + bufl=bufl2; catched(buf+bufl); assert(!record || record==buf+bufl); - assert(bufl=fragl) { - buf[bufl]='\0'; - assert(strlen(buf)==bufl); - /* d3(">%s|%s<\n",buf,term); */ - if (strstr(buf,ERROR_SUBSTR1) || strstr(buf,ERROR_SUBSTR2)) { - error("Found ERROR response on command \"%s\"",send); - goto err; - } - if (catch && bufl>=catchl && (hit=strstr(buf,catch))) { - record=hit+catchl; - catched(buf+bufl); assert(!record || record==buf+bufl); - } - if ( bufl>= terml && (hit=strstr(buf,term))) break; - memmove(buf,buf+bufl-(fragl-1),fragl-1); - bufl=fragl-1; - if (record) record=buf+bufl; + assert(bufl%s|%s<\n",buf,term); */ + if (strstr(buf,ERROR_SUBSTR1) || strstr(buf,ERROR_SUBSTR2)) { + error("Found ERROR response on command %s",reform(send,0)); + goto err; + } + if (catch && bufl>=catchl && (hit=strstr(buf,catch))) { + record=hit+catchl; + catched(buf+bufl); assert(!record || record==buf+bufl); } + if ( bufl>= terml && (hit=strstr(buf,term))) { + memmove(buf,hit+terml,(bufl2=(buf+bufl)-(hit+terml))); bufl=bufl2; + break; + } + if (bufl=2) error(".Returning data \"%s\" for cmd \"%s\"",catchdata,send); + record=emptystring; + catched(record+1); + if (verbose>=2) error(".Returning data %s for cmd %s",reform(catchdata,0),reform(send,1)); return(catchdata); } @@ -647,7 +1017,7 @@ static inline char tohex(unsigned char x) return(x-10+'A'); } -static void textconv(char *d,unsigned char *s,size_t len) +static inline void textconv(char *d,unsigned char *s,size_t len) { while (len--) { *d++=tohex(*s>>4U); @@ -667,10 +1037,12 @@ unsigned char bin[2+(MAXNUMLEN+1)/2]; s=devcmd(NULL,"\n+CSCA:","\r\nAT+CSCA?"); while (isspace(*s)) s++; if (!*s || !strcmp(s,"EMPTY")) - error("!No SMS set in A1 found"); - if (verbose>=1) error("\nFound default SMSC in A1: %s",s); + error("!No SMS set in mobile station found, please use option \"-s\""); + if (verbose>=1) error("\nFound default SMSC in mobile: %s",s); if (*s!='"') error("!No left-quote found in: %s",s); if (!(t=strrchr(s+1,'"'))) error("!No right-quote found in: %s",s); + if (s+1==t) + error("!No SMS set in mobile station found, please use option \"-s\""); e=t++; while (isspace(*t)) t++; if (*t++!=',') error("!No comma found after quotes in: %s",s); @@ -681,14 +1053,13 @@ unsigned char bin[2+(MAXNUMLEN+1)/2]; if (l==ADDR_NAT || s[1]=='+') s++; else *s='+'; *e='\0'; + if (verbose>=2) error("\nDecoded SMSC address: %s",s); + if (!NEED_PDUSMSC()) return; chk(finalsmsc=strdup(s)); - if (verbose>=2) error("\nDecoded SMSC address: %s",finalsmsc); bin[0]=1+(prepaddr(bin,finalsmsc)+1)/2; textconv(pdusmsc,bin,bin[0]+1); } -static char *pdudata; - static inline unsigned char charconv(char c,size_t offs) { switch (c) { @@ -706,12 +1077,106 @@ static inline unsigned char charconv(char c,size_t offs) #endif } +/* Logo format shamelessly stolen from GNokii-0.3.0: http://www.gnokii.org/ + * Beware - Nokia Smart Messaging specification 1.0.0 and 2.0.0 is incompatible + * with Nokia current product line implementation + * http://www.forum.nokia.com/developers/smartmsg/download/ssm2_0_0.pdf + */ + +static char *pdudata; +static char hexdata[140*2+1]; + +static inline void logoread(void) +{ +FILE *f; +char buf[32+140*8+1]; +unsigned char bin[140]={ + 0x06, /* UDH length */ + 0x05, /* IEI */ + 0x04, /* IEDL */ + 0x15, 0x83, /* dest port (group gfx) */ + 0x00, 0x00 /* src port (unused) */ + }; +size_t got,r,w; +ssize_t chars,bits; +char gsmnetf[10]; +int sizex,sizey,bit; + +#define WORD(n) (((unsigned char)buf[(n)])|(((unsigned char)buf[(n)+1])<<8)) + + if (!(f=fopen(logoname,"rb"))) + error("^!Cannot open logo file \"%s\" for r/o",logoname); + got=fread(buf,1,sizeof(buf),f); + if (got>=20 && !memcmp(buf,"NOL",4)) { + VARPRINTF2(gsmnetf,"%03.3u%02.2u",WORD(6),WORD(8)); + assert(strlen(gsmnetf)==5); + r=10; + if (verbose>=1) error(".Reading NOL file \"%s\", GSMnet \"%s\", word@4=%d..", + logoname,gsmnetf,WORD(4)); + } + else if (got>=16 && !memcmp(buf,"NGG",4)) { + r=6; + if (verbose>=1) error(".Reading NGG file \"%s\", word@4=%d..", + logoname,WORD(4)); + } + else error("!Unknown file format of logo file \"%s\"",logoname); + if (gsmnet && !strtrycasecmp(gsmnet,WORD_NET)) { + if (!*gsmnetf) error("!NOL network code detection requested but NOL file not loaded, please specify network code"); + gsmnet=gsmnetf; + } + if (!gsmnet || !strtrycasecmp(gsmnet,WORD_GROUP) || !*gsmnet) { + error("\nSending logo as: group graphics"); + gsmnet=NULL; + } + else { + error("\nSending logo as: operator logo for \"%s\"",gsmnet); + bin[4]=0x82; /* dest port 0x1582 */ + } + + sizex=WORD(r); sizey=WORD(r+2); + if (verbose>=2) error(".Magic words: @+4=%d, @+6=%d, @+8=%d", + WORD(r+4),WORD(r+6),WORD(r+8)); + r+=10; + if (sizex<1 || sizex>255 + || sizey<1 || sizey>255) error("!Invalid size: %dx%d",sizex,sizey); + chars=((bits=sizex*sizey)+7)/8; + if (r+bits>got) error("!Logo file \"%s\" too short - actual=%d, need(%dx%d)=%d", + logoname,got,sizex,sizey,r+chars); + else if (r+bits=1) error("Ignoring trailing garbage in \"%s\", used only %d bytes",logoname,r+bits); + if ((got=(7+(gsmnet?3:0)+4+chars))>140) + error("!SMS size would be %d bytes but 140 is maximum",got); + w=7; + if (gsmnet) { + bin[w++]=((gsmnet[1]&0x0F)<<4)|(gsmnet[0]&0x0F); + bin[w++]=0xF0 |(gsmnet[2]&0x0F); + bin[w++]=((gsmnet[4]&0x0F)<<4)|(gsmnet[3]&0x0F); + } + bin[w++]=0x00; /* RFU by Nokia */ + bin[w++]=sizex; bin[w++]=sizey; + bin[w++]=0x01; /* one B/W plane */ + while (chars--) { + bin[w]=0; + for (bit=0x80;(bits>0) && (bit>0);bits--,bit>>=1) { + if (buf[r]!='0' && buf[r]!='1') + error("!Invalid character (neither '0' nor '1')in logo file \"%s\" at offset 0x%X", + logoname,r); + if (buf[r++]=='1') bin[w]|=bit; + } + w++; + } + assert(chars==-1); assert(bits==0); assert(w==got); assert(w<=140); + textconv(hexdata,bin,w); + if (verbose>=2) error("\nWill send hexdata: %s",hexdata); +#undef WORD +} + static inline void genpdu(void) { static unsigned char pdu[64+MAXNUMLEN/2+(MAXBODYLEN*7)/8]; unsigned char *d=pdu; int i; -char inb=0,outb=0,xb; +char inb=0,outb=0,xb,*bodyr; unsigned char inreg; size_t offs=0; @@ -724,14 +1189,15 @@ size_t offs=0; *d++=PDU_VP; if (bodylen>MAXBODYLEN) { error("Body too large (%d>%d), cut",bodylen,MAXBODYLEN); - bodylen=MAXBODYLEN; + body[(bodylen=MAXBODYLEN)]='\0'; } + bodyr=body; *d=bodylen; assert(d0); assert(!!*body); - inreg=charconv(*body++,offs++); + inreg=charconv(*bodyr++,offs++); bodylen--; inb=7; } @@ -740,7 +1206,9 @@ size_t offs=0; outb=8; } xb=MIN(inb,outb); +#if 0 d4("inb=%d,outb=%d,xb=%d\n",inb,outb,xb); +#endif *d|=((inreg>>(unsigned)(7-inb))&((1<=1) + error("\nPlease enter the SMS text body, end with EOF (ctrl-D):"); + } + else { + if (!(fin=fopen(finame,"rt"))) + error("^!Can't open data file \"%s\" for r/o",finame); + } + chk(body=malloc(BODYLOAD)); + bodylen=fread(body,1,BODYLOAD,fin); + if (bodylen==-1) + error("^!Error reading stream \"%s\"",(finame?finame:"")); + if (finame) { + chkfclose(fin,finame); + free(finame); + } +} + +static int datawait(char immed) +{ +int i; +#ifdef HAVE_POLL +struct pollfd ufd; +#else /* HAVE_POLL */ +fd_set rfds,xfds; +#endif /* HAVE_POLL */ + + assert(devfd>=0); +retry: + errno=0; + +#ifdef HAVE_POLL + ufd.fd=devfd; + ufd.events=POLLIN; + ufd.revents=0; + i=poll(&ufd,1,(immed?0:-1)); +#else /* HAVE_POLL */ +#ifdef HAVE_FD_SETSIZE + if (devfd>=FD_SETSIZE) + error("!Device file descriptor %d can't fit in select() FD_SETSIZE (%d)", + devfd,FD_SETSIZE); +#endif /* HAVE_FD_SETSIZE */ + FD_ZERO(&rfds); FD_SET(devfd,&rfds); + FD_ZERO(&xfds); FD_SET(devfd,&xfds); + i=select(devfd+1,&rfds,NULL,&xfds,NULL); +#endif /* HAVE_POLL */ + if (immed && i==0) return(0); + if (i!=1) + error("^Failed (retval %d) while waiting for data, ignoring",i); + +#ifdef HAVE_POLL + if (ufd.revents&(POLLERR|POLLHUP)) +#else /* HAVE_POLL */ + if (FD_ISSET(devfd,&xfds)) +#endif /* HAVE_POLL */ + error("^Error while waiting for data, ignoring"); + +#ifdef HAVE_POLL + if (!(ufd.revents&POLLIN)) +#else /* HAVE_POLL */ + if (!(FD_ISSET(devfd,&rfds))) +#endif /* HAVE_POLL */ + { + error("^No data input after waited for data, retrying"); + goto retry; + } + return(1); +} + +static char *check_format(const char *fmt,const char *string) +{ +static char err[LINE_MAX],sub[50]; +char *subp,cf,cs; +const char *sf,*ss; + + for (sf=fmt,ss=string;(cf=*sf) && (cs=*ss);sf++,ss++) { + subp=NULL; + switch (cf) { + case '?': + break; + case '9': + if (isdigit(cs)) break; + subp="digit"; + break; + case '+': + if (cs=='+' || cs=='-') break; + subp="+/- sign"; + break; + default: + if (cf==cs) break; + VARPRINTF(sub,"'%c'",cf); subp=sub; + } + if (!subp) continue; + VARPRINTF5(err,"Expected %s, found '%c' at pos %d of string [%s], formatstring [%s]", + subp,cs,ss-string,string,fmt); + return(err); + } + if (*sf) { + VARPRINTF2(err,"String too short for format, string [%s], formatstring [%s]", + string,fmt); + return(err); + } + if (*ss) { + VARPRINTF2(err,"Trailing garbage in string [%s], formatstring [%s]", + string,fmt); + return(err); + } + return(NULL); +} + +static char *receive_number; +static time_t receive_time; + +/* +CMT: "+420602431329",,"99/10/25,03:21:03-00" */ +static int receive_headerparse(char *buf) +{ +char *s,*s1,*err; +struct tm tm; +static const struct { + off_t strpos; + off_t tmpos; + int min,max; + const char *name; + } timeparse[]={ +#define TP_ENT(a,b,c,d,e) { a,offsetof(struct tm,b),c,d,e } + TP_ENT( 3,tm_year,0,99,"year"), + TP_ENT( 6,tm_mon ,1,12,"month"), + TP_ENT( 9,tm_mday,1,31,"day of month"), + TP_ENT(12,tm_hour,0,23,"hour"), + TP_ENT(15,tm_min ,0,59,"minute"), + TP_ENT(18,tm_sec ,0,59,"second"), + /* Time zone ignored */ + }; +int i,val; + +#define DIGIT2(s) (((s)[0]-'0')*10+((s)[1]-'0')) + + for (s=buf;*s==' ';s++); + if (*s++!='"') { + error("Cannot find initial '\"' in CMT header: %s",buf); + return(0); + } + for (s1=s;*s && *s!='"';s++); + if (!*s) { + error("Only one '\"' found in CMT header: %s",buf); + return(0); + } + free(receive_number); + chk(receive_number=malloc(s-s1+1)); + memcpy(receive_number,s1,s-s1); receive_number[s-s1]='\0'; + s++; + if ((err=check_phone(receive_number)) || + (err=check_format(",,\"99/99/99,99:99:99+99\"",s))) { + error("%s in CMT header: %s",err,buf); + return(0); + } + memset(&tm,0,sizeof(tm)); /* may be redundant */ + for (i=0;itimeparse[i].max) { + error("Weird value of %s, is %d but expected %d..%d, setting to %d", + timeparse[i].name,val,timeparse[i].min,timeparse[i].max,timeparse[i].min); + val=timeparse[i].min; + } + *(int *)(((char *)&tm)+timeparse[i].tmpos)=val; + } + if (tm.tm_year<70) tm.tm_year+=100; + tm.tm_mon--; + d7("mktime(y%dm%dd%dh%dm%ds%d)\n", + tm.tm_year,tm.tm_mon,tm.tm_mday,tm.tm_hour,tm.tm_min,tm.tm_sec); + if ((receive_time=mktime(&tm))==-1) { + error("^mktime(3) failed for %s",s+2); + return(0); + } + return(1); +#undef DIGIT2 +} + +static void receive_accept(char *bodyline) +{ +char *buf,*s,*s1,*s2,*s3; +pid_t pid; +char tbuf[32]; +int i; +FILE *f; + + d2("receive_accept: %s\n",bodyline); +#if RECEIVE_TEST + pid=0; +#else + pid=fork(); +#endif + if (pid>0) return; /* parent context */ + if (pid==-1) { + error("Can't fork(2), process spawning may block receive"); + } + else { /* child process */ + dis_cleanup=1; + } + for (s=body;*s;) { + s1=s; + do { + s1=strchr(s1+(s1!=s),'%'); + } while (s1 && s1[1]!='p' && s1[1]!='T' && s1[1]!='t'); + if (!s1) { + pushargstack_one(s,0); + break; + } + *s1='\0'; + pushargstack_one(s,0); + *s1++='%'; + s=s1; + switch (*s++) { + case 'p': + pushargstack_one(receive_number,0); + break; + case 'T': + VARPRINTF(tbuf,"%ld",receive_time); + pushargstack_one(tbuf,0); + break; + case 't': + if (!(s2=ctime(&receive_time))) { + error("Failing ctime(3), ignoring substitution"); + break; + } + if ((s3=strchr(s2,'\n'))) *s3='\0'; + pushargstack_one(s2,0); + break; + default: assert(0); + } + } + buf=glueargstack(NULL,NULL); assert(buf); + if (!(f=popen(buf,"w"))) { + error("^Failing spawn of receive command: %s",buf); + goto err; + } + if (fputs(bodyline,f)<0 || putc('\n',f)!='\n') + error("^Failing write to child receive command: %s",buf); + if ((i=pclose(f))) + error("^Spawned receive command failure (code %d): %s",i,buf); +err: + free(buf); + if (pid==-1) return; + exit(EXIT_SUCCESS); /* cleanup() has been disabled */ +} + static struct { char **sp; long *ip; @@ -759,21 +1488,39 @@ static struct { { &readtime,&readtimen,"readtime" }, { &chartime,&chartimen,"chartime" }, { &cmdtime ,&cmdtimen ,"cmdtime" }, + { &baud ,&baudn ,"baud" }, }; int main(int argc,char **argv) { -char *s,*finame; -FILE *fin; +char *s; int i; unsigned fatal=0; +speed_t portbaud; +enum modenum argsmode; if ((s=strrchr((pname=*argv),'/'))) pname=s+1; +#ifdef HAVE_ATEXIT atexit(cleanup); +#else + error("atexit(3) not available at compilation time, device cleanup may be missed"); +#endif signal(SIGTERM,(RETSIGTYPE (*)(int))cleanup); signal(SIGQUIT,(RETSIGTYPE (*)(int))cleanup); signal(SIGINT ,(RETSIGTYPE (*)(int))cleanup); signal(SIGHUP ,(RETSIGTYPE (*)(int))cleanup); + assert(mode==MODE_UNKNOWN); + for (i=0;i"); if ((s=getenv("HOME"))) { size_t l=strlen(s); @@ -785,48 +1532,38 @@ char *buf=malloc(l+50); free(buf); } readfile(CONFIG_MAIN,1); + if (verbose>=1) { + if (argsmode) + error(".Detected mode \"%s\" from my program name \"%s\"",MODE_NAME(argsmode),pname); + else + error(".Automatic mode detection unsuccessul for my progam name \"%s\"",pname); + } - for (i=0;ivar) continue; + if (n->reqd && !(MODE_BIT(mode)&n->reqd)) continue; + error("Missing parameter \"%s\"",n->name); + fatal++; + } if (fatal) error("!Previous error%s considered unrecoverable",(fatal==1?"":"s")); - for (i=0;i=1) - error("\nPlease enter the SMS text body, end with EOF (ctrl-D):"); - } - else { - if (!(fin=fopen(finame,"rt"))) - error("!Can't open data file \"%s\" for r/o: %m",finame); - } - chk(body=malloc(BODYLOAD)); - bodylen=fread(body,1,BODYLOAD,fin); - if (bodylen==-1) - error("!Error reading stream \"%s\": %m",(finame?finame:"")); - if (finame) { - chkfclose(fin,finame); - free(finame); - } - } for (i=0;i=2) error(".Will use baudrate %ld with hexval 0x%X",baudn,portbaud); if (lockfile && *lockfile && VARPRINTF(lockreal,lockfile,devicename)>0) { time_t start,end; if (verbose>=1) error(".Locking device \"%s\" by \"%s\"..",device,lockreal); time(&start); - lockdevice(); + lockdevice(0); time(&end); if ((end-=start)>LOCKREPORT) - logmsg("Device lock succeeded after %d seconds",end); + logmsg("Device lock succeeded after %ld seconds",(long)end); } if (verbose>=1) error(".Opening device \"%s\"..",device); if ((devfd=open(device,O_RDWR|O_NDELAY))<0) - error("!Cannot open device \"%s\" for rw-access: %m",device); + error("^!Cannot open device \"%s\" for r/w access",device); if (tcgetattr(devfd,&restios)) - error("Unable to get termios settings: %m"); + error("^Unable to get termios settings"); else { restios.c_cflag=(restios.c_cflag&~(CBAUD|CBAUDEX))|B0|HUPCL; restios_yes=1; } tios.c_iflag=IGNBRK|IGNPAR|IXON|IXOFF; tios.c_oflag=0; - tios.c_cflag=CS8|CREAD|CLOCAL|B19200|HUPCL; + tios.c_cflag=CS8|CREAD|CLOCAL|HUPCL|portbaud; tios.c_lflag=IEXTEN|NOFLSH; memset(tios.c_cc,_POSIX_VDISABLE,sizeof(tios.c_cc)); tios.c_cc[VTIME]=0; tios.c_cc[VMIN ]=1; - cfsetispeed(&tios,B19200); - if (cfsetospeed(&tios,B19200)|cfsetispeed(&tios,B19200)) - error("Error setting termios baudrate on device: %m"); + cfsetispeed(&tios,portbaud); + if (cfsetospeed(&tios,portbaud)|cfsetispeed(&tios,portbaud)) + error("^Error setting termios baudrate on device"); if (tcflush(devfd,TCIOFLUSH)) - error("Error flushing termios (TCIOFLUSH) on device: %m"); + error("^Error flushing termios (TCIOFLUSH) on device"); if (tcsetattr(devfd,TCSANOW,&tios)) - error("!Unable to set initial termios device settings: %m"); + error("^!Unable to set initial termios device settings"); - signal(SIGALRM,(RETSIGTYPE (*)(int))sigalarm); - do { - devcmd("",NULL,"\r\nAT\032"); + setalarm(); + +retryall: + devcmd("",NULL,"\r\nAT\033\032"); /* ESCAPE, CTRL-Z */ devcmd(NULL,NULL,"\r\nAT"); smscset(); - devcmd(NULL,NULL,"\r\nAT+CMGF=0"); - devcmd("\n> ",NULL,"\r\nAT+CMGS=%d",(strlen(pdusmsc)+strlen(pdudata))/2); - if (!(s=devcmd(NULL,"\n+CMGS:","!%s%s\032",pdusmsc,pdudata))) retrying(); - } while (!s); + switch (mode) { + case MODE_SEND: +retrysendcmgf: + if (!devcmd(NULL,NULL,"!\r\nAT+CMGF=0")) { + if (!devcmd(NULL,NULL,"!\r\nAT+CMGF=1")) + { retrying(); goto retrysendcmgf; } + /* CMGF=1 */ + devcmd("\n> ",NULL,"\r\nAT+CMGS=\"%s\"",phone); + s=devcmd(NULL,"\n+CMGS:","!~%s\032",body); + } + else { + /* CMGF=0 */ + devcmd("\n> ",NULL,"\r\nAT+CMGS=%d",(strlen(pdusmsc)+strlen(pdudata))/2); + s=devcmd(NULL,"\n+CMGS:","!~%s%s\032",pdusmsc,pdudata); + } + break; + case MODE_LOGO_SEND: + restore="\r\nAT+CSMP=17,,0,0"; + devcmd(NULL,NULL,"\r\nAT+CSMP=81,,0,245"); + devcmd("\n> ",NULL,"\r\nAT+CMGS=\"%s\"",phone); + s=devcmd(NULL,"\n+CMGS:","!~%s\032",hexdata); + break; + case MODE_RECEIVE: + devcmd(NULL,NULL,"\r\nAT+CMGF=1"); + restore="\r\nAT+CNMI=,0"; + devcmd(NULL,NULL,"\r\nAT+CNMI=,2"); + unlockdevice(0); + /* Never bail-out when we got up to this point */ + if (maxretryn!=-1 && verbose>=1) + error(".Initialization successful, infinite retry count set"); + maxretryn=-1; +#if RECEIVE_TEST + receive_headerparse(" \"+420602123456\",,\"99/10/25,03:21:03-00\""); + receive_accept("TESTBODY"); + exit(EXIT_SUCCESS); +#endif + datawait(0); + if (!lockdevice(1)) { + if (verbose>=1) + error(".Dialout detected, waiting for lock.."); + lockdevice(0); + goto retryall; + } + d1("Lock-device succeeded\n"); + do { + d1("Reading a message for us...\n"); + if (!(s=devcmd("\r","+CMT:"," "))) + goto retryall; + if (!(i=receive_headerparse(s))) + error("Receive-header parsing failed on: %s",s); + if (!(s=devcmd("\r","\n"," "))) + goto retryall; + if (i) receive_accept(s); + if (!devcmd("\n",NULL," ")) /* eat last '\n' */ + goto retryall; + } while (datawait(1)); + goto retryall; + break; + default: assert(0); + } + if (!s) { retrying(); goto retryall; } + while (isspace(*s)) s++; if (verbose>=1) error("\nMessage successfuly sent with MR: %s",s); devcmd(NULL,NULL,"\r\nAT");