mirror of https://github.com/hak5/openwrt.git
301 lines
8.7 KiB
Diff
301 lines
8.7 KiB
Diff
--- a/br2684ctl.c
|
|
+++ b/br2684ctl.c
|
|
@@ -10,6 +10,10 @@
|
|
#include <atm.h>
|
|
#include <linux/atmdev.h>
|
|
#include <linux/atmbr2684.h>
|
|
+#ifndef BR2684_FLAG_ROUTED
|
|
+#warning "Kernel missing routed support for br2684"
|
|
+#define BR2684_FLAG_ROUTED (1<<16) /* payload is routed, not bridged */
|
|
+#endif
|
|
|
|
/* Written by Marcell GAL <cell@sch.bme.hu> to make use of the */
|
|
/* ioctls defined in the br2684... kernel patch */
|
|
@@ -28,26 +32,35 @@
|
|
#define LOG_OPTION LOG_PERROR|LOG_PID
|
|
#define LOG_FACILITY LOG_LOCAL2
|
|
|
|
+struct br2684_params {
|
|
+ int itfnum;
|
|
+ int encap;
|
|
+ int sndbuf;
|
|
+ int payload;
|
|
+ char *astr; /* temporary */
|
|
+ struct atm_qos reqqos;
|
|
+};
|
|
+
|
|
|
|
int lastsock, lastitf;
|
|
|
|
|
|
-void fatal(const char *str, int i)
|
|
+void fatal(const char *str, int err)
|
|
{
|
|
- syslog (LOG_ERR,"Fatal: %s",str);
|
|
+ syslog (LOG_ERR,"Fatal: %s; %s", str, strerror(err));
|
|
exit(-2);
|
|
};
|
|
|
|
|
|
void exitFunc(void)
|
|
{
|
|
- syslog (LOG_NOTICE,"Daemon terminated\n");
|
|
+ syslog (LOG_NOTICE,"Daemon terminated");
|
|
}
|
|
|
|
|
|
void int_signal(int dummy)
|
|
{
|
|
- syslog (LOG_INFO,"Killed by a signal\n");
|
|
+ syslog (LOG_INFO,"Killed by a signal");
|
|
exit(0);
|
|
}
|
|
|
|
@@ -58,7 +71,7 @@ int create_pidfile(int num)
|
|
|
|
if (num < 0) return -1;
|
|
|
|
- snprintf(name, 20, "/var/run/nas%d.pid", num);
|
|
+ snprintf(name, 32, "/var/run/br2684ctl-nas%d.pid", num);
|
|
pidfile = fopen(name, "w");
|
|
if (pidfile == NULL) return -1;
|
|
fprintf(pidfile, "%d", getpid());
|
|
@@ -67,9 +80,9 @@ int create_pidfile(int num)
|
|
return 0;
|
|
}
|
|
|
|
-int create_br(char *nstr)
|
|
+int create_br(int itfnum, int payload)
|
|
{
|
|
- int num, err;
|
|
+ int err;
|
|
|
|
if(lastsock<0) {
|
|
lastsock = socket(PF_ATMPVC, SOCK_DGRAM, ATM_AAL5);
|
|
@@ -78,31 +91,36 @@ int create_br(char *nstr)
|
|
syslog(LOG_ERR, "socket creation failed: %s",strerror(errno));
|
|
} else {
|
|
/* create the device with ioctl: */
|
|
- num=atoi(nstr);
|
|
- if( num>=0 && num<1234567890){
|
|
+ if( itfnum>=0 && itfnum<1234567890){
|
|
struct atm_newif_br2684 ni;
|
|
ni.backend_num = ATM_BACKEND_BR2684;
|
|
ni.media = BR2684_MEDIA_ETHERNET;
|
|
+#ifdef BR2684_FLAG_ROUTED
|
|
+ if (payload == 0)
|
|
+ ni.media |= BR2684_FLAG_ROUTED;
|
|
+#endif
|
|
ni.mtu = 1500;
|
|
- sprintf(ni.ifname, "nas%d", num);
|
|
+ sprintf(ni.ifname, "nas%d", itfnum);
|
|
err=ioctl (lastsock, ATM_NEWBACKENDIF, &ni);
|
|
|
|
if (err == 0)
|
|
- syslog(LOG_NOTICE, "Interface \"%s\" created sucessfully\n",ni.ifname);
|
|
+ syslog(LOG_NOTICE, "Interface \"%s\" created sucessfully",ni.ifname);
|
|
else
|
|
- syslog(LOG_INFO, "Interface \"%s\" could not be created, reason: %s\n",
|
|
+ syslog(LOG_INFO, "Interface \"%s\" could not be created, reason: %s",
|
|
ni.ifname,
|
|
strerror(errno));
|
|
- lastitf=num; /* even if we didn't create, because existed, assign_vcc wil want to know it! */
|
|
+ lastitf=itfnum; /* even if we didn't create, because existed,
|
|
+ assign_vcc wil want to know it! */
|
|
} else {
|
|
- syslog(LOG_ERR,"err: strange interface number %d", num );
|
|
+ syslog(LOG_ERR,"err: strange interface number %d", itfnum );
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
-int assign_vcc(char *astr, int encap, int bufsize, struct atm_qos qos)
|
|
+int assign_vcc(char *astr, int encap, int payload,
|
|
+ int bufsize, struct atm_qos qos)
|
|
{
|
|
int err;
|
|
struct sockaddr_atmpvc addr;
|
|
@@ -112,21 +130,17 @@ int assign_vcc(char *astr, int encap, in
|
|
memset(&addr, 0, sizeof(addr));
|
|
err=text2atm(astr,(struct sockaddr *)(&addr), sizeof(addr), T2A_PVC);
|
|
if (err!=0)
|
|
- syslog(LOG_ERR,"Could not parse ATM parameters (error=%d)\n",err);
|
|
+ syslog(LOG_ERR,"Could not parse ATM parameters (error=%d)",err);
|
|
|
|
-#if 0
|
|
- addr.sap_family = AF_ATMPVC;
|
|
- addr.sap_addr.itf = itf;
|
|
- addr.sap_addr.vpi = 0;
|
|
- addr.sap_addr.vci = vci;
|
|
-#endif
|
|
- syslog(LOG_NOTICE,"Communicating over ATM %d.%d.%d, encapsulation: %s\n", addr.sap_addr.itf,
|
|
+ syslog(LOG_NOTICE,"Communicating over ATM %d.%d.%d, encapsulation: %s",
|
|
+ addr.sap_addr.itf,
|
|
addr.sap_addr.vpi,
|
|
addr.sap_addr.vci,
|
|
encap?"VC mux":"LLC");
|
|
|
|
if ((fd = socket(PF_ATMPVC, SOCK_DGRAM, ATM_AAL5)) < 0)
|
|
- syslog(LOG_ERR,"failed to create socket %d, reason: %s", errno,strerror(errno));
|
|
+ syslog(LOG_ERR,"failed to create socket %d, reason: %s",
|
|
+ errno,strerror(errno));
|
|
|
|
if (qos.aal == 0) {
|
|
qos.aal = ATM_AAL5;
|
|
@@ -137,7 +151,7 @@ int assign_vcc(char *astr, int encap, in
|
|
}
|
|
|
|
if ( (err=setsockopt(fd,SOL_SOCKET,SO_SNDBUF, &bufsize ,sizeof(bufsize))) )
|
|
- syslog(LOG_ERR,"setsockopt SO_SNDBUF: (%d) %s\n",err, strerror(err));
|
|
+ syslog(LOG_ERR,"setsockopt SO_SNDBUF: (%d) %s",err, strerror(err));
|
|
|
|
if (setsockopt(fd, SOL_ATM, SO_ATMQOS, &qos, sizeof(qos)) < 0)
|
|
syslog(LOG_ERR,"setsockopt SO_ATMQOS %d", errno);
|
|
@@ -145,7 +159,7 @@ int assign_vcc(char *astr, int encap, in
|
|
err = connect(fd, (struct sockaddr*)&addr, sizeof(struct sockaddr_atmpvc));
|
|
|
|
if (err < 0)
|
|
- fatal("failed to connect on socket", err);
|
|
+ fatal("failed to connect on socket", errno);
|
|
|
|
/* attach the vcc to device: */
|
|
|
|
@@ -169,10 +183,30 @@ int assign_vcc(char *astr, int encap, in
|
|
return fd ;
|
|
}
|
|
|
|
+void start_interface(struct br2684_params* params)
|
|
+{
|
|
+ if (params->astr==NULL) {
|
|
+ syslog(LOG_ERR, "Required ATM parameters not specified.");
|
|
+ exit(1);
|
|
+ }
|
|
+
|
|
+ create_br(params->itfnum, params->payload);
|
|
+ assign_vcc(params->astr, params->encap, params->payload, params->sndbuf,
|
|
+ params->reqqos);
|
|
+}
|
|
+
|
|
|
|
void usage(char *s)
|
|
{
|
|
- printf("usage: %s [-b] [[-c number] [-e 0|1] [-s sndbuf] [-q qos] [-a [itf.]vpi.vci]*]*\n", s);
|
|
+ printf("usage: %s [-b] [[-c number] [-e 0|1] [-s sndbuf] [-q qos] [-p 0|1] "
|
|
+ "[-a [itf.]vpi.vci]*]*\n"
|
|
+ " -b = run in background (daemonize)\n"
|
|
+ " -c <num> = use interface nas<num>\n"
|
|
+ " -e 0|1 = encapsulation (0=LLC, 1=VC Mux)\n"
|
|
+ " -p 0|1 = payload type (0=routed,1=bridged)\n"
|
|
+ " -s <num> = set sndbuf (send buffer) size (default 8192)\n"
|
|
+ " -a [itf.]vpi.vci = ATM interface no, VPI, VCI\n",
|
|
+ s);
|
|
exit(1);
|
|
}
|
|
|
|
@@ -180,47 +214,63 @@ void usage(char *s)
|
|
|
|
int main (int argc, char **argv)
|
|
{
|
|
- int c, background=0, encap=0, sndbuf=8192;
|
|
- struct atm_qos reqqos;
|
|
- int itfnum;
|
|
+ int c, background=0;
|
|
+
|
|
+ struct br2684_params params;
|
|
+ params.itfnum=-1;
|
|
+ params.encap=0;
|
|
+ params.sndbuf=8192;
|
|
+ params.payload=1;
|
|
+ params.astr=NULL;
|
|
+ memset(¶ms.reqqos, 0, sizeof(params.reqqos));
|
|
+
|
|
lastsock=-1;
|
|
lastitf=0;
|
|
|
|
/* st qos to 0 */
|
|
- memset(&reqqos, 0, sizeof(reqqos));
|
|
|
|
openlog (LOG_NAME,LOG_OPTION,LOG_FACILITY);
|
|
if (argc>1)
|
|
- while ((c = getopt(argc, argv,"q:a:bc:e:s:?h")) !=EOF)
|
|
+ while ((c = getopt(argc, argv,"q:a:bc:e:s:p:?h")) !=EOF)
|
|
switch (c) {
|
|
case 'q':
|
|
printf ("optarg : %s",optarg);
|
|
- if (text2qos(optarg,&reqqos,0)) fprintf(stderr,"QOS parameter invalid\n");
|
|
+ if (text2qos(optarg,¶ms.reqqos,0))
|
|
+ fprintf(stderr,"QOS parameter invalid\n");
|
|
break;
|
|
case 'a':
|
|
- assign_vcc(optarg, encap, sndbuf, reqqos);
|
|
+ params.astr=optarg;
|
|
break;
|
|
case 'b':
|
|
background=1;
|
|
break;
|
|
case 'c':
|
|
- create_br(optarg);
|
|
- itfnum = atoi(optarg);
|
|
+ /* temporary, to make it work with multiple interfaces: */
|
|
+ if (params.itfnum>=0) start_interface(¶ms);
|
|
+ params.itfnum= atoi(optarg);
|
|
break;
|
|
case 'e':
|
|
- encap=(atoi(optarg));
|
|
- if(encap<0){
|
|
- syslog (LOG_ERR, "invalid encapsulation: %s:\n",optarg);
|
|
- encap=0;
|
|
+ params.encap=(atoi(optarg));
|
|
+ if(params.encap<0){
|
|
+ syslog (LOG_ERR, "invalid encapsulation: %s:",optarg);
|
|
+ params.encap=0;
|
|
}
|
|
break;
|
|
case 's':
|
|
- sndbuf=(atoi(optarg));
|
|
- if(sndbuf<0){
|
|
- syslog(LOG_ERR, "Invalid sndbuf: %s, using size of 8192 instead\n",optarg);
|
|
- sndbuf=8192;
|
|
+ params.sndbuf=(atoi(optarg));
|
|
+ if(params.sndbuf<0){
|
|
+ syslog(LOG_ERR, "Invalid sndbuf: %s, using size of 8192 instead",
|
|
+ optarg);
|
|
+ params.sndbuf=8192;
|
|
}
|
|
break;
|
|
+ case 'p': /* payload type: routed (0) or bridged (1) */
|
|
+#ifdef BR2684_FLAG_ROUTED
|
|
+ params.payload = atoi(optarg);
|
|
+ break;
|
|
+#else
|
|
+ syslog(LOG_ERR, "payload option not supported.");
|
|
+#endif
|
|
case '?':
|
|
case 'h':
|
|
default:
|
|
@@ -231,6 +281,8 @@ int main (int argc, char **argv)
|
|
|
|
if (argc != optind) usage(argv[0]);
|
|
|
|
+ start_interface(¶ms);
|
|
+
|
|
if(lastsock>=0) close(lastsock);
|
|
|
|
if (background) {
|
|
@@ -268,11 +320,11 @@ int main (int argc, char **argv)
|
|
|
|
}
|
|
|
|
- create_pidfile(itfnum);
|
|
+ create_pidfile(params.itfnum);
|
|
signal(SIGINT, int_signal);
|
|
signal(SIGTERM, int_signal);
|
|
|
|
- syslog (LOG_INFO, "RFC 1483/2684 bridge daemon started\n");
|
|
+ syslog (LOG_INFO, "RFC 1483/2684 bridge daemon started");
|
|
atexit (exitFunc);
|
|
|
|
while (1) pause(); /* to keep the sockets... */
|