From 0a21b0c0b9674f90cb9185e7fe097ae83657328f Mon Sep 17 00:00:00 2001

From: padkrish <padkrish@cisco.com>

Date: Wed, 21 Jan 2015 03:37:31 +0000

Subject: [PATCH] VDP: Support for get-tlv in vdptool and VDP22

This commit has the following changes:

a. Change in VDP22 and vdptool to support get-tlv. This actually refers to

get-vsi. Support for querying and printing all VSI's, partial VSI's is added.

The vdptool man page document is also modified accordingly.

b. The response from lldpad (VDP22) is modified to support to the

len, key, len, value format. Earlier, only the meessage to VDP22 has the

format. The response from VDP22 followed the comma separated format for VSI

parameters.

c. Fix some formatting issues

Signed-off-by: padkrish <padkrish@cisco.com>

Signed-off-by: John Fastabend <john.r.fastabend@intel.com>

---

 docs/vdptool.8         |  47 +++++++-----

 include/lldp_util.h    |   1 +

 include/qbg_vdp22.h    |   5 +-

 include/qbg_vdp22def.h |  11 ++-

 include/qbg_vdpnl.h    |   3 +

 lldp_util.c            |  52 ++++++++++----

 qbg/vdp22.c            |  28 ++++++--

 qbg/vdp22_cmds.c       | 135 +++++++++++++++++++++++++++++++----

 qbg/vdp22sm.c          |   5 +-

 qbg/vdp_ascii.c        | 190 +++++++++++++++++++++++++++++++------------------

 vdptool.c              | 152 +++++++++++----------------------------

 11 files changed, 395 insertions(+), 234 deletions(-)

diff --git a/docs/vdptool.8 b/docs/vdptool.8

index 5110bb9..02b4e8e 100644

--- a/docs/vdptool.8

+++ b/docs/vdptool.8

@@ -70,17 +70,17 @@ bridge.

 Specifies additional parameters for TLV queries and associations commands.

 The argument list varies, depending on the command option

 .B (-T)

-or 

+or

 .BR (-t) .

-To establish a VSI association use the command option 

+To establish a VSI association use the command option

 .B (-T)

 and specify additional information as arguments in the form

-of key=value. See the 

+of key=value. See the

 .I "VSI Parameter"

 subsection and

 .I Example

 section below.

-To query a VSI specific association use the command option 

