/*
 * module.c - netlink implementation of module commands
 *
 * Implementation of "ethtool --show-module <dev>" and
 * "ethtool --set-module <dev> ..."
 */

#include <errno.h>
#include <ctype.h>
#include <inttypes.h>
#include <string.h>
#include <stdio.h>
#include <stdarg.h>

#include "../internal.h"
#include "../common.h"
#include "netlink.h"
#include "parser.h"

/* MODULE_GET */

static const char *module_power_mode_policy_name(u8 val)
{
	switch (val) {
	case ETHTOOL_MODULE_POWER_MODE_POLICY_HIGH:
		return "high";
	case ETHTOOL_MODULE_POWER_MODE_POLICY_AUTO:
		return "auto";
	default:
		return "unknown";
	}
}

static const char *module_power_mode_name(u8 val)
{
	switch (val) {
	case ETHTOOL_MODULE_POWER_MODE_LOW:
		return "low";
	case ETHTOOL_MODULE_POWER_MODE_HIGH:
		return "high";
	default:
		return "unknown";
	}
}

int module_reply_cb(const struct nlmsghdr *nlhdr, void *data)
{
	const struct nlattr *tb[ETHTOOL_A_MODULE_MAX + 1] = {};
	struct nl_context *nlctx = data;
	DECLARE_ATTR_TB_INFO(tb);
	bool silent;
	int err_ret;
	int ret;

	silent = nlctx->is_dump || nlctx->is_monitor;
	err_ret = silent ? MNL_CB_OK : MNL_CB_ERROR;
	ret = mnl_attr_parse(nlhdr, GENL_HDRLEN, attr_cb, &tb_info);
	if (ret < 0)
		return err_ret;
	nlctx->devname = get_dev_name(tb[ETHTOOL_A_MODULE_HEADER]);
	if (!dev_ok(nlctx))
		return err_ret;

	if (silent)
		print_nl();

	open_json_object(NULL);

	print_string(PRINT_ANY, "ifname", "Module parameters for %s:\n",
		     nlctx->devname);

	if (tb[ETHTOOL_A_MODULE_POWER_MODE_POLICY]) {
		u8 val;

		val = mnl_attr_get_u8(tb[ETHTOOL_A_MODULE_POWER_MODE_POLICY]);
		print_string(PRINT_ANY, "power-mode-policy",
			     "power-mode-policy: %s\n",
			     module_power_mode_policy_name(val));
	}

	if (tb[ETHTOOL_A_MODULE_POWER_MODE]) {
		u8 val;

		val = mnl_attr_get_u8(tb[ETHTOOL_A_MODULE_POWER_MODE]);
		print_string(PRINT_ANY, "power-mode",
			     "power-mode: %s\n", module_power_mode_name(val));
	}

	close_json_object();

	return MNL_CB_OK;
}

int nl_gmodule(struct cmd_context *ctx)
{
	struct nl_context *nlctx = ctx->nlctx;
	struct nl_socket *nlsk;
	int ret;

	if (netlink_cmd_check(ctx, ETHTOOL_MSG_MODULE_GET, true))
		return -EOPNOTSUPP;
	if (ctx->argc > 0) {
		fprintf(stderr, "ethtool: unexpected parameter '%s'\n",
			*ctx->argp);
		return 1;
	}

	nlsk = nlctx->ethnl_socket;
	ret = nlsock_prep_get_request(nlsk, ETHTOOL_MSG_MODULE_GET,
				      ETHTOOL_A_MODULE_HEADER, 0);
	if (ret < 0)
		return ret;

	new_json_obj(ctx->json);
	ret = nlsock_send_get_request(nlsk, module_reply_cb);
	delete_json_obj();
	return ret;
}

/* MODULE_SET */

static const struct lookup_entry_u8 power_mode_policy_values[] = {
	{ .arg = "high",	.val = ETHTOOL_MODULE_POWER_MODE_POLICY_HIGH },
	{ .arg = "auto",	.val = ETHTOOL_MODULE_POWER_MODE_POLICY_AUTO },
	{}
};

