path: root/io-module/mths.c

/*
 * mths.c
 *
 *  Created on: Apr 26, 2018
 *      Author: leonid
 */

#include "buttons.h"

static struct gpio_pin gpio_pins_mths_0_0[] = {
    {
        .name = "RADIO_POWER_MONITOR",
        .pin = {
            .gpio = AT91_PIN_PA23,
            .flags = GPIOF_IN,
            .label = "radio-power-monitor",
        },
        .active_low = 0,
    },
    {
        .name = "RADIO_RESET",
        .pin = {
            .gpio = AT91_PIN_PA22,
            .flags = GPIOF_OUT_INIT_HIGH | GPIOF_OPEN_DRAIN,
            .label = "radio-reset",
        },
        .active_low = 0,
    },
    {
        .name = "RADIO_POWER",
        .pin = {
            .gpio = AT91_PIN_PA21,
            .flags = GPIOF_OUT_INIT_HIGH | GPIOF_OPEN_DRAIN,
            .label = "radio-power",
        },
        .active_low = 0,
    },
    {
        .name = "DEVICE_RESET",
        .pin = {
            .gpio = AT91_PIN_PC4,
            .flags = GPIOF_IN,
            .label = "reset",
        },
        .active_low = 1,
    },
    {
        .name = "WPS_BUTTON",
        .pin = {
            .gpio = AT91_PIN_PA13,
            .flags = GPIOF_IN,
            .label = "wps_button",
        },
        .active_low = 1,
    },
    {
        .name = "BT_BUTTON",
        .pin = {
            //TODO return back .gpio = AT91_PIN_PC4,
            .gpio = AT91_PIN_PA12,
            .flags = GPIOF_IN,
            .label = "bt_button",
        },
        .active_low = 1,
    },
    {
        .name = "LS_LED",
        .pin = {
            .gpio = AT91_PIN_PC4,
#if LED_LS_CONTROLLABLE
            .flags = GPIOF_OUT_INIT_HIGH,
#else
            .flags = GPIOF_IN,
#endif
            .label = "led-ls",
        },
        .active_low = 1,
    },
    {
        .name = "LED3",
        .pin = {
            .gpio = AT91_PIN_PC15,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-wifi",
        },
        .active_low = 1,
    },
    {
        .name = "LED3",
        .pin = {
            .gpio = AT91_PIN_PC15,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-b",
        },
        .active_low = 1,
    },
    {
        .name = "LED4",
        .pin = {
            .gpio = AT91_PIN_PC20,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-bt",
        },
        .active_low = 1,
    },
    {
        .name = "LED3",
        .pin = {
            .gpio = AT91_PIN_PC20,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-c",
        },
        .active_low = 1,
    },
    {
        .name = "LED4",
        .pin = {
            .gpio = AT91_PIN_PC16,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-cd",
        },
        .active_low = 1,
    },
    {
	.name = "LED5",
	.pin = {
	    .gpio = AT91_PIN_PC21,
	    .flags = GPIOF_OUT_INIT_HIGH,
	    .label = "led-status",
	},
	.active_low = 1,
    },
    {
	.name = "LED5",
	.pin = {
	    .gpio = AT91_PIN_PC16,
	    .flags = GPIOF_OUT_INIT_HIGH,
	    .label = "led-c",
	},
	.active_low = 1,
    },
    {
        .name = "LED6",
        .pin = {
            .gpio = AT91_PIN_PC19,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-sig1",
        },
        .active_low = 1,
    },
    {
        .name = "LED6",
        .pin = {
            .gpio = AT91_PIN_PC19,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-d",
        },
        .active_low = 1,
    },
    {
        .name = "LED7",
        .pin = {
            .gpio = AT91_PIN_PC18,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-sig2",
        },
        .active_low = 1,
    },
    {
        .name = "LED7",
        .pin = {
            .gpio = AT91_PIN_PC18,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-e",
        },
        .active_low = 1,
    },
    {
        .name = "LED8",
        .pin = {
            .gpio = AT91_PIN_PC17,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-sig3",
        },
        .active_low = 1,
    },
    {
        .name = "LED8",
        .pin = {
            .gpio = AT91_PIN_PC17,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "led-f",
        },
        .active_low = 1,
    },

