added radio-power attribute to turn off/on and status power to the radio for mtr/mtr2

1 files changed, 197 insertions, 0 deletions

diff --git a/io-module/mts_io.c b/io-module/mts_io.c
index ba9996f..211dbc4 100644
--- a/io-module/mts_io.c
+++ b/io-module/mts_io.c
@@ -636,6 +636,15 @@ static struct gpio_pin gpio_pins_mtr_0_0[] = {
 		.use_pullup = 0,
 	},
 	{
+		.name = "PWRMON",
+		.attr_name = "radio-power",
+		.pin = AT91_PIN_PA23,
+		.direction = GPIO_DIR_INPUT,
+		.output_value = 0,
+		.use_pullup = 0,
+		.active_low = 0,
+	},
+	{
 		.name = "3G_RST",
 		.attr_name = "radio-reset",
 		.pin = AT91_PIN_PA22,
@@ -837,6 +846,15 @@ static struct gpio_pin gpio_pins_mtr_0_1[] = {
 		.use_pullup = 0,
 	},
 	{
+		.name = "PWRMON",
+		.attr_name = "radio-power",
+		.pin = AT91_PIN_PA23,
+		.direction = GPIO_DIR_INPUT,
+		.output_value = 0,
+		.use_pullup = 0,
+		.active_low = 0,
+	},
+	{
 		.name = "3G_RST",
 		.attr_name = "radio-reset",
 		.pin = AT91_PIN_PA22,
@@ -1217,6 +1235,177 @@ static void blink_callback(struct work_struct *ignored)
 	schedule_delayed_work(&blink_work, BLINK_INTERVAL);
 }
 
+static int radio_off_telit(void)
+{
+	int value, ret;
+	struct gpio_pin *pwrmon_pin = gpio_pin_by_name("PWRMON");
+	struct gpio_pin *onoff_pin = gpio_pin_by_name("3G_ONOFF");
+	struct gpio_pin *rst_pin = gpio_pin_by_name("3G_RST");
+
+	if (!onoff_pin || !pwrmon_pin || !rst_pin) {
+		return -ENODEV;
+	}
+
+	value = at91_get_gpio_value(pwrmon_pin->pin);
+	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");
+	ret = at91_set_gpio_output_with_pullup(onoff_pin->pin, 0, onoff_pin->use_pullup);
+	if (ret) {
+		return ret;
+	}
+
+	msleep(3500);
+
+	// set on/off pin high
+	ret = at91_set_gpio_output_with_pullup(onoff_pin->pin, 1, onoff_pin->use_pullup);
+	if (ret) {
+		return ret;
+	}
+
+	msleep(200);
+
+	// check that power is low
+	value = at91_get_gpio_value(pwrmon_pin->pin);
+	if(value != 0) {
+		log_warning("radio is still on. performing radio reset.");
+		//Perform Hard Reset
+		ret = at91_set_gpio_output_with_pullup(rst_pin->pin, 0, rst_pin->use_pullup);
+		if (ret) {
+			return ret;
+		}
+
+		msleep(500);
+
+		// set pin high
+		ret = at91_set_gpio_output_with_pullup(rst_pin->pin, 1, rst_pin->use_pullup);
+		if (ret) {
+			return ret;
+		}
+	} else {
+		log_info("radio has been shut down");
+	}
+
+	return ret;
+}
+
+static int radio_on_telit(void)
+{
+	int value, ret;
+	struct gpio_pin *pwrmon_pin = gpio_pin_by_name("PWRMON");
+	struct gpio_pin *onoff_pin = gpio_pin_by_name("3G_ONOFF");
+	struct gpio_pin *rst_pin = gpio_pin_by_name("3G_RST");
+
+	if (!onoff_pin || !pwrmon_pin || !rst_pin) {
+		return -ENODEV;
+	}
+
+	value = at91_get_gpio_value(pwrmon_pin->pin);
+	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");
+	ret = at91_set_gpio_output_with_pullup(onoff_pin->pin, 0, onoff_pin->use_pullup);
+	if (ret) {
+		return ret;
+	}
+
+	msleep(5500);
+
+	// set on/off pin high
+	ret = at91_set_gpio_output_with_pullup(onoff_pin->pin, 1, onoff_pin->use_pullup);
+	if (ret) {
+		return ret;
+	}
+
+	msleep(200);
+
+	// check that power is high
+	value = at91_get_gpio_value(pwrmon_pin->pin);
+	if(value == 0) {
+		log_warning("radio is still off. performing radio reset");
+		//Perform Hard Reset
+		ret = at91_set_gpio_output_with_pullup(rst_pin->pin, 0, rst_pin->use_pullup);
+		if (ret) {
+			return ret;
+		}
+
+		msleep(500);
+
+		// set pin high
+		ret = at91_set_gpio_output_with_pullup(rst_pin->pin, 1, rst_pin->use_pullup);
+		if (ret) {
+			return ret;
+		}
+	} else {
+		log_info("radio has been turned on");
+	}
+
+	return ret;
+}
+
+static ssize_t mts_attr_store_radio_power_telit(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_telit();
+		mutex_unlock(&mts_io_mutex);
+	} else {
+		mutex_lock(&mts_io_mutex);
+		err = radio_on_telit();
+		mutex_unlock(&mts_io_mutex);
+	}
+
+	if (err) {
+		return err;
+	}
+
+	return count;
+}
+
+static ssize_t mts_attr_store_radio_power(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	int value;
+	int ret;
+
+	struct gpio_pin *pin = gpio_pin_by_name("RADIO_RESET");
+
+	if (!pin) {
+		return -ENODEV;
+	}
+
+	if (sscanf(buf, "%i", &value) != 1) {
+		return -EINVAL;
+	}
+
+	if (value == 0) {
+		mutex_lock(&mts_io_mutex);
+		ret = at91_set_gpio_value(pin->pin, 0);
+		mutex_unlock(&mts_io_mutex);
+	} else {
+		mutex_lock(&mts_io_mutex);
+		ret = at91_set_gpio_value(pin->pin, 1);
+		mutex_unlock(&mts_io_mutex);
+	}
+
+	return ret;
+}
+
 static int radio_reset_telit(void)
 {
 	int ret;
@@ -1426,6 +1615,9 @@ static ssize_t mts_attr_store_radio_reset_telit(struct device *dev,
 	return count;
 }
 
+static DEVICE_ATTR_MTS(dev_attr_radio_power, "radio-power",
+	mts_attr_show_gpio_pin, mts_attr_store_radio_power);
+
 static DEVICE_ATTR_MTS(dev_attr_radio_reset, "radio-reset",
 	mts_attr_show_gpio_pin, mts_attr_store_radio_reset);
 
@@ -2186,6 +2378,9 @@ static DEVICE_ATTR_MTS(dev_attr_serial_mode, "serial-mode",
 static DEVICE_ATTR_MTS(dev_attr_eth_switch_enabled, "eth-switch-enabled",
 	mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);
 
+static DEVICE_ATTR_MTS(dev_attr_radio_power_telit, "radio-power",
+	mts_attr_show_gpio_pin, mts_attr_store_radio_power_telit);
+
 static DEVICE_ATTR_MTS(dev_attr_radio_reset_telit, "radio-reset",
 	mts_attr_show_gpio_pin, mts_attr_store_radio_reset_telit);
 
@@ -2267,6 +2462,7 @@ static struct attribute *mtr2_platform_attributes[] = {
 	&dev_attr_wifi_mac.attr,
 	&dev_attr_reset.attr,
 	&dev_attr_reset_monitor.attr,
+	&dev_attr_radio_power.attr,
 	&dev_attr_radio_reset.attr,
 	&dev_attr_extserial_dtr.attr,
 	&dev_attr_extserial_dsr_gpio.attr,
@@ -2381,6 +2577,7 @@ static struct attribute *mtr_platform_attributes[] = {
 	&dev_attr_wifi_mac.attr,
 	&dev_attr_reset.attr,
 	&dev_attr_reset_monitor.attr,
+	&dev_attr_radio_power_telit.attr,
 	&dev_attr_radio_reset_telit.attr,
 	&dev_attr_extserial_ri_gpio.attr,
 	&dev_attr_extserial_dtr.attr,