static const struct param_parser smodule_params[] = {
	{
		.arg		= "power-mode-policy",
		.type		= ETHTOOL_A_MODULE_POWER_MODE_POLICY,
		.handler	= nl_parse_lookup_u8,
		.handler_data	= power_mode_policy_values,
		.min_argc	= 1,
	},
	{}
};

int nl_smodule(struct cmd_context *ctx)
{
	struct nl_context *nlctx = ctx->nlctx;
	struct nl_msg_buff *msgbuff;
	struct nl_socket *nlsk;
	int ret;

	if (netlink_cmd_check(ctx, ETHTOOL_MSG_MODULE_SET, false))
		return -EOPNOTSUPP;
	if (!ctx->argc) {
		fprintf(stderr, "ethtool (--set-module): parameters missing\n");
		return 1;
	}

	nlctx->cmd = "--set-module";
	nlctx->argp = ctx->argp;
	nlctx->argc = ctx->argc;
	nlctx->devname = ctx->devname;
	nlsk = nlctx->ethnl_socket;
	msgbuff = &nlsk->msgbuff;

	ret = msg_init(nlctx, msgbuff, ETHTOOL_MSG_MODULE_SET,
		       NLM_F_REQUEST | NLM_F_ACK);
	if (ret < 0)
		return 2;
	if (ethnla_fill_header(msgbuff, ETHTOOL_A_MODULE_HEADER,
			       ctx->devname, 0))
		return -EMSGSIZE;

	ret = nl_parser(nlctx, smodule_params, NULL, PARSER_GROUP_NONE, NULL);
	if (ret < 0)
		return 1;

	ret = nlsock_sendmsg(nlsk, NULL);
	if (ret < 0)
		return 83;
	ret = nlsock_process_reply(nlsk, nomsg_reply_cb, nlctx);
	if (ret == 0)
		return 0;
	else
		return nlctx->exit_code ?: 83;
}

/* MODULE_FW_FLASH_ACT */

static const struct param_parser flash_module_fw_params[] = {
	{
		.arg		= "file",
		.type		= ETHTOOL_A_MODULE_FW_FLASH_FILE_NAME,
		.handler	= nl_parse_string,
		.min_argc	= 1,
	},
	{
		.arg		= "pass",
		.type		= ETHTOOL_A_MODULE_FW_FLASH_PASSWORD,
		.handler	= nl_parse_direct_u32,
		.min_argc	= 1,
	},
	{}
};

struct module_flash_context {
	uint8_t breakout:1,
		first:1;
};

static int module_fw_flash_ntf_cb(const struct nlmsghdr *nlhdr, void *data)
{
	const struct nlattr *tb[ETHTOOL_A_MODULE_FW_FLASH_MAX + 1] = {};
	struct module_flash_context *mfctx;
	struct nl_context *nlctx = data;
	DECLARE_ATTR_TB_INFO(tb);
	u8 status = 0;
	int ret;

	mfctx = nlctx->cmd_private;

	ret = mnl_attr_parse(nlhdr, GENL_HDRLEN, attr_cb, &tb_info);
	if (ret < 0)
		return MNL_CB_OK;
	nlctx->devname = get_dev_name(tb[ETHTOOL_A_MODULE_FW_FLASH_HEADER]);
	if (!dev_ok(nlctx))
		return MNL_CB_OK;

	if (tb[ETHTOOL_A_MODULE_FW_FLASH_STATUS])
		status = mnl_attr_get_u32(tb[ETHTOOL_A_MODULE_FW_FLASH_STATUS]);

	switch (status) {
	case ETHTOOL_MODULE_FW_FLASH_STATUS_STARTED:
		print_string(PRINT_FP, NULL,
			     "Transceiver module firmware flashing started for device %s\n",
			     nlctx->devname);
		break;
	case ETHTOOL_MODULE_FW_FLASH_STATUS_IN_PROGRESS:
		if (mfctx->first) {
			print_string(PRINT_FP, NULL,
				     "Transceiver module firmware flashing in progress for device %s\n",
				     nlctx->devname);
			mfctx->first = 0;
		}
		break;
	case ETHTOOL_MODULE_FW_FLASH_STATUS_COMPLETED:
		print_nl();
		print_string(PRINT_FP, NULL,
			     "Transceiver module firmware flashing completed for device %s\n",
			     nlctx->devname);
		mfctx->breakout = 1;
		break;
	case ETHTOOL_MODULE_FW_FLASH_STATUS_ERROR:
		print_nl();
		print_string(PRINT_FP, NULL,
			     "Transceiver module firmware flashing encountered an error for device %s\n",
			     nlctx->devname);
		mfctx->breakout = 1;
		break;
	default:
		break;
	}

	if (tb[ETHTOOL_A_MODULE_FW_FLASH_STATUS_MSG]) {
		const char *status_msg;

		status_msg = mnl_attr_get_str(tb[ETHTOOL_A_MODULE_FW_FLASH_STATUS_MSG]);
		print_string(PRINT_FP, NULL, "Status message: %s\n", status_msg);
	}

	if (tb[ETHTOOL_A_MODULE_FW_FLASH_DONE] &&
	    tb[ETHTOOL_A_MODULE_FW_FLASH_TOTAL]) {
		uint64_t done, total;

		done = attr_get_uint(tb[ETHTOOL_A_MODULE_FW_FLASH_DONE]);
		total = attr_get_uint(tb[ETHTOOL_A_MODULE_FW_FLASH_TOTAL]);

		if (total)
			print_u64(PRINT_FP, NULL, "Progress: %"PRIu64"%\r",
				  done * 100 / total);
	}

	return MNL_CB_OK;
}

