File:
[ELWIX - Embedded LightWeight unIX -] /
embedaddon /
mpd /
src /
modem.c
Revision
1.1.1.1 (vendor branch):
download - view:
text,
annotated -
select for diffs -
revision graph
Mon Jul 22 08:44:29 2013 UTC (11 years, 5 months ago) by
misho
Branches:
mpd,
MAIN
CVS tags:
v5_8p7,
v5_8p1_cross,
v5_8p1,
v5_8,
v5_7p0,
v5_7,
v5_6,
HEAD
5.7
/*
* modem.c
*
* Written by Archie Cobbs <archie@freebsd.org>
* Copyright (c) 1995-1999 Whistle Communications, Inc. All rights reserved.
* See ``COPYRIGHT.whistle''
*/
#include "ppp.h"
#include <termios.h>
#include "chat.h"
#include "phys.h"
#include "modem.h"
#include "ngfunc.h"
#include "lcp.h"
#include "event.h"
#include "util.h"
#include "log.h"
#include <netgraph/ng_message.h>
#include <netgraph/ng_socket.h>
#include <netgraph/ng_async.h>
#include <netgraph/ng_tty.h>
#include <netgraph.h>
/*
* DEFINITIONS
*/
#ifndef NETGRAPHDISC
#define NETGRAPHDISC 7 /* XXX */
#endif
#define MODEM_MTU 1600
#define MODEM_MRU 1600
#define MODEM_MIN_CLOSE_TIME 3
#define MODEM_CHECK_INTERVAL 1
#define MODEM_DEFAULT_SPEED 115200
#define MODEM_ERR_REPORT_INTERVAL 60
#define MODEM_IDLE_RESULT_ANSWER "answer"
#define MODEM_IDLE_RESULT_RINGBACK "ringback"
/* Special chat script variables we set/use */
#define CHAT_VAR_LOGIN "$Login"
#define CHAT_VAR_PASSWORD "$Password"
#define CHAT_VAR_DEVICE "$modemDevice"
#define CHAT_VAR_IDLE_RESULT "$IdleResult"
#define CHAT_VAR_CONNECT_SPEED "$ConnectionSpeed"
#define CHAT_VAR_CALLING "$CallingID"
#define CHAT_VAR_CALLED "$CalledID"
/* Nominal link parameters */
#define MODEM_DEFAULT_BANDWIDTH 28800 /* ~33.6 modem */
#define MODEM_DEFAULT_LATENCY 10000 /* 10ms */
/* Modem device state */
struct modeminfo {
int fd; /* Device file desc, or -1 */
int csock; /* netgraph control socket */
int speed; /* Port speed */
u_int watch; /* Signals to watch */
char device[20]; /* Serial device name */
char ttynode[NG_NODESIZ]; /* TTY node name */
char connScript[CHAT_MAX_LABEL]; /* Connect script */
char idleScript[CHAT_MAX_LABEL]; /* Idle script */
struct pppTimer checkTimer; /* Timer to check pins */
struct pppTimer reportTimer; /* Timer to report errs */
struct pppTimer startTimer; /* Timer for ModemStart() */
struct optinfo options; /* Binary options */
struct ng_async_cfg acfg; /* ng_async node config */
ChatInfo chat; /* Chat script state */
time_t lastClosed; /* Last time device closed */
u_char opened:1; /* We have been opened */
u_char originated:1; /* We originated current call */
u_char answering:1; /* $IdleResult was "answer" */
};
typedef struct modeminfo *ModemInfo;
/* Set menu options */
enum {
SET_DEVICE,
SET_SPEED,
SET_CSCRIPT,
SET_ISCRIPT,
SET_SCRIPT_VAR,
SET_WATCH
};
/*
* INTERNAL FUNCTIONS
*/
static int ModemInit(Link l);
static void ModemOpen(Link l);
static void ModemClose(Link l);
static void ModemUpdate(Link l);
static int ModemSetAccm(Link l, u_int32_t xmit, u_int32_t recv);
static void ModemStat(Context ctx);
static int ModemOriginated(Link l);
static int ModemIsSync(Link l);
static int ModemSelfAddr(Link l, void *buf, size_t buf_len);
static int ModemIface(Link l, void *buf, size_t buf_len);
static int ModemCallingNum(Link l, void *buf, size_t buf_len);
static int ModemCalledNum(Link l, void *buf, size_t buf_len);
static void ModemStart(void *arg);
static void ModemDoClose(Link l, int opened);
/* Chat callbacks */
static int ModemChatSetBaudrate(void *arg, int baud);
static void ModemChatConnectResult(void *arg,
int rslt, const char *msg);
static void ModemChatIdleResult(void *arg, int rslt,
const char *msg);
static int ModemSetCommand(Context ctx, int ac, char *av[], void *arg);
static int ModemInstallNodes(Link l);
static int ModemGetNgStats(Link l, struct ng_async_stat *sp);
static void ModemCheck(void *arg);
static void ModemErrorCheck(void *arg);
/*
* GLOBAL VARIABLES
*/
const struct phystype gModemPhysType = {
.name = "modem",
.descr = "Serial port modem",
.mtu = MODEM_MTU,
.mru = MODEM_MRU,
.tmpl = 0,
.init = ModemInit,
.open = ModemOpen,
.close = ModemClose,
.update = ModemUpdate,
.showstat = ModemStat,
.originate = ModemOriginated,
.issync = ModemIsSync,
.setaccm = ModemSetAccm,
.selfaddr = ModemSelfAddr,
.peeraddr = ModemSelfAddr,
.peeriface = ModemIface,
.callingnum = ModemCallingNum,
.callednum = ModemCalledNum,
};
const struct cmdtab ModemSetCmds[] = {
{ "device {name}", "Set modem device",
ModemSetCommand, NULL, 2, (void *) SET_DEVICE },
{ "speed {port-speed}", "Set modem speed",
ModemSetCommand, NULL, 2, (void *) SET_SPEED },
{ "script [{label}]", "Set connect script",
ModemSetCommand, NULL, 2, (void *) SET_CSCRIPT },
{ "idle-script [{label}]", "Set idle script",
ModemSetCommand, NULL, 2, (void *) SET_ISCRIPT },
{ "var ${var} {string}", "Set script variable",
ModemSetCommand, NULL, 2, (void *) SET_SCRIPT_VAR },
{ "watch [+|-cd] [+|-dsr]", "Set signals to monitor",
ModemSetCommand, NULL, 2, (void *) SET_WATCH },
{ NULL },
};
/*
* INTERNAL VARIABLES
*/
static int gSpeedList[] = {
50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800, 9600, 19200,
38400, 7200, 14400, 28800, 57600, 76800, 115200, 230400, 460800, 614400,
921600, 1228800, 1843200, 2000000, 3000000, -1
};
/*
* ModemInit()
*
* Allocate and initialize device private info
*/
static int
ModemInit(Link l)
{
char defSpeed[32];
ModemInfo m;
m = (ModemInfo) (l->info = Malloc(MB_PHYS, sizeof(*m)));
m->watch = TIOCM_CAR;
m->chat = ChatInit(l, ModemChatSetBaudrate);
m->fd = -1;
m->opened = FALSE;
/* Set nominal link speed and bandwith for a modem connection */
l->latency = MODEM_DEFAULT_LATENCY;
l->bandwidth = MODEM_DEFAULT_BANDWIDTH;
/* Set default speed */
m->speed = MODEM_DEFAULT_SPEED;
snprintf(defSpeed, sizeof(defSpeed), "%d", m->speed);
ChatPresetVar(m->chat, CHAT_VAR_BAUDRATE, defSpeed);
return(0);
}
/*
* ModemOpen()
*/
static void
ModemOpen(Link l)
{
ModemInfo const m = (ModemInfo) l->info;
assert(!m->opened);
m->opened = TRUE;
if (m->fd >= 0) { /* Device is already open.. */
if (m->answering) { /* We just answered a call */
m->originated = FALSE;
m->answering = FALSE;
ModemChatConnectResult(l, TRUE, NULL);
} else {
Log(LG_PHYS2, ("[%s] MODEM: Stop idle script then dial back",
l->name));
ModemDoClose(l, TRUE); /* Stop idle script then dial back */
}
} else
ModemStart(l); /* Open device and try to dial */
}
/*
* ModemStart()
*/
static void
ModemStart(void *arg)
{
Link const l = (Link) arg;
ModemInfo const m = (ModemInfo) l->info;
const time_t now = time(NULL);
char password[AUTH_MAX_PASSWORD];
FILE *scriptfp;
/* If we're idle, and there's no idle script, there's nothing to do */
assert(!m->answering);
TimerStop(&m->startTimer);
if (!m->opened &&
(!*m->idleScript || !Enabled(&l->conf.options, LINK_CONF_INCOMING) ||
gShutdownInProgress))
return;
/* Avoid brief hang from kernel enforcing minimum DTR hold time */
if (now - m->lastClosed < MODEM_MIN_CLOSE_TIME) {
TimerInit(&m->startTimer, "ModemStart",
(MODEM_MIN_CLOSE_TIME - (now - m->lastClosed)) * SECONDS, ModemStart, l);
TimerStart(&m->startTimer);
return;
}
/* Open and configure serial port */
if ((m->fd = OpenSerialDevice(l->name, m->device, m->speed)) < 0) {
Log(LG_ERR, ("[%s] MODEM: Fail to open serial port %s on speed %d",
l->name, m->device, m->speed));
goto fail;
}
/* If connecting, but no connect script, then skip chat altogether */
if (m->opened && !*m->connScript) {
Log(LG_PHYS2, ("[%s] MODEM: No connect script present", l->name));
ModemChatConnectResult(l, TRUE, NULL);
return;
}
/* Open chat script file */
if ((scriptfp = OpenConfFile(SCRIPT_FILE, NULL)) == NULL) {
Log(LG_ERR, ("[%s] MODEM: can't open chat script file", l->name));
ExclusiveCloseDevice(l->name, m->fd, m->device);
m->fd = -1;
fail:
m->opened = FALSE;
m->lastClosed = time(NULL);
l->state = PHYS_STATE_DOWN;
PhysDown(l, STR_ERROR, STR_DEV_NOT_READY);
return;
}
/* Preset some special chat variables */
ChatPresetVar(m->chat, CHAT_VAR_DEVICE, m->device);
ChatPresetVar(m->chat, CHAT_VAR_LOGIN, l->lcp.auth.conf.authname);
if (l->lcp.auth.conf.password[0] != 0) {
ChatPresetVar(m->chat, CHAT_VAR_PASSWORD, l->lcp.auth.conf.password);
} else if (AuthGetData(l->lcp.auth.conf.authname,
password, sizeof(password), NULL, NULL) >= 0) {
ChatPresetVar(m->chat, CHAT_VAR_PASSWORD, password);
}
/* Run connect or idle script as appropriate */
if (!m->opened) {
ChatPresetVar(m->chat, CHAT_VAR_IDLE_RESULT, "<unknown>");
ChatStart(m->chat, m->fd, scriptfp, m->idleScript, ModemChatIdleResult);
} else {
m->originated = TRUE;
l->state = PHYS_STATE_CONNECTING;
ChatStart(m->chat, m->fd, scriptfp, m->connScript, ModemChatConnectResult);
}
}
/*
* ModemClose()
*/
static void
ModemClose(Link l)
{
ModemInfo const m = (ModemInfo) l->info;
if (!m->opened)
return;
ModemDoClose(l, FALSE);
l->state = PHYS_STATE_DOWN;
PhysDown(l, STR_MANUALLY, NULL);
}
static void
ModemUpdate(Link l)
{
ModemInfo const m = (ModemInfo) l->info;
if (m->opened || TimerRemain(&m->startTimer) >= 0)
return; /* nothing needs to be done right now */
if (m->fd >= 0 &&
(!*m->idleScript || !Enabled(&l->conf.options, LINK_CONF_INCOMING)))
ModemDoClose(l, FALSE);
else if (m->fd < 0 &&
(*m->idleScript && Enabled(&l->conf.options, LINK_CONF_INCOMING)))
ModemStart(l);
}
/*
* ModemDoClose()
*/
static void
ModemDoClose(Link l, int opened)
{
ModemInfo const m = (ModemInfo) l->info;
const char ch = ' ';
/* Shutdown everything */
assert(m->fd >= 0);
ChatAbort(m->chat);
TimerStop(&m->checkTimer);
TimerStop(&m->startTimer);
TimerStop(&m->reportTimer);
if (*m->ttynode != '\0') {
char path[NG_PATHSIZ];
snprintf(path, sizeof(path), "%s:%s", m->ttynode, NG_TTY_HOOK);
NgFuncShutdownNode(m->csock, l->name, path);
snprintf(path, sizeof(path), "%s:", m->ttynode);
NgFuncShutdownNode(m->csock, l->name, path);
*m->ttynode = '\0';
}
(void) write(m->fd, &ch, 1); /* USR kludge to prevent dial lockup */
if (m->csock > 0) {
close(m->csock);
m->csock = -1;
}
ExclusiveCloseDevice(l->name, m->fd, m->device);
m->lastClosed = time(NULL);
m->answering = FALSE;
m->fd = -1;
m->opened = opened;
ModemStart(l);
}
/*
* ModemSetAccm()
*/
static int
ModemSetAccm(Link l, u_int32_t xmit, u_int32_t recv)
{
ModemInfo const m = (ModemInfo) l->info;
char path[NG_PATHSIZ];
/* Update async config */
m->acfg.accm = xmit|recv;
snprintf(path, sizeof(path), "%s:%s", m->ttynode, NG_TTY_HOOK);
if (NgSendMsg(m->csock, path, NGM_ASYNC_COOKIE,
NGM_ASYNC_CMD_SET_CONFIG, &m->acfg, sizeof(m->acfg)) < 0) {
Perror("[%s] MODEM: can't update config for %s", l->name, path);
return (-1);
}
return (0);
}
/*
* ModemChatConnectResult()
*
* Connect chat script returns here when finished.
*/
static void
ModemChatConnectResult(void *arg, int result, const char *msg)
{
Link const l = (Link) arg;
ModemInfo const m = (ModemInfo) l->info;
char *cspeed;
int bw;
/* Was the connect script successful? */
Log(LG_PHYS, ("[%s] MODEM: chat script %s",
l->name, result ? "succeeded" : "failed"));
if (!result) {
failed:
ModemDoClose(l, FALSE);
l->state = PHYS_STATE_DOWN;
PhysDown(l, STR_ERROR, msg);
return;
}
/* Set modem's reported connection speed (if any) as the link bandwidth */
if ((cspeed = ChatGetVar(m->chat, CHAT_VAR_CONNECT_SPEED)) != NULL) {
if ((bw = (int) strtoul(cspeed, NULL, 10)) > 0)
l->bandwidth = bw;
Freee(cspeed);
}
/* Do async <-> sync conversion via netgraph node */
if (ModemInstallNodes(l) < 0) {
msg = STR_DEV_NOT_READY;
goto failed;
}
/* Start pin check and report timers */
TimerInit(&m->checkTimer, "ModemCheck",
MODEM_CHECK_INTERVAL * SECONDS, ModemCheck, l);
TimerStart(&m->checkTimer);
TimerStop(&m->reportTimer);
TimerInit(&m->reportTimer, "ModemReport",
MODEM_ERR_REPORT_INTERVAL * SECONDS, ModemErrorCheck, l);
TimerStart(&m->reportTimer);
l->state = PHYS_STATE_UP;
PhysUp(l);
}
/*
* ModemChatIdleResult()
*
* Idle chat script returns here when finished. If the script returned
* successfully, then one of two things happened: either we answered
* an incoming call, or else we got a ring and want to do ringback.
* We tell the difference by checking $IdleResult.
*/
static void
ModemChatIdleResult(void *arg, int result, const char *msg)
{
Link const l = (Link) arg;
ModemInfo const m = (ModemInfo) l->info;
char *idleResult;
/* If script failed, then do nothing */
if (!result) {
ModemDoClose(l, FALSE);
return;
}
/* See what script wants us to do now by checking variable $IdleResult */
if ((idleResult = ChatGetVar(m->chat, CHAT_VAR_IDLE_RESULT)) == NULL) {
Log(LG_ERR, ("[%s] MODEM: idle script succeeded, but %s not defined",
l->name, CHAT_VAR_IDLE_RESULT));
ModemDoClose(l, FALSE);
return;
}
/* Do whatever */
Log(LG_PHYS, ("[%s] MODEM: idle script succeeded, action=%s",
l->name, idleResult));
if (gShutdownInProgress) {
Log(LG_PHYS, ("Shutdown sequence in progress, ignoring"));
ModemDoClose(l, FALSE);
} else if (strcasecmp(idleResult, MODEM_IDLE_RESULT_ANSWER) == 0) {
Log(LG_PHYS, ("[%s] MODEM: opening link in %s mode", l->name, "answer"));
RecordLinkUpDownReason(NULL, l, 1, STR_INCOMING_CALL, msg ? "%s" : NULL, msg);
m->answering = TRUE;
l->state = PHYS_STATE_READY;
PhysIncoming(l);
} else if (strcasecmp(idleResult, MODEM_IDLE_RESULT_RINGBACK) == 0) {
Log(LG_PHYS, ("[%s] MODEM: opening link in %s mode", l->name, "ringback"));
RecordLinkUpDownReason(NULL, l, 1, STR_RINGBACK, msg ? "%s" : NULL, msg);
m->answering = FALSE;
PhysIncoming(l);
} else {
Log(LG_ERR, ("[%s] MODEM: idle script succeeded, but action \"%s\" unknown",
l->name, idleResult));
ModemDoClose(l, FALSE);
}
Freee(idleResult);
}
/*
* ModemInstallNodes()
*/
static int
ModemInstallNodes(Link l)
{
ModemInfo m = (ModemInfo) l->info;
struct ngm_mkpeer ngm;
struct ngm_connect cn;
char path[NG_PATHSIZ];
int hotchar = PPP_FLAG;
#if NGM_TTY_COOKIE < 1226109660
struct nodeinfo ngtty;
int ldisc = NETGRAPHDISC;
#else
struct ngm_rmhook rm;
union {
u_char buf[sizeof(struct ng_mesg) + sizeof(struct nodeinfo)];
struct ng_mesg reply;
} repbuf;
struct ng_mesg *const reply = &repbuf.reply;
struct nodeinfo *ninfo = (struct nodeinfo *)&reply->data;
int tty[2];
#endif
/* Get a temporary netgraph socket node */
if (NgMkSockNode(NULL, &m->csock, NULL) < 0) {
Perror("[%s] MODEM: NgMkSockNode failed", l->name);
return(-1);
}
#if NGM_TTY_COOKIE < 1226109660
/* Install ng_tty line discipline */
if (ioctl(m->fd, TIOCSETD, &ldisc) < 0) {
/* Installation of the tty node type should be automatic, but isn't yet.
The 'mkpeer' below will fail, because you can only create a ng_tty
node via TIOCSETD; however, this will force a load of the node type. */
if (errno == ENODEV) {
(void)NgSendAsciiMsg(m->csock, ".:",
"mkpeer { type=\"%s\" ourhook=\"dummy\" peerhook=\"%s\" }",
NG_TTY_NODE_TYPE, NG_TTY_HOOK);
}
if (ioctl(m->fd, TIOCSETD, &ldisc) < 0) {
Perror("[%s] ioctl(TIOCSETD, %d)", l->name, ldisc);
close(m->csock);
return(-1);
}
}
/* Get the name of the ng_tty node */
if (ioctl(m->fd, NGIOCGINFO, &ngtty) < 0) {
Perror("[%s] MODEM: ioctl(NGIOCGINFO)", l->name);
close(m->csock);
return(-1);
}
strlcpy(m->ttynode, ngtty.name, sizeof(m->ttynode));
#else
/* Attach a TTY node */
snprintf(ngm.type, sizeof(ngm.type), "%s", NG_TTY_NODE_TYPE);
snprintf(ngm.ourhook, sizeof(ngm.ourhook), "%s", NG_TTY_HOOK);
snprintf(ngm.peerhook, sizeof(ngm.peerhook), "%s", NG_TTY_HOOK);
if (NgSendMsg(m->csock, ".", NGM_GENERIC_COOKIE,
NGM_MKPEER, &ngm, sizeof(ngm)) < 0) {
Perror("[%s] MODEM: can't connect %s node on %s", l->name,
NG_TTY_NODE_TYPE, ".");
close(m->csock);
return(-1);
}
snprintf(path, sizeof(path), ".:%s", NG_TTY_HOOK);
if (NgSendMsg(m->csock, path,
NGM_GENERIC_COOKIE, NGM_NODEINFO, NULL, 0) != -1) {
if (NgRecvMsg(m->csock, reply, sizeof(repbuf), NULL) < 0) {
Perror("[%s] MODEM: can't locate %s node on %s (%d)", l->name,
NG_TTY_NODE_TYPE, path, errno);
close(m->csock);
return(-1);
}
}
snprintf(m->ttynode, sizeof(m->ttynode), "[%x]", ninfo->id);
/* Attach to the TTY */
tty[0] = gPid;
tty[1] = m->fd;
if (NgSendMsg(m->csock, path, NGM_TTY_COOKIE,
NGM_TTY_SET_TTY, &tty, sizeof(tty)) < 0) {
Perror("[%s] MODEM: can't hook tty to fd %d", l->name, m->fd);
close(m->csock);
return(-1);
}
/* Disconnect temporary hook. */
snprintf(rm.ourhook, sizeof(rm.ourhook), "%s", NG_TTY_HOOK);
if (NgSendMsg(m->csock, ".",
NGM_GENERIC_COOKIE, NGM_RMHOOK, &rm, sizeof(rm)) < 0) {
Perror("[%s] MODEM: can't remove hook %s", l->name, NG_TTY_HOOK);
close(m->csock);
return(-1);
}
#endif
/* Set the ``hot char'' on the TTY node */
snprintf(path, sizeof(path), "%s:", m->ttynode);
if (NgSendMsg(m->csock, path, NGM_TTY_COOKIE,
NGM_TTY_SET_HOTCHAR, &hotchar, sizeof(hotchar)) < 0) {
Perror("[%s] MODEM: can't set hotchar", l->name);
close(m->csock);
return(-1);
}
/* Attach an async converter node */
strcpy(ngm.type, NG_ASYNC_NODE_TYPE);
strcpy(ngm.ourhook, NG_TTY_HOOK);
strcpy(ngm.peerhook, NG_ASYNC_HOOK_ASYNC);
if (NgSendMsg(m->csock, path, NGM_GENERIC_COOKIE,
NGM_MKPEER, &ngm, sizeof(ngm)) < 0) {
Perror("[%s] MODEM: can't connect %s node", l->name, NG_ASYNC_NODE_TYPE);
close(m->csock);
return(-1);
}
/* Configure the async converter node */
snprintf(path, sizeof(path), "%s:%s", m->ttynode, NG_TTY_HOOK);
memset(&m->acfg, 0, sizeof(m->acfg));
m->acfg.enabled = TRUE;
m->acfg.accm = ~0;
m->acfg.amru = MODEM_MRU;
m->acfg.smru = MODEM_MTU;
if (NgSendMsg(m->csock, path, NGM_ASYNC_COOKIE,
NGM_ASYNC_CMD_SET_CONFIG, &m->acfg, sizeof(m->acfg)) < 0) {
Perror("[%s] MODEM: can't config %s", l->name, path);
close(m->csock);
return(-1);
}
/* Attach async node to PPP node */
if (!PhysGetUpperHook(l, cn.path, cn.peerhook)) {
Log(LG_PHYS, ("[%s] MODEM: can't get upper hook", l->name));
close(m->csock);
return (-1);
}
snprintf(cn.ourhook, sizeof(cn.ourhook), NG_ASYNC_HOOK_SYNC);
if (NgSendMsg(m->csock, path, NGM_GENERIC_COOKIE, NGM_CONNECT,
&cn, sizeof(cn)) < 0) {
Perror("[%s] MODEM: can't connect \"%s\"->\"%s\" and \"%s\"->\"%s\"",
l->name, path, cn.ourhook, cn.path, cn.peerhook);
close(m->csock);
return (-1);
}
return(0);
}
/*
* ModemChatSetBaudrate()
*
* This callback changes the actual baudrate of the serial port.
* Should only be called once the device is already open.
* Returns -1 on failure.
*/
static int
ModemChatSetBaudrate(void *arg, int baud)
{
Link const l = (Link) arg;
ModemInfo const m = (ModemInfo) l->info;
struct termios attr;
/* Change baud rate */
if (tcgetattr(m->fd, &attr) < 0) {
Perror("[%s] MODEM: can't tcgetattr \"%s\"", l->name, m->device);
return(-1);
}
if (cfsetspeed(&attr, (speed_t) baud) < 0) {
Perror("[%s] MODEM: can't set speed %d", l->name, baud);
return(-1);
}
if (tcsetattr(m->fd, TCSANOW, &attr) < 0) {
Perror("[%s] MODEM: can't tcsetattr \"%s\"", l->name, m->device);
return(-1);
}
return(0);
}
/*
* ModemGetVar()
*/
char *
ModemGetVar(Link l, const char *name)
{
ModemInfo const m = (ModemInfo) l->info;
return ChatGetVar(m->chat, name);
}
/*
* ModemCheck()
*/
static void
ModemCheck(void *arg)
{
Link const l = (Link)arg;
ModemInfo const m = (ModemInfo) l->info;
int state;
if (ioctl(m->fd, TIOCMGET, &state) < 0) {
Perror("[%s] MODEM: can't ioctl(TIOCMGET) %s", l->name, m->device);
l->state = PHYS_STATE_DOWN;
ModemDoClose(l, FALSE);
PhysDown(l, STR_ERROR, strerror(errno));
return;
}
if ((m->watch & TIOCM_CAR) && !(state & TIOCM_CAR)) {
Log(LG_PHYS, ("[%s] MODEM: carrier detect (CD) signal lost", l->name));
l->state = PHYS_STATE_DOWN;
ModemDoClose(l, FALSE);
PhysDown(l, STR_DROPPED, STR_LOST_CD);
return;
}
if ((m->watch & TIOCM_DSR) && !(state & TIOCM_DSR)) {
Log(LG_PHYS, ("[%s] MODEM: data-set ready (DSR) signal lost", l->name));
l->state = PHYS_STATE_DOWN;
ModemDoClose(l, FALSE);
PhysDown(l, STR_DROPPED, STR_LOST_DSR);
return;
}
TimerStart(&m->checkTimer);
}
/*
* ModemErrorCheck()
*
* Called every second to record errors to the log
*/
static void
ModemErrorCheck(void *arg)
{
Link const l = (Link) arg;
ModemInfo const m = (ModemInfo) l->info;
char path[NG_PATHSIZ];
struct ng_async_stat stats;
/* Check for errors */
snprintf(path, sizeof(path), "%s:%s", m->ttynode, NG_TTY_HOOK);
if (ModemGetNgStats(l, &stats) >= 0
&& (stats.asyncBadCheckSums
|| stats.asyncRunts || stats.asyncOverflows)) {
Log(LG_PHYS, ("[%s] NEW FRAME ERRS: FCS %u RUNT %u OVFL %u", l->name,
stats.asyncBadCheckSums, stats.asyncRunts, stats.asyncOverflows));
(void) NgSendMsg(m->csock, path,
NGM_ASYNC_COOKIE, NGM_ASYNC_CMD_CLR_STATS, NULL, 0);
}
/* Restart timer */
TimerStop(&m->reportTimer);
TimerStart(&m->reportTimer);
}
/*
* ModemGetNgStats()
*/
static int
ModemGetNgStats(Link l, struct ng_async_stat *sp)
{
ModemInfo const m = (ModemInfo) l->info;
char path[NG_PATHSIZ];
union {
u_char buf[sizeof(struct ng_mesg) + sizeof(*sp)];
struct ng_mesg resp;
} u;
/* Get stats */
snprintf(path, sizeof(path), "%s:%s", m->ttynode, NG_TTY_HOOK);
if (NgFuncSendQuery(path, NGM_ASYNC_COOKIE, NGM_ASYNC_CMD_GET_STATS,
NULL, 0, &u.resp, sizeof(u), NULL) < 0) {
Perror("[%s] MODEM: can't get stats", l->name);
return(-1);
}
memcpy(sp, u.resp.data, sizeof(*sp));
return(0);
}
/*
* ModemSetCommand()
*/
static int
ModemSetCommand(Context ctx, int ac, char *av[], void *arg)
{
Link const l = ctx->lnk;
ModemInfo const m = (ModemInfo) l->info;
switch ((intptr_t)arg) {
case SET_DEVICE:
if (ac == 1)
strlcpy(m->device, av[0], sizeof(m->device));
break;
case SET_SPEED:
{
int k, baud;
if (ac != 1)
return(-1);
baud = atoi(*av);
for (k = 0; gSpeedList[k] != -1 && baud != gSpeedList[k]; k++);
if (gSpeedList[k] == -1)
Error("invalid speed \'%s\'", *av);
else {
char buf[32];
m->speed = baud;
snprintf(buf, sizeof(buf), "%d", m->speed);
ChatPresetVar(m->chat, CHAT_VAR_BAUDRATE, buf);
}
}
break;
case SET_CSCRIPT:
if (ac != 1)
return(-1);
*m->connScript = 0;
strlcpy(m->connScript, av[0], sizeof(m->connScript));
break;
case SET_ISCRIPT:
if (ac != 1)
return(-1);
*m->idleScript = 0;
strlcpy(m->idleScript, av[0], sizeof(m->idleScript));
if (m->opened || TimerRemain(&m->startTimer) >= 0)
break; /* nothing needs to be done right now */
if (m->fd >= 0 && !*m->idleScript)
ModemDoClose(l, FALSE);
else if (m->fd < 0 && *m->idleScript)
ModemStart(l);
break;
case SET_SCRIPT_VAR:
if (ac != 2)
return(-1);
ChatPresetVar(m->chat, av[0], av[1]);
break;
case SET_WATCH:
{
int bit, add;
while (ac--) {
switch (**av) {
case '+':
(*av)++;
default:
add = TRUE;
break;
case '-':
add = FALSE;
(*av)++;
break;
}
if (!strcasecmp(*av, "cd"))
bit = TIOCM_CAR;
else if (!strcasecmp(*av, "dsr"))
bit = TIOCM_DSR;
else {
Printf("[%s] modem signal \"%s\" is unknown\r\n", l->name, *av);
bit = 0;
}
if (add)
m->watch |= bit;
else
m->watch &= ~bit;
av++;
}
}
break;
default:
assert(0);
}
return(0);
}
/*
* ModemOriginated()
*/
static int
ModemOriginated(Link l)
{
ModemInfo const m = (ModemInfo) l->info;
return(m->originated ? LINK_ORIGINATE_LOCAL : LINK_ORIGINATE_REMOTE);
}
/*
* ModemIsSync()
*/
static int
ModemIsSync(Link l)
{
return (0);
}
static int
ModemSelfAddr(Link l, void *buf, size_t buf_len)
{
ModemInfo const m = (ModemInfo) l->info;
strlcpy(buf, m->ttynode, buf_len);
return(0);
}
static int
ModemIface(Link l, void *buf, size_t buf_len)
{
ModemInfo const m = (ModemInfo) l->info;
strlcpy(buf, m->device, buf_len);
return(0);
}
static int
ModemCallingNum(Link l, void *buf, size_t buf_len)
{
ModemInfo const m = (ModemInfo) l->info;
char *tmp;
if ((tmp = ChatGetVar(m->chat, CHAT_VAR_CALLING)) == NULL) {
((char *)buf)[0] = 0;
return (-1);
}
strlcpy((char*)buf, tmp, buf_len);
Freee(tmp);
return(0);
}
static int
ModemCalledNum(Link l, void *buf, size_t buf_len)
{
ModemInfo const m = (ModemInfo) l->info;
char *tmp;
if ((tmp = ChatGetVar(m->chat, CHAT_VAR_CALLED)) == NULL) {
((char *)buf)[0] = 0;
return (-1);
}
strlcpy((char*)buf, tmp, buf_len);
Freee(tmp);
return(0);
}
/*
* ModemStat()
*/
void
ModemStat(Context ctx)
{
ModemInfo const m = (ModemInfo) ctx->lnk->info;
struct ng_async_stat stats;
char *tmp;
Printf("Modem info:\r\n");
Printf("\tDevice : %s\r\n", m->device);
Printf("\tPort speed : %d baud\r\n", m->speed);
Printf("\tConn. script : \"%s\"\r\n", m->connScript);
Printf("\tIdle script : \"%s\"\r\n", m->idleScript);
Printf("\tPins to watch: %s%s\r\n",
(m->watch & TIOCM_CAR) ? "CD " : "",
(m->watch & TIOCM_DSR) ? "DSR" : "");
Printf("Modem status:\r\n");
if (ctx->lnk->state != PHYS_STATE_DOWN) {
Printf("\tOpened : %s\r\n", (m->opened?"YES":"NO"));
Printf("\tIncoming : %s\r\n", (m->originated?"NO":"YES"));
/* Set modem's reported connection speed (if any) as the link bandwidth */
if ((tmp = ChatGetVar(m->chat, CHAT_VAR_CONNECT_SPEED)) != NULL) {
Printf("\tConnect speed: %s baud\r\n", tmp);
Freee(tmp);
}
if ((tmp = ChatGetVar(m->chat, CHAT_VAR_CALLING)) != NULL) {
Printf("\tCalling : %s\r\n", tmp);
Freee(tmp);
}
if ((tmp = ChatGetVar(m->chat, CHAT_VAR_CALLED)) != NULL) {
Printf("\tCalled : %s\r\n", tmp);
Freee(tmp);
}
if (ctx->lnk->state == PHYS_STATE_UP &&
ModemGetNgStats(ctx->lnk, &stats) >= 0) {
Printf("Async stats:\r\n");
Printf("\t syncOctets: %8u\r\n", stats.syncOctets);
Printf("\t syncFrames: %8u\r\n", stats.syncFrames);
Printf("\t syncOverflows: %8u\r\n", stats.syncOverflows);
Printf("\t asyncOctets: %8u\r\n", stats.asyncOctets);
Printf("\t asyncFrames: %8u\r\n", stats.asyncFrames);
Printf("\t asyncRunts: %8u\r\n", stats.asyncRunts);
Printf("\t asyncOverflows: %8u\r\n", stats.asyncOverflows);
Printf("\tasyncBadCheckSums: %8u\r\n", stats.asyncBadCheckSums);
}
}
}
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>