int ip232_init_conn(modem_config *cfg)
{
int rc = -1;
int port;
LOG_ENTER();
LOG(LOG_INFO, "Opening ip232 device");
port = atoi(cfg->dce_data.tty);
rc = ip_init_server_conn("", port);
if (rc < 0) {
ELOG(LOG_FATAL, "Could not initialize ip232 server socket");
exit(-1);
}
if (-1 == pipe(cfg->dce_data.dp[0])) {
ELOG(LOG_FATAL, "ip232 thread incoming IPC pipe could not be created");
exit(-1);
}
if (-1 == pipe(cfg->dce_data.dp[1])) {
ELOG(LOG_FATAL, "ip232 thread outgoing IPC pipe could not be created");
exit(-1);
}
cfg->dce_data.sSocket = rc;
cfg->dce_data.ip232_is_connected = FALSE;
cfg->dce_data.fd = cfg->dce_data.dp[0][0];
spawn_ip232_thread(cfg);
LOG(LOG_INFO, "ip232 device configured");
LOG_EXIT();
return rc;
}
int main(int argc, char *argv[]) {
modem_config cfg[64];
int modem_count;
int port=0;
char *ip_addr = NULL; /* gwb */
unsigned char all_busy[255];
pthread_t thread_id;
int i;
int rc;
int sSocket = 0;
fd_set readfs;
int max_fd=0;
int accept_pending=FALSE;
int res=0;
unsigned char buf[255];
int cSocket;
log_init();
LOG_ENTER();
log_set_level(LOG_FATAL);
mdm_init();
pb_init();
signal(SIGIO,SIG_IGN); /* Some Linux variant term on SIGIO by default */
modem_count = init(argc, argv, cfg, 64, &ip_addr, &port,all_busy,sizeof(all_busy)); /* gwb */
sSocket = ip_init_server_conn(ip_addr, port);
for(i=0;i<modem_count;i++) {
if( -1 == pipe(cfg[i].data.mp[0])) {
ELOG(LOG_FATAL,"Bridge task incoming IPC pipe could not be created");
exit(-1);
}
if( -1 == pipe(cfg[i].data.mp[1])) {
ELOG(LOG_FATAL,"Bridge task outgoing IPC pipe could not be created");
exit(-1);
}
if(dce_init_conn(&cfg[i]) < 0) {
LOG(LOG_FATAL,"Could not open serial port %s",cfg->dce_data.tty);
exit(-1);
}
cfg[i].line_data.sfd=sSocket;
rc=pthread_create(&thread_id,NULL,*run_bridge,(void *)&cfg[i]);
if(rc < 0) {
ELOG(LOG_FATAL,"IP thread could not be started");
exit(-1);
}
}
for(;;) {
FD_ZERO(&readfs);
max_fd=0;
for(i=0;i<modem_count;i++) {
FD_SET(cfg[i].data.mp[0][0], &readfs);
max_fd=MAX(max_fd,cfg[i].data.mp[0][0]);
}
if(accept_pending==FALSE) {
max_fd=MAX(max_fd,sSocket);
FD_SET(sSocket, &readfs);
}
LOG(LOG_ALL,"Waiting for incoming connections and/or indicators");
select(max_fd+1, &readfs, NULL, NULL, NULL);
for(i=0;i<modem_count;i++) {
if (FD_ISSET(cfg[i].data.mp[0][0],&readfs)) { // child pipe
res = read(cfg[i].data.mp[0][0],buf,sizeof(buf) -1);
if(res > -1) {
buf[res]=0;
LOG(LOG_DEBUG,"modem core #%d sent response '%c'",i,buf[0]);
accept_pending=FALSE;
}
}
}
if (FD_ISSET(sSocket,&readfs)) { // IP traffic
if(!accept_pending) {
LOG(LOG_DEBUG,"Incoming connection pending");
// first try for a modem that is listening.
for(i=0;i<modem_count;i++) {
if(cfg[i].s[0] != 0 && cfg[i].off_hook == FALSE) {
// send signal to pipe saying pick up...
LOG(LOG_DEBUG,"Sending incoming connection to listening modem #%d",i);
writePipe(cfg[i].data.mp[1][1],MSG_ACCEPT);
accept_pending=TRUE;
break;
}
}
// now, send to any non-active modem.
for(i=0;i<modem_count;i++) {
if(cfg[i].off_hook== FALSE) {
// send signal to pipe saying pick up...
LOG(LOG_DEBUG,"Sending incoming connection to non-connected modem #%d",i);
writePipe(cfg[i].data.mp[1][1],MSG_ACCEPT);
accept_pending=TRUE;
break;
}
}
if(i==modem_count) {
LOG(LOG_DEBUG,"No open modem to send to, send notice and close");
// no connections.., accept and print error
cSocket=ip_accept(sSocket);
if(cSocket > -1) {
if(strlen(all_busy) < 1) {
ip_write(cSocket,(unsigned char*)MDM_BUSY,strlen(MDM_BUSY));
} else {
writeFile(all_busy,cSocket);
}
close(cSocket);
}
}
}
}
}
LOG_EXIT();
return rc;
}