/*
 * capab.c
 *
 *  Created on: Dec 1, 2016
 *      Author: jklug
 *
 *  capabilities from EE-PROM, enumerated in /sys/devices/platform/mts-io/capability
 *  an associative array, written the hard way in C.
 */

/* This array is not in any order. */
struct capab_map_s {
	unsigned int bitvalue;
	const char *name;
};

/*
 * Should match mts_eeprom.h capabilities
 */
static struct capab_map_s capabilities_map[] = {
		{ CAPA_GPS,       "gps"},
		{ CAPA_DIN,       "din"},
		{ CAPA_DOUT,      "dout"},
		{ CAPA_ADC,       "adc"},
		{ CAPA_BLUETOOTH, "bluetooth"},
		{ CAPA_WIFI,      "wifi"},
		{ CAPA_LORA,      "lora"},
		{ CAPA_BATTERY,   "battery"},
		{ CAPA_SUPERCAP,  "supercap"},
		{ CAPA_LORA_LBT,  "lora-lbt"},
		{ CAPA_USER_DATA_ENCRYPTION,  "user-data-encryption"},
};

static ssize_t capab_show_value(struct device *dev, struct device_attribute *at, char *buf) {
	int i;
	const int count = sizeof(capabilities_map)/sizeof(capabilities_map[0]);
        struct kobj_attribute *attr = (struct kobj_attribute *)at;

	for (i = 0; i < count; i++) {
		if (strcmp(capabilities_map[i].name, attr->attr.name) == 0) {
			return snprintf(buf, 32, "%u\n", DEVICE_CAPA(id_eeprom.capa, capabilities_map[i].bitvalue) != 0);
		}
	}

	return (ssize_t)-1;
}

static DEVICE_ATTR_RO_MTS(capa_attr_gps,  "gps",       capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_din,  "din",       capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_dout, "dout",      capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_adc,  "adc",       capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_bt,   "bluetooth", capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_wifi, "wifi",      capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_lora, "lora",      capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_battery, "battery",      capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_supercap, "supercap",    capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_lora_lbt, "lora-lbt",    capab_show_value);
static DEVICE_ATTR_RO_MTS(capa_attr_user_data_encryption, "user-data-encryption",    capab_show_value);

static struct attribute *mts_capa_attributes[] = {
		&capa_attr_gps.attr,
		&capa_attr_din.attr,
		&capa_attr_dout.attr,
		&capa_attr_adc.attr,
		&capa_attr_bt.attr,
		&capa_attr_wifi.attr,
		&capa_attr_lora.attr,
		&capa_attr_battery.attr,
		&capa_attr_supercap.attr,
		&capa_attr_lora_lbt.attr,
		&capa_attr_user_data_encryption.attr,
		NULL,
};

static struct attribute_group mts_capa_attr_group = {
	.attrs = mts_capa_attributes
};

static struct kobject *mts_capa_kobject = NULL;
EXPORT_SYMBOL(mts_capa_kobject);

static int mts_capab_dir_create(uint8_t hw_version)
{
    int i,j;
    
    if (hw_version == MTCPM_0_0) {
        for (i=0; mts_capa_attributes[i]; i++) {
            /* Remove capa_lora for MTCPM mts-io driver */
            if (mts_capa_attributes[i] == &capa_attr_lora.attr) {
                for(j=i; mts_capa_attributes[j]; j++)
                    mts_capa_attributes[j] = mts_capa_attributes[j+1];
                break;
            }
        }

        for (i=0; mts_capa_attributes[i]; i++) {
            /* Remove capa_lora_lbt for MTCPM mts-io driver */
            if (mts_capa_attributes[i] == &capa_attr_lora_lbt.attr) {
                for(j=i; mts_capa_attributes[j]; j++)
                    mts_capa_attributes[j] = mts_capa_attributes[j+1];
                break;
            }
        }
    }
    mts_capa_kobject = kobject_create_and_add("capability", &mts_io_platform_device->dev.kobj);
    if (!mts_capa_kobject) {
            log_error("kobject_create_and_add for capability directory failed");
            return -ENOMEM;
    }

    if (sysfs_create_group(mts_capa_kobject, &mts_capa_attr_group)) {
            log_error("sysfs_create_group failed to create capability group");
            return -ENOMEM;
    }

    return 0;
}

static void mts_capab_dir_delete(void)
{
	if (mts_capa_kobject) {
		kobject_put(mts_capa_kobject);
	}
}