#define MTP_RADIO_RESET

static struct gpio_pin gpio_pins_mtp_0_0[] = {
	{
		.name = "ETH_EN",
		.pin = {
			.gpio = AT91_PIN_PC6, // NETH_RST
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "eth-enabled",
		},
		.active_low = 0,
	},
	{
		.name = "RADIO_POWER_MONITOR",
		.pin = {
			.gpio = AT91_PIN_PA23, // PWRMON
			.flags = GPIOF_IN,
			.label = "radio-power-monitor",
		},
	},
	{
		.name = "RADIO_RESET",
		.pin = {
			.gpio = AT91_PIN_PA22, // 3G_RST
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "radio-reset",
		},
	},
	{
		.name = "RADIO_POWER",
		.pin = {
			.gpio = AT91_PIN_PA21, // 3G_ONOFF
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "radio-power",
		},
	},
	{
		.name = "DEVICE_RESET",
		.pin = {
			.gpio = AT91_PIN_PC4, // OPT_RST
			.flags = GPIOF_IN,
			.label = "reset",
		},
		.active_low = 1,
	},
	{
		.name = "USER_PUSHBUTTON",
		.pin = {
			.gpio = AT91_PIN_PA5, // User Pushbutton
			.flags = GPIOF_IN,
			.label = "button",
		},
		.active_low = 1,
	},
	{
		.name = "LORA_RESET",
		.pin = {
			.gpio = AT91_PIN_PA8, // LORA_RST
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "lora-reset",
		},
	},

	/* LEDs */
	{
		.name = "LED2", // LED2 is for LoRa status
		.pin = {
			.gpio = AT91_PIN_PC15,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-lora",
		},
		.active_low = 1,
	},
	{
		.name = "LED2",
		.pin = {
			.gpio = AT91_PIN_PC15,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-a",
		},
		.active_low = 1,
	},
	{
		.name = "LED3", // LED3 is for Cellular status (Modem can directly enable it)
		.pin = {
			.gpio = AT91_PIN_PC16,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-cd",
		},
		.active_low = 1,
	},
	{
		.name = "LED3",
		.pin = {
			.gpio = AT91_PIN_PC16,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-b",
		},
		.active_low = 1,
	},
	{
		.name = "LED4", // LED4 is for WiFi status
		.pin = {
			.gpio = AT91_PIN_PC20,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-wifi",
		},
		.active_low = 1,
	},
	{
		.name = "LED4",
		.pin = {
			.gpio = AT91_PIN_PC20,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-c",
		},
		.active_low = 1,
	},
	{
		.name = "LED5", // DEV_LED_GN
		.pin = {
			.gpio = AT91_PIN_PC25,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-dev",
		},
		.active_low = 1,
	},
	{
		.name = "LED5",
		.pin = {
			.gpio = AT91_PIN_PC25,
			.flags = GPIOF_OUT_INIT_HIGH,
			.label = "led-d",
		},
		.active_low = 1,
	},
	{ },
};


#ifdef MTP_RADIO_RESET

/* radio control (power/reset) for mtp */
static int radio_off_mtp(void)
{
	int value;
	struct gpio_pin *pwrmon_pin = gpio_pin_by_attr_name("radio-power-monitor");
	struct gpio_pin *onoff_pin = gpio_pin_by_attr_name("radio-power");
	struct gpio_pin *rst_pin = gpio_pin_by_attr_name("radio-reset");

	if (!onoff_pin || !pwrmon_pin || !rst_pin) {
		return -ENODEV;
	}

	value = gpio_get_value(pwrmon_pin->pin.gpio);
	if(value == 0) {
		log_error("radio is already off");
		return -EINVAL;
	}

	// drive on/off pin low for at least 3 sec
	log_info("shutting down radio");
	gpio_set_value(onoff_pin->pin.gpio, 0);

	msleep(3500);

	// set on/off pin high
	gpio_set_value(onoff_pin->pin.gpio, 1);

	msleep(200);

	// check that power is low
	value = gpio_get_value(pwrmon_pin->pin.gpio);
	if(value != 0) {
		log_warning("radio is still on. performing radio reset.");
		//Perform Hard Reset
		gpio_set_value(rst_pin->pin.gpio, 0);

		msleep(500);

		// set pin high
		gpio_set_value(rst_pin->pin.gpio, 1);
	} else {
		log_info("radio has been shut down");
	}

	return 0;
}

static int radio_on_mtp(void)
{
	int value;
	struct gpio_pin *pwrmon_pin = gpio_pin_by_attr_name("radio-power-monitor");
	struct gpio_pin *onoff_pin = gpio_pin_by_attr_name("radio-power");
	struct gpio_pin *rst_pin = gpio_pin_by_attr_name("radio-reset");

	if (!onoff_pin || !pwrmon_pin || !rst_pin) {
		return -ENODEV;
	}

	value = gpio_get_value(pwrmon_pin->pin.gpio);
	if(value != 0) {
		log_error("radio is already on");
		return -EINVAL;
	}

	// drive on/off pin low for at least 5 sec
	log_info("turning on radio");
	gpio_set_value(onoff_pin->pin.gpio, 0);

	msleep(5500);

	// set on/off pin high
	gpio_set_value(onoff_pin->pin.gpio, 1);

	msleep(200);

	// check that power is high
	value = gpio_get_value(pwrmon_pin->pin.gpio);
	if(value == 0) {
		log_warning("radio is still off. performing radio reset");
		//Perform Hard Reset
		gpio_set_value(rst_pin->pin.gpio, 0);

		msleep(500);

		// set pin high
		gpio_set_value(rst_pin->pin.gpio, 1);
	} else {
		log_info("radio has been turned on");
	}

	return 0;
}