+To query a VSI specific association use the command option

 .B (-t)

 and specify the value of the

 VSI Instance Identifier (keywork uuid followed be the VSI

@@ -92,6 +92,9 @@ show raw client interface messages

 .TP

 .B \-R

 show only raw Client interface messages

+.TP

+.B \-W

+Wait for the bridge response message

 .SS VSI Parameter

 Each VDP22 TLVs contains a command mode, manager identifier,

 type identifier, type identifier version, VSI instance identifier,

@@ -99,7 +102,7 @@ migiration hints and filter information.

 The fields are explained next:

 .TP

 .B "mode (Command Mode):"

-The command mode determines the type 

+The command mode determines the type

 of the VSI association to be established.

 It is an ascii string can be one of:

 .RS

@@ -110,7 +113,7 @@ Create an VSI preassociation. The association

 is only announced to the switch.

 .IP preassoc-rr:

 Create an VSI preassociation. The association

-is only announced to the switch and the 

+is only announced to the switch and the

 switch should reserve the resources.

 .IP deassoc:

 Delete an VSI association.

@@ -137,7 +140,7 @@ an UUID according to RFC 4122

 with optional dashes in between.

 .TP

 .B "hints (Migration Hints):"

-The migiration hints is a string aiding in 

+The migiration hints is a string aiding in

 migration of virtual machines:

 .RS

 .IP none:

@@ -168,13 +171,13 @@ The MAC address is specified in the format xx:xx:xx:xx:xx:xx.

 The colons are mandatory.

 For vlan details see (1).

 .IP "vlan-mac-group (4)"

-A vlan number, MAC address and group identifier, 

+A vlan number, MAC address and group identifier,

 each delimited by a slash ('-'),

 also known as filter information format 4.

 The group identifier is a 32 bit number.

 For vlan and MAC address details see (1) and (2).

 .IP "vlan--group (3)"

-A vlan number and group identifier, 

+A vlan number and group identifier,

 delimited by two slashes ('--'),

 also known as filter information format 3.

 For vlan and group details see (1) and (4).

@@ -218,18 +221,30 @@ vdptool -p

 Create a VSI association on interface eth2

 .br

 .nf

-Supported today: One config parameter and comma separated list

-vdptool -i eth2 -T -V assoc -c vsi=assoc,blabla,5, \\

-	1122,4,none,2-52:00:00:11:22:33-200

+vdptool -i eth2 -T -V assoc -c mode=assoc -c mgrid2=blabla \\

+	-c typeid=5 -c uuid=1122 -c typeidver=4 -c hints=none \\

+	-c filter=2-52:00:00:11:22:33-200

+.fi

+.TP

+Create a VSI association on interface eth2 and wait for the response from the bridge

+.br

+.nf

+vdptool -i eth2 -T -W -V assoc -c mode=assoc -c mgrid2=blabla \\

+	-c typeid=5 -c uuid=1122 -c typeidver=4 -c hints=none \\

+	-c filter=0-52:00:00:11:22:33-200

+.fi

-Planned for the future:

-vdptool -i eth2 -T -V assoc -c mgrid2=blabla -c typeid=5 \\

-	-c uuid=1122 -c typeidver=4 -c hints=none -c fid=2-52:00:00:11:22:33-200

-.fi

 .TP

 Query all VSI association on interface eth2

 .br

 vdptool -i eth2 -t -V assoc

+

+.TP

+Query  VSI association on interface eth2 that matches specific VSI parameters. Any of the VSI parameters below can be omitted.

+.br

+vdptool -i eth2 -t -V assoc -t -V assoc -c mode=assoc \\

+        -c mgrid2=blabla -c typeid=5 -c uuid=1122 \\

+        -c typeidver=4 -c hints=none

 .SH SEE ALSO

 .BR lldptool-dcbx (8),

 .BR lldptool-ets (8),

diff --git a/include/lldp_util.h b/include/lldp_util.h

index 5767d4e..878426b 100644

--- a/include/lldp_util.h

+++ b/include/lldp_util.h

@@ -170,6 +170,7 @@ int check_link_status(const char *ifname);

 int get_arg_val_list(char *ibuf, int ilen, int *ioff,

 			    char **args, char **argvals);

 int get_arg_list(char *ibuf, int ilen, int *ioff, char **args);

+int get_vsistr_arg_count(int ioff, int ilen);

 #define ntohll(x) be64_to_cpu(x)

 #define htonll(x) cpu_to_be64(x)

diff --git a/include/qbg_vdp22.h b/include/qbg_vdp22.h

index 45f44d5..af0aa15 100644

--- a/include/qbg_vdp22.h

+++ b/include/qbg_vdp22.h

@@ -165,7 +165,7 @@ struct vdp22_user_data {		/* Head for all VDP data */

 struct vsi_keyword_handler {

 	char *keyword;

-	enum vsi_mand_arg val;

+	enum vsi_key_arg val;

 };

 struct lldp_module *vdp22_register(void);

@@ -175,6 +175,7 @@ void vdp22_showvsi(struct vsi22 *p);

 void vdp22_stop(char *);

 int vdp22_from_ecp22(struct vdp22 *);

 int vdp22_query(const char *);

+struct vdp22 *vdp22_getvdp(const char *);

 int vdp22_addreq(struct vsi22 *, struct vdp22 *);

 int vdp22_nlback(struct vsi22 *);

 int vdp22_clntback(struct vsi22 *);

@@ -184,6 +185,8 @@ int vdp22br_resources(struct vsi22 *, int *);

 int vdp22_info(const char *);

 void vdp22_stop_timers(struct vsi22 *);

 int vdp22_start_localchange_timer(struct vsi22 *);

+bool vdp22_cmp_fdata(struct vsi22 *, struct vsi22 *);

+void vdp22_delete_vsi(struct vsi22 *);

 /*

  * Functions to get and set vlan identifier and qos.

diff --git a/include/qbg_vdp22def.h b/include/qbg_vdp22def.h

index 21ba15d..ff4270c 100644

--- a/include/qbg_vdp22def.h

+++ b/include/qbg_vdp22def.h

@@ -30,6 +30,15 @@

 #define QBG_VDP22DEF_H

 /*

+ * Define for length of vid-mac-gid

+ * VID in string cannot be more than 4B (Max is 4K)

+ * MAC when represented as 11:22:33:44:55:66 has 17B

+ * GID is 4B

+ * The below should be more than sufficient.

+ */

+#define MAX_GID_MAC_VID_STR 50

+

+/*

  * Define VDP22 filter formats.

  */

 enum vdp22_ffmt {			/* Format of filter information */

@@ -72,7 +81,7 @@ enum vdp22_migration_hints {

 	VDP22_MIGFROM = 32		/* S-bit migrate from hint */

 };

-enum vsi_mand_arg {

+enum vsi_key_arg {

 	VSI_MODE_ARG = 0,

 	VSI_MGRID2_ARG,

 	VSI_TYPEID_ARG,

diff --git a/include/qbg_vdpnl.h b/include/qbg_vdpnl.h

index 510a20c..c5c93ed 100644

--- a/include/qbg_vdpnl.h

+++ b/include/qbg_vdpnl.h

@@ -79,4 +79,7 @@ int vdp_str2vdpnl(char *, struct vdpnl_vsi *, char *);

 int vdp_vdpnl2str(struct vdpnl_vsi *, char *, size_t);

 int vdp22_sendevent(struct vdpnl_vsi *);

 void vdp22_freemaclist(struct vdpnl_vsi *);

+int vdp22_parse_str_vdpnl(struct vdpnl_vsi *, unsigned short *, char *);

+struct vsi22 *vdp22_alloc_vsi_ext(struct vdpnl_vsi *, int *);

+void copy_vsi_external(struct vdpnl_vsi *, struct vsi22 *, int);

 #endif

diff --git a/lldp_util.c b/lldp_util.c

index 754b0cd..f1fb7b9 100644

--- a/lldp_util.c

+++ b/lldp_util.c

@@ -199,7 +199,7 @@ int is_bond(const char *ifname)

  */

 int is_san_mac(u8 *addr)

 {

-	int i; 

+	int i;

 	for ( i = 0; i < ETH_ALEN; i++) {

 		if ( addr[i]!= 0xff )

@@ -215,7 +215,7 @@ int is_san_mac(u8 *addr)

  *	@addr: address of buffer in which to return the selected MAC address

  *

  *	Checks to see if ifname is a slave of the bond port.  If it is,

- *	then a 

+ *	then a

  *	Returns 0 if a source MAC from the bond could not be found. 1 is

  *	returned if the slave was found in the bond.  addr is updated with

  *	the source MAC that should be used.

@@ -287,7 +287,7 @@ int	get_src_mac_from_bond(struct port *bond_port, char *ifname, u8 *addr)

 	switch (ifb.bond_mode) {

 	case BOND_MODE_ACTIVEBACKUP:

-		/* If current port is not the active slave, then 

+		/* If current port is not the active slave, then

 		 * if the bond MAC is equal to the port's

 		 * permanent MAC, then find and return

 		 * the permanent MAC of the active

@@ -297,7 +297,7 @@ int	get_src_mac_from_bond(struct port *bond_port, char *ifname, u8 *addr)

 		if (strncmp(ifname, act_ifname, IFNAMSIZ))

 			if (get_perm_hwaddr(ifname, addr, san_mac) == 0)

 				if (!memcmp(bond_mac, addr, ETH_ALEN))

-					get_perm_hwaddr(act_ifname, addr, 

+					get_perm_hwaddr(act_ifname, addr,

 								san_mac);

 		break;

 	default:

@@ -346,7 +346,7 @@ int get_ifflags(const char *ifname)

 	int flags = 0;

 	struct ifreq ifr;

-	/* use ioctl */	

+	/* use ioctl */

 	fd = get_ioctl_socket();

 	if (fd >= 0) {

 		memset(&ifr, 0, sizeof(ifr));

@@ -382,7 +382,7 @@ int get_ifpflags(const char *ifname)

 	int flags = 0;

 	struct ifreq ifr;

-	/* use ioctl */	

+	/* use ioctl */

 	fd = get_ioctl_socket();

 	if (fd >= 0) {

 		memset(&ifr, 0, sizeof(ifr));

@@ -417,7 +417,7 @@ int get_iflink(const char *ifname)

 	snprintf(path, sizeof(path), "/sys/class/net/%s/iflink", ifname);

 	return read_int(path);

 }

-	

+

 int is_ether(const char *ifname)

 {

 	/* check for bridge in sysfs */

@@ -486,7 +486,7 @@ int is_slave(const char *ifmaster, const char *ifslave)

 			}

 		}

 	}

-	

+

 out_done:

 	return rc;

 }

@@ -562,13 +562,13 @@ int is_bridge(const char *ifname)

 	if (dirp) {

 		closedir(dirp);

 		rc = 1;

-	} else { 

-		/* use ioctl */	

+	} else {

+		/* use ioctl */

 		fd = get_ioctl_socket();

 		if (fd >= 0) {

 			struct ifreq ifr;

 			struct __bridge_info bi;

-			unsigned long args[4] = { BRCTL_GET_BRIDGE_INFO, 

+			unsigned long args[4] = { BRCTL_GET_BRIDGE_INFO,

 						 (unsigned long) &bi, 0, 0 };

 			ifr.ifr_data = (char *)args;

@@ -748,7 +748,7 @@ int is_autoneg_supported(const char *ifname)

 	int fd;

 	struct ifreq ifr;

 	struct ethtool_cmd cmd;

-	

+

 	fd = get_ioctl_socket();

 	if (fd >= 0) {

 		memset(&ifr, 0, sizeof(ifr));

@@ -769,7 +769,7 @@ int is_autoneg_enabled(const char *ifname)

 	int fd;

 	struct ifreq ifr;

 	struct ethtool_cmd cmd;

-	

+

 	fd = get_ioctl_socket();

 	if (fd >= 0) {

 		memset(&ifr, 0, sizeof(ifr));

@@ -806,7 +806,7 @@ int get_maucaps(const char *ifname)

 	u16 caps = MAUCAPADV_bOther;

 	struct ifreq ifr;

 	struct ethtool_cmd cmd;

-	

+

 	fd = get_ioctl_socket();

 	if (fd >= 0) {

 		memset(&ifr, 0, sizeof(ifr));

@@ -940,7 +940,7 @@ u16 get_caps(const char *ifname)

 	/* how to find TPID to determine C-VLAN vs. S-VLAN ? */

 	if (is_vlan(ifname))

-		caps |= SYSCAP_CVLAN; 

+		caps |= SYSCAP_CVLAN;

 	if (is_bridge(ifname))

 		caps |= SYSCAP_BRIDGE;

@@ -1282,3 +1282,25 @@ int get_arg_list(char *ibuf, int ilen, int *ioff, char **args)

 	free(arglens);

 	return numargs;

 }

+

+/*

+ * This functionality can be seen in many places to convert a LenData to a

+ * argument array.

+ */

+

+int get_vsistr_arg_count(int ioff, int ilen)

+{

+	int offset;

+	int numargs;

+

+	offset = ioff;

+	for (numargs = 0; (ilen - offset) > 2; numargs++) {

+		offset += 2;

+		if (ilen - offset > 0) {

+			offset++;

+			if (ilen - offset > 4)

+				offset += 4;

+		}

+	}

+	return numargs;

+}

diff --git a/qbg/vdp22.c b/qbg/vdp22.c

index a3cb7c9..af11af8 100644

--- a/qbg/vdp22.c

+++ b/qbg/vdp22.c

@@ -219,7 +219,7 @@ void vdp22_showvsi(struct vsi22 *p)

 /*

  * Delete a complete VSI node not on queue.

  */

-static void vdp22_delete_vsi(struct vsi22 *p)

+void vdp22_delete_vsi(struct vsi22 *p)

 {

 	LLDPAD_DBG("%s:%s vsi:%p(%02x)\n", __func__, p->vdp->ifname, p,

 		   p->vsi[0]);

@@ -477,14 +477,15 @@ static bool filter_ok(unsigned char ffmt, struct fid22 *fp,

  * Allocate a VSI node with filter information data.

  * Check if input data is valid.

  */

-static struct vsi22 *vdp22_alloc_vsi(struct vdpnl_vsi *vsi, struct vdp22 *vdp,

-				     int *rc)

+static struct vsi22 *vdp22_alloc_vsi_int(struct vdpnl_vsi *vsi,

+					 struct vdp22 *vdp,

+					 int *rc, bool vsinl_chk)

 {

 	struct vsi22 *p;

 	int i;

 	*rc = -EINVAL;

-	if (!check_vsinl(vsi))

+	if (vsinl_chk && (!check_vsinl(vsi)))

 		return NULL;

 	p = calloc(1, sizeof(*p));

 	if (!p) {

@@ -546,6 +547,16 @@ error1:

 	return NULL;

 }

+struct vsi22 *vdp22_alloc_vsi_ext(struct vdpnl_vsi *vsinl, int *rc)

+{

+	struct vdp22 *vdp;

+

+	vdp = vdp22_getvdp(vsinl->ifname);

+	if (!vdp)

+		return NULL;

+	return vdp22_alloc_vsi_int(vsinl, vdp, rc, false);

+}

+

 /*

  * Allocate a VSI node with filter information data.

  * Check if input data is valid. Data was received by bridge from unknown

@@ -750,7 +761,7 @@ static struct vdp22 *vdp22_create(const char *ifname,

 /*

  * Query the supported VDP protocol on an interface.

  */

-static struct vdp22 *vdp22_getvdp(const char *ifname)

+struct vdp22 *vdp22_getvdp(const char *ifname)

 {

 	struct vdp22 *vdp;

@@ -820,7 +831,7 @@ int vdp22_request(struct vdpnl_vsi *vsi, int clif)

 		/* Adjust numbering for VDP 0.2 protocol from netlink */

 		if (!clif)

 			vsi->request += 1;

-		p = vdp22_alloc_vsi(vsi, vdp, &rc);

+		p = vdp22_alloc_vsi_int(vsi, vdp, &rc, true);

 		if (p) {

 			rc = vdp22_addreq(p, vdp);

 			if (rc)

@@ -1079,3 +1090,8 @@ int vdp22_info(const char *ifname)

 	return rc;

 }

+

+void copy_vsi_external(struct vdpnl_vsi *vsi, struct vsi22 *p, int clif)

+{

+	copy_vsi(vsi, p, clif);

+}

diff --git a/qbg/vdp22_cmds.c b/qbg/vdp22_cmds.c

index dde4669..409858d 100644

--- a/qbg/vdp22_cmds.c

+++ b/qbg/vdp22_cmds.c

@@ -237,7 +237,7 @@ int vdp22_clif_cmd(UNUSED void *data, UNUSED struct sockaddr_un *from,

 		return cmd_not_applicable;

 	}

-	if (!(cmd.ops & op_config))

+	if (!(cmd.ops & op_config) && (cmd.cmd != cmd_gettlv))

 		return cmd_invalid;

 	snprintf(rbuf, rlen, "%c%1x%02x%08x%02x%s",

@@ -254,10 +254,9 @@ int vdp22_clif_cmd(UNUSED void *data, UNUSED struct sockaddr_un *from,

 	snprintf(rbuf + roff, rlen - roff, "%08x", cmd.tlvid);

 	roff += 8;

 	if (cmd.cmd == cmd_gettlv) {

-		rstatus = handle_get_arg(&cmd, ARG_VDP22_VSI,

-						NULL,

-						rbuf + strlen(rbuf),

-						rlen - strlen(rbuf));

+		rstatus = handle_get_arg(&cmd, ARG_VDP22_VSI, ibuf + ioff,

+					 rbuf + strlen(rbuf),

+					 rlen - strlen(rbuf));

 	} else {

 		rstatus = handle_test_arg(&cmd, ARG_VDP22_VSI,

 						ibuf + ioff,

@@ -392,19 +391,25 @@ static int test_arg_vsi(struct cmd *cmd, UNUSED char *arg, char *argvalue,

  */

 static int catvsis(struct vdpnl_vsi *vsi, char *out, size_t out_len)

 {

-	int rc, i;

+	int rc, i, len, c;

 	size_t used = 0;

 	unsigned char wanted_req = vsi->request;

+	char tmp_buf[MAX_CLIF_MSGBUF];

+	memset(tmp_buf, 0, sizeof(tmp_buf));

 	for (i = 1; vdp22_status(i, vsi, 1) > 0; ++i) {

 		if (wanted_req != vsi->request) {

 			vdp22_freemaclist(vsi);

 			continue;

 		}

-		rc = vdp_vdpnl2str(vsi, out + used, out_len - used);

+		rc = vdp_vdpnl2str(vsi, tmp_buf, out_len - used);

+		len = strlen(tmp_buf);

+		c = snprintf(out + used, out_len - used, "%04x%s", len,

+			     tmp_buf);

+		if ((c < 0) || ((unsigned)c >= (out_len - used)))

+			return 0;

 		vdp22_freemaclist(vsi);

 		if (rc) {

-			strcat(out, ";");

 			used = strlen(out);

 		} else

 			return 0;

@@ -413,15 +418,113 @@ static int catvsis(struct vdpnl_vsi *vsi, char *out, size_t out_len)

 }

 /*

+ * Based on the VSI arguments specified, checks if it matches.

+ * This does't check for all VSI parameters.

+ */

+

+static bool vdp22_partial_vsi_equal(struct vsi22 *p1, struct vsi22 *p2,

+				    enum vsi_key_arg vsi_arg_key_flags)

+{

+	enum vsi_key_arg key_enum;

+

+	for (key_enum = VSI_MODE_ARG; key_enum < VSI_INVALID_ARG; key_enum++) {

+		if (!((1 << key_enum) & vsi_arg_key_flags))

+			continue;

+		switch (key_enum) {

+		case VSI_MODE_ARG:

+			break;

+		case VSI_MGRID2_ARG:

+			if (memcmp(p1->mgrid, p2->mgrid,

+				   sizeof(p2->mgrid)))

+				return false;

+		case VSI_TYPEID_ARG:

+			if (p1->type_id != p2->type_id)

+				return false;

+			break;

+		case VSI_TYPEIDVER_ARG:

+			if (p1->type_ver != p2->type_ver)

+				return false;

+			break;

+#ifdef LATER

+/* Currently not supported */

+		case VSI_VSIIDFRMT_ARG:

+			if (p1->vsi_fmt != p2->vsi_fmt)

+				return false;

+			break;

+#endif

+		case VSI_VSIID_ARG:

+			if (memcmp(p1->vsi, p2->vsi, sizeof(p1->vsi)))

+				return false;

+			break;

+		case VSI_FILTER_ARG:

+			if ((p1->fif != p2->fif) || (!vdp22_cmp_fdata(p1, p2)))

+				return false;

+			break;

+		case VSI_HINTS_ARG:

+			break;

+		default:

+			return false;

+		}

+	}

+	return true;

+}

+

+static int get_vsi_partial_arg(UNUSED char *arg, char *orig_argvalue,

+			       struct vdpnl_vsi *vsinl, char *out,

+			       size_t out_len)

+{

+	char tmp_buf[MAX_CLIF_MSGBUF];

+	struct vsi22 *p, *vsi;

+	struct vdp22 *vdp;

+	size_t used = 0;

+	int rc = -ENOMEM, len, c;

+	u16 vsi_arg_key_flags = 0;

+

+	if (vdp22_parse_str_vdpnl(vsinl, &vsi_arg_key_flags, orig_argvalue))

+		goto out;

+	vdp = vdp22_getvdp(vsinl->ifname);

+	if (!vdp)

+		goto out;

+

+	vsi = vdp22_alloc_vsi_ext(vsinl, &rc);

+	if (!vsi)

+		goto out;

+	LIST_FOREACH(p, &vdp->vsi22_que, node) {

+		if (p->vsi_mode != vsi->vsi_mode)

+			continue;

+		if (vdp22_partial_vsi_equal(p, vsi, vsi_arg_key_flags)) {

+			copy_vsi_external(vsinl, p, 1);

+			rc = vdp_vdpnl2str(vsinl, tmp_buf, out_len - used);

+			len = strlen(tmp_buf);

+			c = snprintf(out + used, out_len - used, "%04x%s",

+				     len, tmp_buf);

+			vdp22_freemaclist(vsinl);

+			if ((c < 0) || ((unsigned)c >= (out_len - used)))

+				goto out_delvsi;

+			if (rc)

+				used = strlen(out);

+			else

+				goto out_delvsi;

+		}

+	}

+out_delvsi:

+	vdp22_delete_vsi(vsi);

+out:

+	return rc;

+}

+

+/*

  * Return all VSIs on a particular interface into one string.

  */

-static int get_arg_vsi(struct cmd *cmd, char *arg, UNUSED char *argvalue,

+static int get_arg_vsi(struct cmd *cmd, char *arg, char *argvalue,

 		       char *obuf, int obuf_len)

 {

 	cmd_status good_cmd = vdp22_cmdok(cmd, cmd_gettlv);

 	struct vdpnl_vsi vsi;

 	char vsi_str[MAX_CLIF_MSGBUF];

 	int rc;

+	int fsize = (cmd->ops >> OP_FID_POS) & 0xff;

+	struct vdpnl_mac mac[fsize];

 	if (good_cmd != cmd_success)

 		return good_cmd;

@@ -433,14 +536,20 @@ static int get_arg_vsi(struct cmd *cmd, char *arg, UNUSED char *argvalue,

 	memset(obuf, 0, obuf_len);

 	memset(&vsi, 0, sizeof(vsi));

+	memset(vsi_str, 0, sizeof(vsi_str));

 	vsi.request = cmd->tlvid;

 	strncpy(vsi.ifname, cmd->ifname, sizeof(vsi.ifname) - 1);

 	good_cmd = cmd_failed;

-	if (!catvsis(&vsi, vsi_str, sizeof(vsi_str)))

+	if ((cmd->ops & op_config) && (cmd->ops & op_arg)) {

+		memset(&mac, 0, sizeof(mac));

+		vsi.macsz = fsize;

+		vsi.maclist = mac;

+		if (!get_vsi_partial_arg(arg, argvalue, &vsi, vsi_str,

+					 sizeof(vsi_str)))

+			goto out;

+	} else if (!catvsis(&vsi, vsi_str, sizeof(vsi_str)))

 		goto out;

-	rc = snprintf(obuf, obuf_len, "%02x%s%04x%s",

-		 (unsigned int)strlen(arg), arg, (unsigned int)strlen(vsi_str),

-		 vsi_str);

+	rc = snprintf(obuf, obuf_len, "%s", vsi_str);

 	if (rc > 0 || rc < obuf_len)

 		good_cmd = cmd_success;

 out:

diff --git a/qbg/vdp22sm.c b/qbg/vdp22sm.c

index d1f65b4..6264f74 100644

--- a/qbg/vdp22sm.c

+++ b/qbg/vdp22sm.c

@@ -944,7 +944,8 @@ static bool cmp_fdata1(struct fid22 *p1, struct fid22 *p2, unsigned char fif)

 	if (fif == VDP22_FFMT_MACVID || fif == VDP22_FFMT_GROUPMACVID)

 		is_good = !memcmp(p1->mac, p2->mac, sizeof(p1->mac));

-	if (fif == VDP22_FFMT_GROUPVID || fif == VDP22_FFMT_GROUPMACVID)

+	if (is_good &&

+		(fif == VDP22_FFMT_GROUPVID || fif == VDP22_FFMT_GROUPMACVID))

 		is_good = (p1->grpid == p2->grpid);

 	if (is_good) {

 		if (vdp22_get_vlanid(p1->vlan))

@@ -956,7 +957,7 @@ static bool cmp_fdata1(struct fid22 *p1, struct fid22 *p2, unsigned char fif)

 	return is_good;

 }

-static bool vdp22_cmp_fdata(struct vsi22 *p, struct vsi22 *vsip)

+bool vdp22_cmp_fdata(struct vsi22 *p, struct vsi22 *vsip)

 {

 	int i;

diff --git a/qbg/vdp_ascii.c b/qbg/vdp_ascii.c

index 09e53c6..76dde4a 100644

--- a/qbg/vdp_ascii.c

+++ b/qbg/vdp_ascii.c

@@ -110,6 +110,15 @@ static bool getnumber(char *s, unsigned int min, unsigned int max,

 }

 /*

+ * Returns the byte length of a given number

+ */

+

+static int get_strlen_num(unsigned long no)

+{

+	return snprintf(NULL, 0, "%lu", no);

+}

+

+/*

  * Read filter information data. The format is an ascii string:

  * filter-data		filter-format

  * vlan			1

@@ -264,7 +273,7 @@ static bool getmode(struct vdpnl_vsi *p, char *s)

 	return true;

 }

-enum vsi_mand_arg get_keywork_val(char *keyword)

+enum vsi_key_arg get_keywork_val(char *keyword)

 {

 	int count, key_str_size;

@@ -276,65 +285,36 @@ enum vsi_mand_arg get_keywork_val(char *keyword)

 	return VSI_INVALID_ARG;

 }

-/*

- * Parse the mode parameter to create/change an VSI assoication.

- * The format is a comma separated list of tokens:

- * cmd,mgrid,typeid,typeidversion,vsiid,hints,fid[,fid,fid,...]

- * with