vlan_mon,ipoe,pppoe: implemented detection of vlan existance

4 files changed, 126 insertions, 26 deletions

diff --git a/accel-pppd/ctrl/ipoe/ipoe.c b/accel-pppd/ctrl/ipoe/ipoe.c
index 1e3c04c..68841fe 100644
--- a/accel-pppd/ctrl/ipoe/ipoe.c
+++ b/accel-pppd/ctrl/ipoe/ipoe.c
@@ -2181,7 +2181,7 @@ static int get_offer_delay()
 	return 0;
 }
 
-void ipoe_vlan_mon_notify(int ifindex, int vid)
+void ipoe_vlan_mon_notify(int ifindex, int vid, int vlan_ifindex)
 {
 	struct conf_sect_t *sect = conf_get_section("ipoe");
 	struct conf_option_t *opt;
@@ -2217,24 +2217,59 @@ void ipoe_vlan_mon_notify(int ifindex, int vid)
 		return;
 	}
 
-	if (iplink_vlan_add(ifname, ifindex, vid))
-		return;
+	if (vlan_ifindex) {
+		struct ipoe_serv *serv;
+
+		pthread_mutex_lock(&serv_lock);
+		list_for_each_entry(serv, &serv_list, entry) {
+			if (serv->ifindex == vlan_ifindex) {
+				pthread_mutex_unlock(&serv_lock);
+				return;
+			}
+		}
+		pthread_mutex_unlock(&serv_lock);
+
+		log_info2("ipoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
+
+		ifr.ifr_ifindex = vlan_ifindex;
+		if (ioctl(sock_fd, SIOCGIFNAME, &ifr, sizeof(ifr))) {
+			log_error("ipoe: vlan-mon: failed to get interface name, ifindex=%i\n", ifindex);
+			return;
+		}
+
+		if (ioctl(sock_fd, SIOCGIFFLAGS, &ifr, sizeof(ifr)))
+			return;
+
+		if (ifr.ifr_flags & IFF_UP) {
+			ifr.ifr_flags &= ~IFF_UP;
+
+			if (ioctl(sock_fd, SIOCSIFFLAGS, &ifr, sizeof(ifr)))
+				return;
+		}
+
+		if (strcmp(ifr.ifr_name, ifname)) {
+			strcpy(ifr.ifr_newname, ifname);
+			if (ioctl(sock_fd, SIOCSIFNAME, &ifr, sizeof(ifr))) {
+				log_error("ipoe: vlan-mon: failed to rename interface %s to %s\n", ifr.ifr_name, ifr.ifr_newname);
+				return;
+			}
+			strcpy(ifr.ifr_name, ifname);
+		}
+	} else {
+		log_info2("ipoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
 
-	log_info2("ipoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
+		if (iplink_vlan_add(ifname, ifindex, vid))
+			return;
+	}
 
 	len = strlen(ifname);
 	memcpy(ifr.ifr_name, ifname, len + 1);
 
-	ioctl(sock_fd, SIOCGIFFLAGS, &ifr, sizeof(ifr));
-	ifr.ifr_flags |= IFF_UP;
-	ioctl(sock_fd, SIOCSIFFLAGS, &ifr, sizeof(ifr));
-
 	if (ioctl(sock_fd, SIOCGIFINDEX, &ifr, sizeof(ifr))) {
 		log_error("ipoe: vlan-mon: %s: failed to get interface index\n", ifr.ifr_name);
 		return;
 	}
 
-
 	list_for_each_entry(opt, &sect->items, entry) {
 		if (strcmp(opt->name, "interface"))
 			continue;
@@ -2482,6 +2517,10 @@ static void add_interface(const char *ifname, int ifindex, const char *opt, int
 	memset(&ifr, 0, sizeof(ifr));
 	strcpy(ifr.ifr_name, ifname);
 
+	((struct sockaddr_in *)&ifr.ifr_addr)->sin_family = AF_INET;
+
+	ioctl(sock_fd, SIOCSIFADDR, &ifr, sizeof(ifr));
+
 	if (ioctl(sock_fd, SIOCGIFHWADDR, &ifr)) {
 		log_error("ipoe: '%s': ioctl(SIOCGIFHWADDR): %s\n", ifname, strerror(errno));
 		return;
@@ -2489,12 +2528,14 @@ static void add_interface(const char *ifname, int ifindex, const char *opt, int
 
 	ioctl(sock_fd, SIOCGIFFLAGS, &ifr);
 
-	if (!(ifr.ifr_flags & IFF_UP)) {
-		ifr.ifr_flags |= IFF_UP;
-
+	if (ifr.ifr_flags & IFF_UP) {
+		ifr.ifr_flags &= ~IFF_UP;
 		ioctl(sock_fd, SIOCSIFFLAGS, &ifr);
 	}
 
+	ifr.ifr_flags |= IFF_UP;
+	ioctl(sock_fd, SIOCSIFFLAGS, &ifr);
+
 	serv = _malloc(sizeof(*serv));
 	memset(serv, 0, sizeof(*serv));
 	serv->ctx.close = ipoe_serv_close;
diff --git a/accel-pppd/ctrl/pppoe/pppoe.c b/accel-pppd/ctrl/pppoe/pppoe.c
index f219152..b649b0b 100644
--- a/accel-pppd/ctrl/pppoe/pppoe.c
+++ b/accel-pppd/ctrl/pppoe/pppoe.c
@@ -1351,6 +1351,19 @@ static void __pppoe_server_start(const char *ifname, const char *opt, void *cli,
 	}
 
 	strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
+
+	if (net->sock_ioctl(SIOCGIFFLAGS, &ifr)) {
+		if (cli)
+			cli_sendv(cli, "%s: %s\r\n", ifname, strerror(errno));
+		log_error("pppoe: %s: %s\n", ifname, strerror(errno));
+		goto out_err;
+	}
+
+	if (!ifr.ifr_flags & IFF_UP) {
+		ifr.ifr_flags |= IFF_UP;
+		net->sock_ioctl(SIOCSIFFLAGS, &ifr);
+	}
+
 	if (net->sock_ioctl(SIOCGIFHWADDR, &ifr)) {
 		if (cli)
 			cli_sendv(cli, "ioctl(SIOCGIFHWADDR): %s\r\n", strerror(errno));
@@ -1526,7 +1539,7 @@ static int init_secret(struct pppoe_serv_t *serv)
 	return 0;
 }
 
-void pppoe_vlan_mon_notify(int ifindex, int vid)
+void pppoe_vlan_mon_notify(int ifindex, int vid, int vlan_ifindex)
 {
 	struct conf_sect_t *sect = conf_get_section("pppoe");
 	struct conf_option_t *opt;
@@ -1556,17 +1569,53 @@ void pppoe_vlan_mon_notify(int ifindex, int vid)
 		return;
 	}
 
-	strcpy(ifr.ifr_name, ifname);
-	len = strlen(ifr.ifr_name);
+	if (vlan_ifindex) {
+		struct pppoe_serv_t *serv;
 
-	if (iplink_vlan_add(ifr.ifr_name, ifindex, vid))
-		return;
+		pthread_rwlock_rdlock(&serv_lock);
+		list_for_each_entry(serv, &serv_list, entry) {
+			if (serv->ifindex == vlan_ifindex) {
+				pthread_rwlock_unlock(&serv_lock);
+				return;
+			}
+		}
+		pthread_rwlock_unlock(&serv_lock);
+
+		log_info2("pppoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
+
+		ifr.ifr_ifindex = vlan_ifindex;
+		if (ioctl(sock_fd, SIOCGIFNAME, &ifr, sizeof(ifr))) {
+			log_error("pppoe: vlan-mon: failed to get interface name, ifindex=%i\n", ifindex);
+			return;
+		}
 
-	log_info2("pppoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
+		if (ioctl(sock_fd, SIOCGIFFLAGS, &ifr, sizeof(ifr)))
+			return;
+
+		if (ifr.ifr_flags & IFF_UP) {
+			ifr.ifr_flags &= ~IFF_UP;
+
+			if (ioctl(sock_fd, SIOCSIFFLAGS, &ifr, sizeof(ifr)))
+				return;
+		}
+
+		if (strcmp(ifr.ifr_name, ifname)) {
+			strcpy(ifr.ifr_newname, ifname);
+			if (ioctl(sock_fd, SIOCSIFNAME, &ifr, sizeof(ifr))) {
+				log_error("pppoe: vlan-mon: failed to rename interface %s to %s\n", ifr.ifr_name, ifr.ifr_newname);
+				return;
+			}
+			strcpy(ifr.ifr_name, ifname);
+		}
+	} else {
+		log_info2("pppoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
 
-	ioctl(sock_fd, SIOCGIFFLAGS, &ifr, sizeof(ifr));
-	ifr.ifr_flags |= IFF_UP;
-	ioctl(sock_fd, SIOCSIFFLAGS, &ifr, sizeof(ifr));
+		if (iplink_vlan_add(ifr.ifr_name, ifindex, vid))
+			return;
+	}
+
+	strcpy(ifr.ifr_name, ifname);
+	len = strlen(ifname);
 
 	if (ioctl(sock_fd, SIOCGIFINDEX, &ifr, sizeof(ifr))) {
 		log_error("pppoe: vlan-mon: %s: failed to get interface index\n", ifr.ifr_name);
@@ -1602,9 +1651,14 @@ void pppoe_vlan_mon_notify(int ifindex, int vid)
 				continue;
 
 			__pppoe_server_start(ifr.ifr_name, opt->val, NULL, ifindex, vid);
-		} else if (ptr - opt->val == len && memcmp(opt->val, ifr.ifr_name, len) == 0)
+			return;
+		} else if (ptr - opt->val == len && memcmp(opt->val, ifr.ifr_name, len) == 0) {
 			__pppoe_server_start(ifr.ifr_name, opt->val, NULL, ifindex, vid);
+			return;
+		}
 	}
+
+	log_warn("pppoe: vlan %s not started\n", ifname);
 }
 
 static void add_vlan_mon(const char *opt, long *mask)
diff --git a/accel-pppd/include/vlan_mon.h b/accel-pppd/include/vlan_mon.h
index c6b2db7..328e230 100644
--- a/accel-pppd/include/vlan_mon.h
+++ b/accel-pppd/include/vlan_mon.h
@@ -1,7 +1,7 @@
 #ifndef __VLAN_MON_H
 #define __VLAN_MON_H
 
-typedef void (*vlan_mon_notify)(int ifindex, int vid);
+typedef void (*vlan_mon_notify)(int ifindex, int vid, int vlan_ifindex);
 
 void vlan_mon_register_proto(int proto, vlan_mon_notify cb);
 
diff --git a/accel-pppd/vlan-mon/vlan_mon.c b/accel-pppd/vlan-mon/vlan_mon.c
index 7f15aa0..9b77fbc 100644
--- a/accel-pppd/vlan-mon/vlan_mon.c
+++ b/accel-pppd/vlan-mon/vlan_mon.c
@@ -151,7 +151,7 @@ static void vlan_mon_handler(const struct sockaddr_nl *addr, struct nlmsghdr *h)
 	int len = h->nlmsg_len;
 	struct rtattr *attrs;
 	int i;
-	int ifindex, vid, proto;
+	int ifindex, vid, proto, vlan_ifindex;
 
 	len -= NLMSG_LENGTH(GENL_HDRLEN);
 
@@ -176,7 +176,12 @@ static void vlan_mon_handler(const struct sockaddr_nl *addr, struct nlmsghdr *h)
 		vid = *(uint32_t *)(RTA_DATA(tb2[VLAN_MON_ATTR_VID]));
 		proto = *(uint32_t *)(RTA_DATA(tb2[VLAN_MON_ATTR_PROTO]));
 
-		log_debug("vlan-mon: notify %i %i %04x\n", ifindex, vid, proto);
+		if (tb2[VLAN_MON_ATTR_VLAN_IFINDEX])
+			vlan_ifindex = *(uint32_t *)(RTA_DATA(tb2[VLAN_MON_ATTR_VLAN_IFINDEX]));
+		else
+			vlan_ifindex = 0;
+
+		log_debug("vlan-mon: notify %i %i %04x %i\n", ifindex, vid, proto, vlan_ifindex);
 
 		if (proto == ETH_P_PPP_DISC)
 			proto = 1;
@@ -184,7 +189,7 @@ static void vlan_mon_handler(const struct sockaddr_nl *addr, struct nlmsghdr *h)
 			proto = 0;
 
 		if (cb[proto])
-			cb[proto](ifindex, vid);
+			cb[proto](ifindex, vid, vlan_ifindex);
 	}
 }