pfcp: pfcp-peer-list async broadcast

While launching schedule association setup request to remote pfcp peer
list.

Signed-off-by: Alexandre Cassen <acassen@gmail.com>

Author: acassen

src/pfcp/include/pfcp_proto_hdl.h

@@ -25,6 +25,7 @@
 #include "pfcp_session.h"
 
 /* Prototypes */
+void pfcp_assoc_setup_request_send(struct thread *t);
 int pfcp_proto_hdl(struct pfcp_server *srv, struct sockaddr_storage *addr);
 int gtpu_send_end_marker(struct gtp_server *srv, struct pfcp_teid *t);
 int pfcp_gtpu_hdl(struct gtp_server *s, struct sockaddr_storage *addr_from);

src/pfcp/include/pfcp_router.h

@@ -44,13 +44,23 @@ enum pfcp_debug_flags {
 	PFCP_DEBUG_FL_EGRESS_MSG,
 };
 
+struct pfcp_peer_list {
+	char			name[GTP_NAME_MAX_LEN];
+	char			description[GTP_STR_MAX_LEN];
+	union addr		addr[PFCP_PEER_MAX];
+	int			nr_addr;
+
+	struct list_head	next;
+};
+
 struct pfcp_router {
 	char			name[GTP_NAME_MAX_LEN];
 	char			description[GTP_STR_MAX_LEN];
 	uint8_t			supported_features[4];
 	struct gtp_bpf_prog	*bpf_prog;
 	struct pfcp_bpf_data	*bpf_data;
 	struct list_head	bpf_list;
+	struct pfcp_peer_list	*peer_list;
 	struct pfcp_server	s;
 	unsigned long		debug;
 
@@ -72,15 +82,6 @@ struct pfcp_router {
 	struct list_head	next;
 };
 
-struct pfcp_peer_list {
-	char			name[GTP_NAME_MAX_LEN];
-	char			description[GTP_STR_MAX_LEN];
-	union addr		addr[PFCP_PEER_MAX];
-	int			nr_addr;
-
-	struct list_head	next;
-};
-
 
 /* Prototypes */
 struct pfcp_peer_list *pfcp_peer_list_get(const char *name);

src/pfcp/pfcp_proto_hdl.c

@@ -144,6 +144,53 @@ pfcp_assoc_setup_request(struct pfcp_msg *msg, struct pfcp_server *srv,
 	return 0;
 }
 
+static int
+pfcp_assoc_setup_response(struct pfcp_msg *msg, struct pfcp_server *srv,
+			  struct sockaddr_storage *addr)
+{
+
+
+	return 0;
+}
+
+void
+pfcp_assoc_setup_request_send(struct thread *t)
+{
+	struct pfcp_router *ctx = THREAD_ARG(t);
+	struct pfcp_peer_list *plist = ctx->peer_list;
+	struct pkt_buffer *pbuff;
+	struct pfcp_hdr *pfcph;
+	int err = 0, i;
+
+	/* Prepare pkt */
+	pbuff = pkt_buffer_alloc(INET_BUFFER_SIZE);
+	pfcph = (struct pfcp_hdr *) pbuff->head;
+	pfcph->version = 1;
+	pfcph->type = PFCP_ASSOCIATION_SETUP_REQUEST;
+	pfcph->sqn_only = htonl(1 << 8);
+
+	err = pfcp_ie_put_node_id(pbuff, ctx->node_id, ctx->node_id_len);
+	err = (err) ? : pfcp_ie_put_recovery_ts(pbuff, ctx->recovery_ts);
+	err = (err) ? : pfcp_ie_put_up_function_features(pbuff, ctx->supported_features);
+	if (err) {
+		log_message(LOG_INFO, "%s(): Error while Appending IEs"
+				    , __FUNCTION__);
+		goto end;
+	}
+
+	/* Broadcast pkt to peer list */
+	for (i = 0; i < plist->nr_addr; i++) {
+		/* TODO: only support IPv4 peer from now */
+		if (plist->addr[i].family != AF_INET)
+			continue;
+
+		inet_server_snd(&ctx->s.s, ctx->s.s.fd, pbuff, &plist->addr[i].sin);
+	}
+
+end:
+	pkt_buffer_free(pbuff);
+}
+
 
 /* Session Establishment */
 static struct gtp_apn *
@@ -387,6 +434,7 @@ static const struct {
 	[PFCP_HEARTBEAT_REQUEST]		= { pfcp_heartbeat_request },
 	[PFCP_PFD_MANAGEMENT_REQUEST]		= { pfcp_pfd_management_request },
 	[PFCP_ASSOCIATION_SETUP_REQUEST]	= { pfcp_assoc_setup_request },
+	[PFCP_ASSOCIATION_SETUP_RESPONSE]	= { pfcp_assoc_setup_response },
 	[PFCP_ASSOCIATION_UPDATE_REQUEST]	= { NULL },
 	[PFCP_ASSOCIATION_RELEASE_REQUEST]	= { NULL },
 	[PFCP_NODE_REPORT_REQUEST]		= { NULL },

src/pfcp/pfcp_router.c

@@ -39,7 +39,7 @@ extern struct thread_master *master;
 
 
 /*
- *	PFCP Peer utilities
+ *	PFCP Peer list utilities
  */
 struct pfcp_peer_list *
 pfcp_peer_list_get(const char *name)

src/pfcp/pfcp_router_vty.c

@@ -28,6 +28,7 @@
 #include "pfcp_router.h"
 #include "inet_server.h"
 #include "pfcp_assoc.h"
+#include "pfcp_proto_hdl.h"
 #include "pfcp.h"
 #include "inet_utils.h"
 #include "command.h"
@@ -162,6 +163,33 @@ DEFUN(pfcp_router_bpf_prog,
 	return CMD_SUCCESS;
 }
 
+DEFUN(pfcp_router_peer_list,
+      pfcp_router_peer_list_cmd,
+      "pfcp-peer-list STRING",
+      "Use Specific PFCP Peer list\n"
+      "PFCP Peer list name")
+{
+	struct pfcp_router *c = vty->index;
+	struct pfcp_peer_list *plist;
+
+	if (argc < 1) {
+		vty_out(vty, "%% missing arguments%s", VTY_NEWLINE);
+		return CMD_WARNING;
+	}
+
+	plist = pfcp_peer_list_get(argv[0]);
+	if (!plist) {
+		vty_out(vty, "%% unknown pfcp-peer-list:'%s'%s"
+			   , argv[0], VTY_NEWLINE);
+		return CMD_WARNING;
+	}
+
+	c->peer_list = plist;
+	thread_add_event(master, pfcp_assoc_setup_request_send, c, 0);
+
+	return CMD_SUCCESS;
+}
+
 DEFUN(pfcp_listen,
       pfcp_listen_cmd,
       "listen (A.B.C.D|X:X::X:X) port <1024-65535>",
@@ -479,7 +507,7 @@ DEFUN(pfcp_peer_list,
 		return CMD_WARNING;
 	}
 
-	vty->node = PFCP_ROUTER_NODE;
+	vty->node = PFCP_PEER_LIST_NODE;
 	vty->index = new;
 	return CMD_SUCCESS;
 }
@@ -524,9 +552,10 @@ DEFUN(pfcp_peer_list_desciption,
 
 DEFUN(pfcp_peer,
       pfcp_peer_cmd,
-      "peer STRING",
+      "peer (A.B.C.D|X:X::X:X)",
       "Create a PFCP Peer\n"
-      "PFCP Peer")
+      "PFCP IPv4 Peer\n"
+      "PFCP IPv6 Peer\n")
 {
 	struct pfcp_peer_list *p = vty->index;
 	int err;
@@ -542,6 +571,12 @@ DEFUN(pfcp_peer,
 		return CMD_WARNING;
 	}
 
+	if (p->nr_addr >= PFCP_PEER_MAX) {
+		vty_out(vty, "%% Maximum peer per list reached:%d%s"
+			   , p->nr_addr, VTY_NEWLINE);
+		return CMD_WARNING;
+	}
+
 	switch (p->addr[p->nr_addr].family) {
 	case AF_INET:
 		if (!p->addr[p->nr_addr].sin.sin_port)
@@ -609,6 +644,9 @@ config_pfcp_router_write(struct vty *vty)
 		if (c->bpf_prog)
 			vty_out(vty, " bpf-program %s%s"
 				   , c->bpf_prog->name, VTY_NEWLINE);
+		if (c->peer_list)
+			vty_out(vty, " pfcp-peer-list %s%s"
+				   , c->peer_list->name, VTY_NEWLINE);
 		srv = &c->s;
 		if (srv->s.addr.ss_family)
 			vty_out(vty, " listen %s port %d%s"
@@ -664,6 +702,7 @@ config_pfcp_peer_list_write(struct vty *vty)
 				   , VTY_NEWLINE);
 		}
 
+		vty_out(vty, "!\n");
 	}
 
 	return 0;
@@ -684,6 +723,7 @@ cmd_ext_pfcp_router_install(void)
 	install_element(PFCP_ROUTER_NODE, &pfcp_router_description_cmd);
 	install_element(PFCP_ROUTER_NODE, &pfcp_node_id_cmd);
 	install_element(PFCP_ROUTER_NODE, &pfcp_router_bpf_prog_cmd);
+	install_element(PFCP_ROUTER_NODE, &pfcp_router_peer_list_cmd);
 	install_element(PFCP_ROUTER_NODE, &pfcp_listen_cmd);
 	install_element(PFCP_ROUTER_NODE, &pfcp_debug_cmd);
 	install_element(PFCP_ROUTER_NODE, &pfcp_debug_teid_cmd);
@@ -703,7 +743,7 @@ cmd_ext_pfcp_router_install(void)
 }
 
 static int
-cmd_ext_pfcp_peer_install(void)
+cmd_ext_pfcp_peer_list_install(void)
 {
 	/* Install PFCP Router commands. */
 	install_element(CONFIG_NODE, &pfcp_peer_list_cmd);
@@ -738,7 +778,7 @@ struct cmd_node pfcp_peer_list_node = {
 
 static struct cmd_ext cmd_ext_pfcp_peer_list = {
 	.node = &pfcp_peer_list_node,
-	.install = cmd_ext_pfcp_peer_install,
+	.install = cmd_ext_pfcp_peer_list_install,
 };
 
 static void __attribute__((constructor))