/*

 * iplink_hsr.c	HSR device support

 *

 *		This program is free software; you can redistribute it and/or

 *		modify it under the terms of the GNU General Public License

 *		as published by the Free Software Foundation; either version

 *		2 of the License, or (at your option) any later version.

 *

 * Authors:	Arvid Brodin <arvid.brodin@alten.se>

 *

 *		Based on iplink_vlan.c by Patrick McHardy <kaber@trash.net>

 */

#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <sys/socket.h>  /* Needed by linux/if.h for some reason */

#include <linux/if.h>

#include <linux/if_arp.h>

#include "rt_names.h"

#include "utils.h"

#include "ip_common.h"

static void print_usage(FILE *f)

{

	fprintf(f,

		"Usage:\tip link add name NAME type hsr slave1 SLAVE1-IF slave2 SLAVE2-IF\n"

		"\t[ supervision ADDR-BYTE ] [version VERSION] [proto PROTOCOL]\n"

		"\n"

		"NAME\n"

		"	name of new hsr device (e.g. hsr0)\n"

		"SLAVE1-IF, SLAVE2-IF\n"

		"	the two slave devices bound to the HSR device\n"

		"ADDR-BYTE\n"

		"	0-255; the last byte of the multicast address used for HSR supervision\n"

		"	frames (default = 0)\n"

		"VERSION\n"

		"	0,1; the protocol version to be used. (default = 0)\n"

		"PROTOCOL\n"

		"	0 - HSR, 1 - PRP. (default = 0 - HSR)\n");

}

static void usage(void)

{

	print_usage(stderr);

}

static int hsr_parse_opt(struct link_util *lu, int argc, char **argv,

			 struct nlmsghdr *n)

{

	int ifindex;

	unsigned char multicast_spec;

	unsigned char protocol_version;

	unsigned char protocol = HSR_PROTOCOL_HSR;

	while (argc > 0) {

		if (matches(*argv, "supervision") == 0) {

			NEXT_ARG();

			if (get_u8(&multicast_spec, *argv, 0))

				invarg("ADDR-BYTE is invalid", *argv);

			addattr_l(n, 1024, IFLA_HSR_MULTICAST_SPEC,

				  &multicast_spec, 1);

		} else if (matches(*argv, "version") == 0) {

			NEXT_ARG();

			if (!(get_u8(&protocol_version, *argv, 0) == 0 ||

			      get_u8(&protocol_version, *argv, 0) == 1))

				invarg("version is invalid", *argv);

			addattr_l(n, 1024, IFLA_HSR_VERSION,

				  &protocol_version, 1);

		} else if (matches(*argv, "proto") == 0) {

			NEXT_ARG();

			if (!(get_u8(&protocol, *argv, 0) == HSR_PROTOCOL_HSR ||

			      get_u8(&protocol, *argv, 0) == HSR_PROTOCOL_PRP))

				invarg("protocol is invalid", *argv);

			addattr_l(n, 1024, IFLA_HSR_PROTOCOL,

				  &protocol, 1);

		} else if (matches(*argv, "slave1") == 0) {

			NEXT_ARG();

			ifindex = ll_name_to_index(*argv);

			if (ifindex == 0)

				invarg("No such interface", *argv);

			addattr_l(n, 1024, IFLA_HSR_SLAVE1, &ifindex, 4);

		} else if (matches(*argv, "slave2") == 0) {

			NEXT_ARG();

			ifindex = ll_name_to_index(*argv);

			if (ifindex == 0)

				invarg("No such interface", *argv);

			addattr_l(n, 1024, IFLA_HSR_SLAVE2, &ifindex, 4);

		} else if (matches(*argv, "help") == 0) {

			usage();

			return -1;

		} else {

			fprintf(stderr, "hsr: what is \"%s\"?\n", *argv);

			usage();

			return -1;

		}

		argc--, argv++;

	}

	return 0;

}

static void hsr_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[])

{

	SPRINT_BUF(b1);

	if (!tb)

		return;

	if (tb[IFLA_HSR_SLAVE1] &&

	    RTA_PAYLOAD(tb[IFLA_HSR_SLAVE1]) < sizeof(__u32))

		return;

	if (tb[IFLA_HSR_SLAVE2] &&

	    RTA_PAYLOAD(tb[IFLA_HSR_SLAVE2]) < sizeof(__u32))

		return;

	if (tb[IFLA_HSR_SEQ_NR] &&

	    RTA_PAYLOAD(tb[IFLA_HSR_SEQ_NR]) < sizeof(__u16))

		return;

	if (tb[IFLA_HSR_SUPERVISION_ADDR] &&

	    RTA_PAYLOAD(tb[IFLA_HSR_SUPERVISION_ADDR]) < ETH_ALEN)

		return;

	if (tb[IFLA_HSR_SLAVE1])

		print_string(PRINT_ANY,

			     "slave1",

			     "slave1 %s ",

			     ll_index_to_name(rta_getattr_u32(tb[IFLA_HSR_SLAVE1])));

	else

		print_null(PRINT_ANY, "slave1", "slave1 %s ", "<none>");

	if (tb[IFLA_HSR_SLAVE2])

		print_string(PRINT_ANY,

			     "slave2",

			     "slave2 %s ",

			     ll_index_to_name(rta_getattr_u32(tb[IFLA_HSR_SLAVE2])));

	else

		print_null(PRINT_ANY, "slave2", "slave2 %s ", "<none>");

	if (tb[IFLA_HSR_SEQ_NR])

		print_int(PRINT_ANY,

			  "seq_nr",

			  "sequence %d ",

			  rta_getattr_u16(tb[IFLA_HSR_SEQ_NR]));

	if (tb[IFLA_HSR_SUPERVISION_ADDR])

		print_string(PRINT_ANY,

			     "supervision_addr",

			     "supervision %s ",

			     ll_addr_n2a(RTA_DATA(tb[IFLA_HSR_SUPERVISION_ADDR]),

					 RTA_PAYLOAD(tb[IFLA_HSR_SUPERVISION_ADDR]),

					 ARPHRD_VOID,

					 b1, sizeof(b1)));

	if (tb[IFLA_HSR_PROTOCOL])

		print_hhu(PRINT_ANY, "proto", "proto %hhu ",

			  rta_getattr_u8(tb[IFLA_HSR_PROTOCOL]));

}

static void hsr_print_help(struct link_util *lu, int argc, char **argv,

	FILE *f)

{

	print_usage(f);

}

struct link_util hsr_link_util = {

	.id		= "hsr",

	.maxattr	= IFLA_HSR_MAX,

	.parse_opt	= hsr_parse_opt,

	.print_opt	= hsr_print_opt,

	.print_help	= hsr_print_help,

};