static int nl_flash_module_fw_cb(const struct nlmsghdr *nlhdr, void *data)
{
	const struct genlmsghdr *ghdr = (const struct genlmsghdr *)(nlhdr + 1);

	if (ghdr->cmd != ETHTOOL_MSG_MODULE_FW_FLASH_NTF)
		return MNL_CB_OK;

	module_fw_flash_ntf_cb(nlhdr, data);

	return MNL_CB_STOP;
}

static int nl_flash_module_fw_process_ntf(struct cmd_context *ctx)
{
	struct nl_context *nlctx = ctx->nlctx;
	struct module_flash_context *mfctx;
	struct nl_socket *nlsk;
	int ret;

	nlsk = nlctx->ethnl_socket;

	mfctx = malloc(sizeof(struct module_flash_context));
	if (!mfctx)
		return -ENOMEM;

	mfctx->breakout = 0;
	mfctx->first = 1;
	nlctx->cmd_private = mfctx;

	while (!mfctx->breakout) {
		ret = nlsock_process_reply(nlsk, nl_flash_module_fw_cb, nlctx);
		if (ret)
			goto out;
		nlsk->seq++;
	}

out:
	free(mfctx);
	return ret;
}

int nl_flash_module_fw(struct cmd_context *ctx)
{
	struct nl_context *nlctx = ctx->nlctx;
	struct nl_msg_buff *msgbuff;
	struct nl_socket *nlsk;
	int ret;

	if (netlink_cmd_check(ctx, ETHTOOL_MSG_MODULE_FW_FLASH_ACT, false))
		return -EOPNOTSUPP;
	if (!ctx->argc) {
		fprintf(stderr, "ethtool (--flash-module-firmware): parameters missing\n");
		return 1;
	}

	nlctx->cmd = "--flash-module-firmware";
	nlctx->argp = ctx->argp;
	nlctx->argc = ctx->argc;
	nlctx->devname = ctx->devname;
	nlsk = nlctx->ethnl_socket;
	msgbuff = &nlsk->msgbuff;

	ret = msg_init(nlctx, msgbuff, ETHTOOL_MSG_MODULE_FW_FLASH_ACT,
		       NLM_F_REQUEST | NLM_F_ACK);
	if (ret < 0)
		return 2;
	if (ethnla_fill_header(msgbuff, ETHTOOL_A_MODULE_FW_FLASH_HEADER,
			       ctx->devname, 0))
		return -EMSGSIZE;

	ret = nl_parser(nlctx, flash_module_fw_params, NULL, PARSER_GROUP_NONE,
			NULL);
	if (ret < 0)
		return 1;

	ret = nlsock_sendmsg(nlsk, NULL);
	if (ret < 0)
		fprintf(stderr, "Cannot flash transceiver module firmware\n");
	else
		ret = nl_flash_module_fw_process_ntf(ctx);

	return ret;
}