static int radio_reset_mtp(void)
{
	struct gpio_pin *onoff_pin = gpio_pin_by_attr_name("radio-power");
	struct gpio_pin *rst_pin = gpio_pin_by_attr_name("radio-reset");

	if (!rst_pin || !onoff_pin) {
		return -ENODEV;
	}

	// drive reset pin low for 500ms
	gpio_set_value(rst_pin->pin.gpio, 0);

	msleep(500);

	// set pin high
	gpio_set_value(rst_pin->pin.gpio, 1);

	// wait for 2 sec before toggling on/off pin
	msleep(2000);

	// drive on/off pin low for 6 sec
	gpio_set_value(onoff_pin->pin.gpio, 0);

	msleep(6000);

	// set on/off pin high
	gpio_set_value(onoff_pin->pin.gpio, 1);

	return 0;
}

static ssize_t mts_attr_store_radio_power_mtp(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	int value;
	int err;

	if (sscanf(buf, "%i", &value) != 1) {
		return -EINVAL;
	}
	if (value == 0) {
		mutex_lock(&mts_io_mutex);
		err = radio_off_mtp();
		mutex_unlock(&mts_io_mutex);
	} else {
		mutex_lock(&mts_io_mutex);
		err = radio_on_mtp();
		mutex_unlock(&mts_io_mutex);
	}

	if (err) {
		return err;
	}

	return count;
}

static ssize_t mts_attr_store_radio_reset_mtp(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	int value;
	int err;

	if (sscanf(buf, "%i", &value) != 1) {
		return -EINVAL;
	}
	if (value != 0) {
		return -EINVAL;
	}

	/* check reset timings is enabled */
	if (NULL != timings_data) {
		/* check reset timer is started */
		if (radio_reset_timer_is_start == 1) {
			log_info("radio reset timer is running. \n");
			return count;
		}

		/* check reset timer available is started */
		if (radio_reset_available_timer_is_start == 1) {
			del_timer(&radio_reset_available_timer);
			radio_reset_available_timer_is_start = 0;
		}

		/* reset timer not started, start it */
		mod_timer(&radio_reset_timer, jiffies + msecs_to_jiffies((timings_data[timings_data_index]) * 1000));
		//log_info("radio reset timer is start = [%d]\n", time_now_secs());
		/* save timings_data_stop_seconds */
		timings_data_stop_seconds = timings_data[timings_data_index] + time_now_secs();
		radio_reset_timer_is_start = 1;
	}

	log_info("radio is reset\n");

	mutex_lock(&mts_io_mutex);

	err = radio_reset_mtp();

	mutex_unlock(&mts_io_mutex);

	if (err) {
		return err;
	}

	return count;
}

static ssize_t mts_attr_show_radio_power_mtp(struct device *dev,
			struct device_attribute *attr,
			char *buf)
{
	int value;
	struct gpio_pin *pwrmon_pin = gpio_pin_by_attr_name("radio-power-monitor");

	if ( !pwrmon_pin ) {
		return -ENODEV;
	}

	value = gpio_get_value(pwrmon_pin->pin.gpio);
	return sprintf(buf, "%d\n", value);
}

static DEVICE_ATTR_MTS(dev_attr_radio_reset_mtp, "radio-reset",
	mts_attr_show_gpio_pin, mts_attr_store_radio_reset_mtp);

static DEVICE_ATTR_MTS(dev_attr_radio_power_mtp, "radio-power",
		mts_attr_show_radio_power_mtp, mts_attr_store_radio_power_mtp);
#endif // MTP_RADIO_RESET

static DEVICE_ATTR_MTS(dev_attr_lora_reset_mtp, "lora-reset",
		mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_eth_enabled_mtp, "eth-enabled",
		mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_led_lora_gpio_mtp, "led-lora",
	mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_led_dev_gpio_mtp, "led-dev",
	mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static struct attribute *mtp_0_0_platform_attributes[] = {
		&dev_attr_vendor_id.attr,
		&dev_attr_product_id.attr,
		&dev_attr_device_id.attr,
		&dev_attr_uuid.attr,
		&dev_attr_hw_version.attr,
		&dev_attr_imei.attr,
		&dev_attr_eth_mac.attr,
		&dev_attr_reset.attr,
		&dev_attr_reset_monitor.attr,
		&dev_attr_reset_monitor_intervals.attr,

		&dev_attr_eth_enabled_mtp.attr,

#ifdef MTP_RADIO_RESET
		&dev_attr_radio_power_mtp.attr,
		&dev_attr_radio_reset_mtp.attr,
#else
		&dev_attr_radio_power.attr,
		&dev_attr_radio_reset.attr,
#endif

		&dev_attr_radio_reset_backoffs.attr,
		&dev_attr_radio_reset_backoff_index.attr,
		&dev_attr_radio_reset_backoff_seconds.attr,

		&dev_attr_led_cd_gpio.attr,
		&dev_attr_led_lora_gpio_mtp.attr,
		&dev_attr_led_dev_gpio_mtp.attr,

		&dev_attr_led_a_gpio.attr,
		&dev_attr_led_b_gpio.attr,
		&dev_attr_led_c_gpio.attr,
		&dev_attr_led_d_gpio.attr,
		&dev_attr_lora_reset_mtp.attr,

		NULL,
};

static struct attribute_group mtp_0_0_platform_attribute_group = {
	.attrs = mtp_0_0_platform_attributes
};