/*
 * Copyright (C) 2017 XRADIO TECHNOLOGY CO., LTD. All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions
 *  are met:
 *    1. Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *    2. Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in the
 *       documentation and/or other materials provided with the
 *       distribution.
 *    3. Neither the name of XRADIO TECHNOLOGY CO., LTD. nor the names of
 *       its contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *  "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *  LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 *  A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 *  OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *  SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 *  LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 *  DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 *  THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 *  OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include "cmd_util.h"
#include "cmd_gpio.h"
#include "driver/chip/hal_gpio.h"

static void _gpio_cd_irq(void *arg)
{
	GPIO_PinState state;
	uint32_t pin_config = (uint32_t)arg;
	uint32_t port, pin, event;

	port  = (pin_config >> 16) & 0x0ff;
	pin   = (pin_config >> 8)  & 0x0ff;
	event = pin_config & 0x0ff;
	state = HAL_GPIO_ReadPin(port, pin);

	CMD_DBG("gpio irq state:%d event:%d\n", state, event);
}

/*
 * drv gpio config <gpio> m=<mode> p=<pull> l=<level> [e=<event>]
 * eg. drv gpio config pa6 m=1 p=1 l=1
 * eg. drv gpio config pa6 m=1 p=1 l=1 e=0
 */
static enum cmd_status cmd_gpio_config_exec(char *cmd)
{
	int32_t cnt;
	char port;
	char gpio[3];
	uint32_t pin, mode, pull, level, event;
	GPIO_InitParam param;

	cnt = cmd_sscanf(cmd, "%2s%d m=%d p=%d l=%d e=%d", gpio, &pin, &mode,
	                 &pull, &level, &event);
	if (cnt != 6 || pull > GPIO_CTRL_PULL_MAX) {
		cnt = cmd_sscanf(cmd, "%2s%d m=%d p=%d l=%d", gpio, &pin, &mode, &pull,
		                 &level);
		if (cnt != 5 || pull > GPIO_CTRL_PULL_MAX) {
			goto err;
		}
	}

	if (mode == GPIOx_Pn_F6_EINT && cnt != 6) {
		goto err;
	}

	if (cmd_strcmp(gpio, "PA") == 0 || cmd_strcmp(gpio, "pa")  == 0)
		port = GPIO_PORT_A;
	else if (cmd_strcmp(gpio, "PB") == 0 || cmd_strcmp(gpio, "pb")  == 0)
		port = GPIO_PORT_B;
#if (CONFIG_CHIP_ARCH_VER == 2)
	else if (cmd_strcmp(gpio, "PC") == 0 || cmd_strcmp(gpio, "pc")  == 0)
		port = GPIO_PORT_C;
#endif
	else
		goto err;
	param.mode = mode;
	param.driving = level;
	param.pull = pull;
	HAL_GPIO_Init(port, pin, &param);

	if (mode == GPIOx_Pn_F6_EINT) {
		GPIO_IrqParam Irq_param;

		Irq_param.event = event;
		Irq_param.callback = _gpio_cd_irq;
		Irq_param.arg = (void *)((port << 16) | (pin << 8) | event);
		HAL_GPIO_EnableIRQ(port, pin, &Irq_param);
	}

	return CMD_STATUS_OK;

err:
	CMD_ERR("err cmd:%s, expect: <GPIO> m=<Mode> p=<Pull> l=<Level> "
	        "[e=<Event>]\n", cmd);
	return CMD_STATUS_INVALID_ARG;
}

/*
 * drv gpio deconfig <gpio> [m=<mode>]
 * eg. drv gpio deconfig pa6
 * eg. drv gpio deconfig pa6 m=6
 */
static enum cmd_status cmd_gpio_deconfig_exec(char *cmd)
{
	int32_t cnt;
	char port;
	char gpio[3];
	uint32_t pin, mode;

	cnt = cmd_sscanf(cmd, "%2s%d m=%d", gpio, &pin, &mode);
	if (cnt != 3) {
		cnt = cmd_sscanf(cmd, "%2s%d", gpio, &pin);
		if (cnt != 2) {
			CMD_ERR("err cmd:%s, expect: <gpio> m=<Mode>\n", cmd);
			return CMD_STATUS_INVALID_ARG;
		}
	}

	if (cmd_strcmp(gpio, "PA") == 0 || cmd_strcmp(gpio, "pa") == 0)
		port = GPIO_PORT_A;
	else if (cmd_strcmp(gpio, "PB") == 0 || cmd_strcmp(gpio, "pb") == 0)
		port = GPIO_PORT_B;
#if (CONFIG_CHIP_ARCH_VER == 2)
	else if (cmd_strcmp(gpio, "PC") == 0 || cmd_strcmp(gpio, "pc") == 0)
		port = GPIO_PORT_C;
#endif
	else
		return CMD_STATUS_INVALID_ARG;

