#include #include #include #include "modem.h" typedef struct { char *terse; char *verbose; int result; int (*f)(Modem*); } ResultCode; static ResultCode results[] = { { "0", "OK", Rok, 0, }, { "1", "CONNECT", Rconnect, 0, }, { "2", "RING", Rring, 0, }, { "3", "NO CARRIER", Rfailure, 0, }, { "4", "ERROR", Rrerror, 0, }, { "5", "CONNECT 1200", Rconnect, 0, }, { "6", "NO DIALTONE", Rfailure, 0, }, { "7", "BUSY", Rfailure, 0, }, { "8", "NO ANSWER", Rfailure, 0, }, { "9", "CONNECT 2400", Rconnect, 0, }, /* MT1432BA */ { "10", "CONNECT 2400", Rconnect, 0, }, /* Hayes */ { "11", "CONNECT 4800", Rconnect, 0, }, { "12", "CONNECT 9600", Rconnect, 0, }, { "13", "CONNECT 14400",Rconnect, 0, }, { "23", "CONNECT 1275", Rconnect, 0, }, /* MT1432BA */ { "-1", "+FCON", Rcontinue, fcon, }, { "-1", "+FTSI", Rcontinue, ftsi, }, { "-1", "+FDCS", Rcontinue, fdcs, }, { "-1", "+FCFR", Rcontinue, fcfr, }, { "-1", "+FPTS", Rcontinue, fpts, }, { "-1", "+FET", Rcontinue, fet, }, { "-1", "+FHNG", Rcontinue, fhng, }, { 0 }, }; void initmodem(Modem *m, int fd, int cfd, char *type, char *id) { m->fd = fd; m->cfd = cfd; if(id == 0) id = "Plan 9"; m->id = id; m->t = type; } int rawmchar(Modem *m, char *p) { Dir *d; int n; if(m->icount == 0) m->iptr = m->ibuf; if(m->icount){ *p = *m->iptr++; m->icount--; return Eok; } m->iptr = m->ibuf; if((d = dirfstat(m->fd)) == nil){ verbose("rawmchar: dirfstat: %r"); return seterror(m, Esys); } n = d->length; free(d); if(n == 0) return Enoresponse; if(n > sizeof(m->ibuf)-1) n = sizeof(m->ibuf)-1; if((m->icount = read(m->fd, m->ibuf, n)) <= 0){ verbose("rawmchar: read: %r"); m->icount = 0; return seterror(m, Esys); } *p = *m->iptr++; m->icount--; return Eok; } int getmchar(Modem *m, char *buf, long timeout) { int r, t; timeout += time(0); while((t = time(0)) <= timeout){ switch(r = rawmchar(m, buf)){ case Eok: return Eok; case Enoresponse: sleep(100); continue; default: return r; } } verbose("getmchar: time %ud, timeout %ud", t, timeout); return seterror(m, Enoresponse); } int putmchar(Modem *m, char *p) { if(write(m->fd, p, 1) < 0) return seterror(m, Esys); return Eok; } /* * lines terminate with cr-lf */ static int getmline(Modem *m, char *buf, int len, long timeout) { int r, t; char *e = buf+len-1; char last = 0; timeout += time(0); while((t = time(0)) <= timeout){ switch(r = rawmchar(m, buf)){ case Eok: /* ignore ^s ^q which are used for flow */ if(*buf == '\021' || *buf == '\023') continue; if(*buf == '\n'){ /* ignore nl if its not with a cr */ if(last == '\r'){ *buf = 0; return Eok; } continue; } last = *buf; if(*buf == '\r') continue; buf++; if(buf == e){ *buf = 0; return Eok; } continue; case Enoresponse: sleep(100); continue; default: return r; } } verbose("getmline: time %ud, timeout %ud", t, timeout); return seterror(m, Enoresponse); } int command(Modem *m, char *s) { verbose("m->: %s", s); if(fprint(m->fd, "%s\r", s) < 0) return seterror(m, Esys); return Eok; } /* * Read till we see a message or we time out. * BUG: line lengths not checked; * newlines */ int response(Modem *m, int timeout) { int r; ResultCode *rp; while(getmline(m, m->response, sizeof(m->response), timeout) == Eok){ if(m->response[0] == 0) continue; verbose("<-m: %s", m->response); for(rp = results; rp->terse; rp++){ if(strncmp(rp->verbose, m->response, strlen(rp->verbose))) continue; r = rp->result; if(rp->f && (r = (*rp->f)(m)) == Rcontinue) break; return r; } } m->response[0] = 0; return Rnoise; } void xonoff(Modem *m, int i) { char buf[8]; sprint(buf, "x%d", i); i = strlen(buf); write(m->cfd, buf, i); }