    // The difference between MTRv1_0_0 and MTRv1_0_1 starts here
    {
        .name = "WIFI_BT_ULPWKUP",
        .pin = {
            .gpio = AT91_PIN_PB9,
            .flags = GPIOF_IN,
            .label = "wifi-bt-ulpwkup",
        }
    },
    {
        .name = "WIFI_BT_LPWKUP",
        .pin = {
            .gpio = AT91_PIN_PB11,
            .flags = GPIOF_IN,
            .label = "wifi-bt-lpwkup",
        }
    },
    {
        .name = "WIFI_BT_INT",
        .pin = {
            .gpio = AT91_PIN_PB13,
            .flags = GPIOF_IN,
            .label = "wifi-bt-int",
        }
    },
    {
        .name = "WIFI_BT_RESET",
        .pin = {
            .gpio = AT91_PIN_PB10,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "wifi-bt-reset",
        }
    },
    {
        .name = "WIFI_BT_LPMODE",
        .pin = {
            .gpio = AT91_PIN_PB12,
            .flags = GPIOF_IN,
            .label = "wifi-bt-lpmode",
        }
    },
    {
        .name = "GNSS_RESET",
        .pin = {
            .gpio = AT91_PIN_PC6,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "gnss-reset",
        }
    },
    {
        .name = "USBHUB_RESET",
        .pin = {
            .gpio = AT91_PIN_PB6,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "usbhub-reset",
        }
    },
    {
        .name = "GNSS_INT",
        .pin = {
            .gpio = AT91_PIN_PC7,
            .flags = GPIOF_OUT_INIT_HIGH,
            .label = "gnss-int",
        }
    },


    { },
};

button_info_t mths_wps_button = {
        .name = "User Push Button WPS",
        .label_pin = "wps_button",
        .label_monitor = "wps_button-monitor",
        .label_monitor_intervals = "wps_button-monitor-intervals",

        /* Signals */
        .short_signal = SIGUSR1,
        .long_signal  = SIGUSR2,
        .short_signal = SIGHUP,

        /* Intervals */
        .short_interval = BUTTON_HOLD_COUNT,
        .long_interval = BUTTON_LONG_HOLD_COUNT,
};

button_info_t mths_bt_button = {
        .name = "User Push Button BT",
        .label_pin = "bt_button",
        .label_monitor = "bt_button-monitor",
        .label_monitor_intervals = "bt_button-monitor-intervals",

        /* Signals */
        .short_signal = SIGUSR1,
        .long_signal  = SIGUSR2,
        .short_signal = SIGHUP,

        /* Intervals */
        .short_interval = BUTTON_HOLD_COUNT,
        .long_interval = BUTTON_LONG_HOLD_COUNT,
};

static button_info_pt mths_buttons_0_0[] = {
        &reset_button,
        &mths_wps_button,
        &mths_bt_button,
        NULL,
};

static DEVICE_ATTR_MTS(dev_attr_wps_button_monitor_intervals_mths,
        mths_wps_button.label_monitor_intervals,
        mts_attr_show_button_monitor_intervals,
        mts_attr_store_button_monitor_intervals);

static DEVICE_ATTR_MTS(dev_attr_wps_button_monitor_mths,
        mths_wps_button.label_monitor,
        mts_attr_show_button_monitor,
        mts_attr_store_button_monitor);

static DEVICE_ATTR_RO_MTS(dev_attr_wps_button_pin_mths,
        mths_wps_button.label_pin,
        mts_attr_show_gpio_pin);


static DEVICE_ATTR_MTS(dev_attr_bt_button_monitor_intervals_mths,
        mths_bt_button.label_monitor_intervals,
        mts_attr_show_button_monitor_intervals,
        mts_attr_store_button_monitor_intervals);

static DEVICE_ATTR_MTS(dev_attr_bt_button_monitor_mths,
        mths_bt_button.label_monitor,
        mts_attr_show_button_monitor,
        mts_attr_store_button_monitor);

static DEVICE_ATTR_RO_MTS(dev_attr_bt_button_pin_mths,
        mths_bt_button.label_pin,
        mts_attr_show_gpio_pin);