	HAL_GPIO_DeInit(port, pin);

	if (mode == GPIOx_Pn_F6_EINT) {
		HAL_GPIO_DisableIRQ(port, pin);
	}

	return CMD_STATUS_OK;
}

/*
 * drv gpio read <gpio>
 * eg. drv gpio read pa6
 */
static enum cmd_status cmd_gpio_read_exec(char *cmd)
{
	enum cmd_status ret = CMD_STATUS_OK;
	int32_t cnt;
	char port;
	char gpio[3];
	uint32_t pin, state;

	cnt = cmd_sscanf(cmd, "%2s%d", gpio, &pin);

	if (cmd_strcmp(gpio, "PA") == 0 || cmd_strcmp(gpio, "pa") == 0)
		port = GPIO_PORT_A;
	else if (cmd_strcmp(gpio, "PB") == 0 || cmd_strcmp(gpio, "pb") == 0)
		port = GPIO_PORT_B;
#if (CONFIG_CHIP_ARCH_VER == 2)
	else if (cmd_strcmp(gpio, "PC") == 0 || cmd_strcmp(gpio, "pc") == 0)
		port = GPIO_PORT_C;
#endif
	else
		ret = CMD_STATUS_INVALID_ARG;

	if (cnt != 2 || ret == CMD_STATUS_INVALID_ARG) {
		CMD_ERR("err cmd:%s, expect: <gpio>\n", cmd);
		return ret;
	}

	state = HAL_GPIO_ReadPin(port, pin);
	CMD_DBG("read gpio value:%d\n", state);

	return CMD_STATUS_OK;
}

/*
 * drv gpio write <gpio> v=<value>
 * eg. drv gpio write pa6 v=0
 */
static enum cmd_status cmd_gpio_write_exec(char *cmd)
{
	int32_t cnt;
	char port;
	char gpio[3];
	uint32_t pin, state;

	cnt = cmd_sscanf(cmd, "%2s%d v=%d", gpio, &pin, &state);
	if (cnt != 3) {
		CMD_ERR("err cmd:%s, expect: <gpio> v=<value>\n", cmd);
		return CMD_STATUS_INVALID_ARG;
	}

	if (cmd_strcmp(gpio, "PA") == 0 || cmd_strcmp(gpio, "pa") == 0)
		port = GPIO_PORT_A;
	else if (cmd_strcmp(gpio, "PB") == 0 || cmd_strcmp(gpio, "pb") == 0)
		port = GPIO_PORT_B;
#if (CONFIG_CHIP_ARCH_VER == 2)
	else if (cmd_strcmp(gpio, "PC") == 0 || cmd_strcmp(gpio, "pc") == 0)
		port = GPIO_PORT_C;
#endif
	else
		return CMD_STATUS_INVALID_ARG;

	HAL_GPIO_WritePin(port, pin, state);

	return CMD_STATUS_OK;
}

#if CMD_DESCRIBE
#define gpio_config_help_info \
    "gpio config <gpio> m=<mode> p=<pull> l=<level> [e=<event>]\n" \
    "\t\t\teg. gpio config pa6 m=1 p=1 l=1\n" \
    "\t\t\teg. gpio config pa6 m=1 p=1 l=1 e=0"
#define gpio_deconfig_help_info "gpio deconfig <gpio> [m=<mode>]\n" \
    "\t\t\teg. gpio deconfig pa6\n" \
    "\t\t\teg. gpio deconfig pa6 m=6"
#define gpio_read_help_info "gpio read <gpio>\n" \
    "\t\t\teg. gpio read pa6"
#define gpio_write_help_info "gpio write <gpio> v=<value>\n" \
    "\t\t\teg. gpio write pa6 v=0"
#endif

static enum cmd_status cmd_gpio_help_exec(char *cmd);

static const struct cmd_data g_gpio_cmds[] = {
	{ "config",     cmd_gpio_config_exec,   CMD_DESC(gpio_config_help_info) },
	{ "deconfig",   cmd_gpio_deconfig_exec, CMD_DESC(gpio_deconfig_help_info) },
	{ "read",       cmd_gpio_read_exec,     CMD_DESC(gpio_read_help_info) },
	{ "write",      cmd_gpio_write_exec,    CMD_DESC(gpio_write_help_info) },
	{ "help",       cmd_gpio_help_exec,     CMD_DESC(CMD_HELP_DESC) },
};

static enum cmd_status cmd_gpio_help_exec(char *cmd)
{
	return cmd_help_exec(g_gpio_cmds, cmd_nitems(g_gpio_cmds), 8);
}

enum cmd_status cmd_gpio_exec(char *cmd)
{
	return cmd_exec(cmd, g_gpio_cmds, cmd_nitems(g_gpio_cmds));
}