diff options
| -rw-r--r-- | io-module/mts_io.c | 88 |
1 files changed, 88 insertions, 0 deletions
diff --git a/io-module/mts_io.c b/io-module/mts_io.c index fe7fcaf..c62b534 100644 --- a/io-module/mts_io.c +++ b/io-module/mts_io.c @@ -260,6 +260,13 @@ static struct gpio_pin gpio_pins_mtcdp_1_0[] = { .use_pullup = 0, }, #endif + { + .name = "NDC_RESET", + .pin = AT91_PIN_PB21, + .direction = GPIO_DIR_OUTPUT, + .output_value = 1, + .use_pullup = 0, + }, { }, }; @@ -604,6 +611,27 @@ static int radio_reset(void) return ret; } +static int ndc_reset(void) +{ + int ret; + struct gpio_pin *pin = gpio_pin_by_name("NDC_RESET"); + + if (!pin) { + return -ENODEV; + } + + ret = at91_set_gpio_value(pin->pin, 0); + if (ret) { + return ret; + } + + mdelay(1); + + ret = at91_set_gpio_value(pin->pin, 1); + + return ret; +} + static int ADT7302_to_celsius(int value) { if (value & 0x2000) { @@ -692,6 +720,65 @@ static struct device_attribute dev_attr_radio_reset = { .store = mts_attr_store_radio_reset, }; +static ssize_t mts_attr_show_ndc_reset(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + int value; + struct gpio_pin *pin = gpio_pin_by_name("NDC_RESET"); + + if (!pin) { + return -ENODEV; + } + + mutex_lock(&mts_io_mutex); + + value = at91_get_gpio_value(pin->pin); + + mutex_unlock(&mts_io_mutex); + + if (value < 0) { + return value; + } + + return sprintf(buf, "%d\n", value); +} + +static ssize_t mts_attr_store_ndc_reset(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; + } + + mutex_lock(&mts_io_mutex); + + err = ndc_reset(); + + mutex_unlock(&mts_io_mutex); + + if (err) { + return err; + } + + return count; +} + +static struct device_attribute dev_attr_ndc_reset = { + .attr = { + .name = "ndc-reset", + .mode = MTS_ATTR_MODE_RW, + }, + .show = mts_attr_show_ndc_reset, + .store = mts_attr_store_ndc_reset, +}; + static ssize_t mts_attr_show_eth0_enabled(struct device *dev, struct device_attribute *attr, char *buf) @@ -2202,6 +2289,7 @@ static struct attribute *platform_attributes[] = { &dev_attr_reset.attr, &dev_attr_reset_monitor.attr, &dev_attr_radio_reset.attr, + &dev_attr_ndc_reset.attr, &dev_attr_eth0_enabled.attr, &dev_attr_extserial_dtr.attr, &dev_attr_led_ls.attr, |