/* radio control (power/reset) for mtr */
static int radio_off_mths(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_mths(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_mths(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_mths(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_mths();
        mutex_unlock(&mts_io_mutex);
    } else {
        mutex_lock(&mts_io_mutex);
        err = radio_on_mths();
        mutex_unlock(&mts_io_mutex);
    }

    if (err) {
        return err;
    }

    return count;
}

static ssize_t mts_attr_store_radio_reset_mths(struct device *dev,
        struct device_attribute *attr, const char *buf, size_t count)
{
    int value; /* 0 = normal reset; -1 = forced reset */
    int err;

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

    /* check reset timings is enabled */
    if (value != -1 && 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_mths();

    mutex_unlock(&mts_io_mutex);

    if (err) {
        return err;
    }

    return count;
}

static ssize_t mts_attr_show_radio_power_mths(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_power_mths, "radio-power",
    mts_attr_show_radio_power_mths, mts_attr_store_radio_power_mths);

static DEVICE_ATTR_MTS(dev_attr_radio_reset_mths, "radio-reset",
    mts_attr_show_gpio_pin, mts_attr_store_radio_reset_mths);


static DEVICE_ATTR_MTS(dev_attr_led_wifi_gpio_mths, "led-wifi",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_led_bt_gpio_mths, "led-bt",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_led_f_gpio_mths, "led-f",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_led_e_gpio_mths, "led-e",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_RO_MTS(dev_attr_wifi_mac_mths, "mac-wifi",
    mts_attr_show_product_info);

static DEVICE_ATTR_MTS(dev_attr_wifi_bt_lpwkup_mths, "wifi-bt-lpwkup",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_wifi_bt_ulpwkup_mths, "wifi-bt-ulpwkup",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_wifi_bt_reset_mths, "wifi-bt-reset",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_RO_MTS(dev_attr_wifi_bt_lpmode_mths, "wifi-bt-lpmode",
    mts_attr_show_gpio_pin);

static DEVICE_ATTR_RO_MTS(dev_attr_wifi_bt_int_mths, "wifi-bt-int",
    mts_attr_show_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_gnss_reset_mths, "gnss-reset",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_MTS(dev_attr_usbhub_reset_mths, "usbhub-reset",
    mts_attr_show_gpio_pin, mts_attr_store_gpio_pin);

static DEVICE_ATTR_RO_MTS(dev_attr_gnss_int_mths, "gnss-int",
    mts_attr_show_gpio_pin);



static struct attribute *mths_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_wifi_mac_mths.attr,
    &dev_attr_has_radio.attr,

    &dev_attr_reset.attr,
    &dev_attr_reset_monitor.attr,
    &dev_attr_reset_monitor_intervals.attr,
    &dev_attr_wps_button_pin_mths.attr,
    &dev_attr_wps_button_monitor_mths.attr,
    &dev_attr_wps_button_monitor_intervals_mths.attr,
    &dev_attr_bt_button_pin_mths.attr,
    &dev_attr_bt_button_monitor_mths.attr,
    &dev_attr_bt_button_monitor_intervals_mths.attr,

    &dev_attr_radio_power_mths.attr,
    &dev_attr_radio_reset_mths.attr,

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

    &dev_attr_wifi_bt_lpwkup_mths.attr,
    &dev_attr_wifi_bt_ulpwkup_mths.attr,
    &dev_attr_wifi_bt_reset_mths.attr,
    &dev_attr_wifi_bt_lpmode_mths.attr,
    &dev_attr_wifi_bt_int_mths.attr,
    &dev_attr_gnss_reset_mths.attr,
    &dev_attr_usbhub_reset_mths.attr,
    &dev_attr_gnss_int_mths.attr,

    &dev_attr_led_status.attr,
    &dev_attr_led_cd_gpio.attr,
    &dev_attr_led_sig1_gpio.attr,
    &dev_attr_led_sig2_gpio.attr,
    &dev_attr_led_sig3_gpio.attr,
    &dev_attr_led_wifi_gpio_mths.attr,
    &dev_attr_led_bt_gpio_mths.attr,

    &dev_attr_led_b_gpio.attr,
    &dev_attr_led_c_gpio.attr,
    &dev_attr_led_d_gpio.attr,
    &dev_attr_led_e_gpio.attr,
    &dev_attr_led_f_gpio_mths.attr,

    NULL,
};

static struct attribute_group mths_0_0_platform_attribute_group = {
    .attrs = mths_0_0_platform_attributes
};