static int i4l_break(struct ast_modem_pvt *p)
{
if (ast_modem_send(p, breakcmd, 2)) {
ast_log(LOG_WARNING, "Failed to break\n");
return -1;
}
if (ast_modem_send(p, "\r\n", 2)) {
ast_log(LOG_WARNING, "Failed to send enter?\n");
return -1;
}
#if 0
/* Read any outstanding junk */
while(!ast_modem_read_response(p, 1));
#endif
if (ast_modem_send(p, "AT", 0)) {
/* Modem might be stuck in some weird mode, try to get it out */
ast_modem_send(p, "+++", 3);
if (ast_modem_expect(p, "OK", 10)) {
ast_log(LOG_WARNING, "Modem is not responding\n");
return -1;
}
if (ast_modem_send(p, "AT", 0)) {
ast_log(LOG_WARNING, "Modem is not responding\n");
return -1;
}
}
if (ast_modem_expect(p, "OK", 5)) {
ast_log(LOG_WARNING, "Modem did not respond properly\n");
return -1;
}
return 0;
}
static int bestdata_break(struct ast_modem_pvt *p)
{
if (ast_modem_send(p, breakcmd, 2)) {
ast_log(LOG_WARNING, "Failed to break\n");
return -1;
}
p->ministate = STATE_COMMAND;
usleep(10000);
/* Read any outstanding junk */
while(!ast_modem_read_response(p, 1));
if (ast_modem_send(p, "AT", 0)) {
/* Modem might be stuck in some weird mode, try to get it out */
ast_modem_send(p, "+++", 3);
if (ast_modem_expect(p, "OK", 10)) {
ast_log(LOG_WARNING, "Modem is not responding\n");
return -1;
}
if (ast_modem_send(p, "AT", 0)) {
ast_log(LOG_WARNING, "Modem is not responding\n");
return -1;
}
}
if (ast_modem_expect(p, "OK", 5)) {
ast_log(LOG_WARNING, "Modem did not respond properly\n");
return -1;
}
return 0;
}
static int i4l_setdev(struct ast_modem_pvt *p, int dev)
{
char cmd[80];
if ((dev != MODEM_DEV_TELCO) && (dev != MODEM_DEV_TELCO_SPK)) {
ast_log(LOG_WARNING, "ISDN4Linux only supports telco device, not %d.\n", dev);
return -1;
} else /* Convert DEV to our understanding of it */
dev = 2;
if (ast_modem_send(p, "AT+VLS?", 0)) {
ast_log(LOG_WARNING, "Unable to select current mode %d\n", dev);
return -1;
}
if (ast_modem_read_response(p, 5)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
ast_modem_trim(p->response);
strncpy(cmd, p->response, sizeof(cmd)-1);
if (ast_modem_expect(p, "OK", 5)) {
ast_log(LOG_WARNING, "Modem did not respond properly\n");
return -1;
}
if (dev == atoi(cmd)) {
/* We're already in the right mode, don't bother changing for fear of
hanging up */
return 0;
}
snprintf(cmd, sizeof(cmd), "AT+VLS=%d", dev);
if (ast_modem_send(p, cmd, 0)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
if (ast_modem_read_response(p, 5)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
ast_modem_trim(p->response);
if (strcasecmp(p->response, "VCON") && strcasecmp(p->response, "OK")) {
ast_log(LOG_WARNING, "Unexpected reply: %s\n", p->response);
return -1;
}
return 0;
}
static int aopen_setdev(struct ast_modem_pvt *p, int dev)
{
char cmd[80];
if (ast_modem_send(p, "AT#VLS?", 0)) {
ast_log(LOG_WARNING, "Unable to select current mode %d\n", dev);
return -1;
}
if (ast_modem_read_response(p, 5)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
ast_modem_trim(p->response);
strncpy(cmd, p->response, sizeof(cmd)-1);
if (ast_modem_expect(p, "OK", 5)) {
ast_log(LOG_WARNING, "Modem did not respond properly\n");
return -1;
}
if (dev == atoi(cmd)) {
/* We're already in the right mode, don't bother changing for fear of
hanging up */
return 0;
}
snprintf(cmd, sizeof(cmd), "AT#VLS=%d", dev);
if (ast_modem_send(p, cmd, 0)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
if (ast_modem_read_response(p, 5)) {
ast_log(LOG_WARNING, "Unable to select device %d\n", dev);
return -1;
}
ast_modem_trim(p->response);
if (strcasecmp(p->response, "VCON") && strcasecmp(p->response, "OK")) {
ast_log(LOG_WARNING, "Unexpected reply: %s\n", p->response);
return -1;
}
return 0;
}
static char *aopen_identify(struct ast_modem_pvt *p)
{
char identity[256];
char mfr[80];
char mdl[80];
char rev[80];
ast_modem_send(p, "AT#MDL?", 0);
ast_modem_read_response(p, 5);
strncpy(mdl, p->response, sizeof(mdl)-1);
ast_modem_trim(mdl);
ast_modem_expect(p, "OK", 5);
ast_modem_send(p, "AT#MFR?", 0);
ast_modem_read_response(p, 5);
strncpy(mfr, p->response, sizeof(mfr)-1);
ast_modem_trim(mfr);
ast_modem_expect(p, "OK", 5);
ast_modem_send(p, "AT#REV?", 0);
ast_modem_read_response(p, 5);
strncpy(rev, p->response, sizeof(rev)-1);
ast_modem_trim(rev);
ast_modem_expect(p, "OK", 5);
snprintf(identity, sizeof(identity), "%s Model %s Revision %s", mfr, mdl, rev);
return strdup(identity);
}
static struct ast_frame *bestdata_handle_escape(struct ast_modem_pvt *p, char esc)
{
char name[30]="",nmbr[30]="";
time_t now;
/* Handle escaped characters -- but sometimes we call it directly as
a quick way to cause known responses */
p->fr.frametype = AST_FRAME_NULL;
p->fr.subclass = 0;
p->fr.data = NULL;
p->fr.datalen = 0;
p->fr.samples = 0;
p->fr.offset = 0;
p->fr.mallocd = 0;
p->fr.delivery.tv_sec = 0;
p->fr.delivery.tv_usec = 0;
if (esc)
ast_log(LOG_DEBUG, "Escaped character '%c'\n", esc);
switch(esc) {
case 'R': /* Pseudo ring */
time(&now);
if (now > (p->lastring + (RINGT / 1000)))
{ /* if stale, treat as new */
p->gotclid = 0;
}
if (p->gotclid)
{
p->fr.frametype = AST_FRAME_CONTROL;
p->fr.subclass = AST_CONTROL_RING;
}
p->ringt = RINGT;
time(&p->lastring);
return &p->fr;
case 'X': /* Caller-ID Spill */
if (p->gotclid) return &p->fr;
name[0] = nmbr[0] = 0;
for(;;)
{
char res[1000]="";
if (ast_modem_read_response(p, 5)) break;
strncpy(res, p->response, sizeof(res)-1);
ast_modem_trim(res);
if (!strncmp(res,"\020.",2)) break;
if (!strncmp(res,"NAME",4)) strncpy(name,res + 7, sizeof(name) - 1);
if (!strncmp(res,"NMBR",4)) strncpy(nmbr,res + 7, sizeof(nmbr) - 1);
}
p->gotclid = 1;
if ((!strcmp(name,"O")) || (!strcmp(name,"P"))) name[0] = 0;
if ((!strcmp(nmbr,"O")) || (!strcmp(nmbr,"P"))) nmbr[0] = 0;
if ((name[0]) && (nmbr[0])) snprintf(p->cid,sizeof(p->cid),
"\"%s\" <%s>",name,nmbr);
else if (name[0]) snprintf(p->cid,sizeof(p->cid),
"\"%s\"",name);
else if (nmbr[0]) snprintf(p->cid,sizeof(p->cid),
"%s",nmbr);
if (p->owner) p->owner->callerid = strdup(p->cid);
return &p->fr;
case '@': /* response from "OK" in command mode */
if (p->owner)
ast_setstate(p->owner, AST_STATE_UP);
if (bestdata_startrec(p)) return NULL;
p->fr.frametype = AST_FRAME_CONTROL;
p->fr.subclass = AST_CONTROL_RING;
return &p->fr;
case 'b': /* Busy signal */
p->fr.frametype = AST_FRAME_CONTROL;
p->fr.subclass = AST_CONTROL_BUSY;
return &p->fr;
case 'o': /* Overrun */
ast_log(LOG_WARNING, "Overflow on modem, flushing buffers\n");
if (ast_modem_send(p, "\0x10E", 2))
ast_log(LOG_WARNING, "Unable to flush buffers\n");
return &p->fr;
case '0': /* All the DTMF characters */
case '1':
case '2':
case '3':
case '4':
case '5':
case '6':
case '7':
case '8':
case '9':
case '*':
case '#':
case 'A':
case 'B':
case 'C':
case 'D':
p->dtmfrx = esc; /* save this for when its done */
return &p->fr;
case '/': /* Start of DTMF tone shielding */
p->dtmfrx = ' ';
return &p->fr;
case '~': /* DTMF transition to off */
if (p->dtmfrx > ' ')
{
p->fr.frametype = AST_FRAME_DTMF;
p->fr.subclass = p->dtmfrx;
}
p->dtmfrx = 0;
return &p->fr;
case 'u': /* Underrun */
ast_log(LOG_WARNING, "Data underrun\n");
/* Fall Through */
case CHAR_ETX: /* End Transmission */
case 'd': /* Dialtone */
case 'c': /* Calling Tone */
case 'e': /* European version */
case 'a': /* Answer Tone */
case 'f': /* Bell Answer Tone */
case 'T': /* Timing mark */
case 't': /* Handset off hook */
case 'h': /* Handset hungup */
case 0: /* Pseudo signal */
/* Ignore */
return &p->fr;
default:
ast_log(LOG_DEBUG, "Unknown Escaped character '%c' (%d)\n", esc, esc);
}
return &p->fr;
}
