1 files changed, 30 insertions, 49 deletions

diff --git a/io-module/mts_io.c b/io-module/mts_io.c
index d95eed5..199c723 100644
--- a/io-module/mts_io.c
+++ b/io-module/mts_io.c
@@ -267,45 +267,9 @@ struct gpio_pin *gpio_pin_by_name(const char *name) {
 	return NULL;
 }
 
-static uint8_t __capa_mask[] = {
-	0x01,
-	0x02,
-	0x04,
-	0x08,
-	0x10,
-	0x20,
-	0x40,
-	0x80
-};
-
-#define DEVICE_CAPA_INDEX(c)			((c) >> 3)
-#define DEVICE_CAPA_MASK(c)			__capa_mask[(c) & 0x07]
-
-#define DEVICE_CAPA(capa_buf, c)		((capa_buf)[DEVICE_CAPA_INDEX(c)] & DEVICE_CAPA_MASK(c))
-#define DEVICE_CAPA_SET(capa_buf, c) \
-do { \
-	(capa_buf)[DEVICE_CAPA_INDEX(c)] |= DEVICE_CAPA_MASK(c); \
-}while (0)
-#define DEVICE_CAPA_CLEAR(capa_buf, c) \
-do { \
-	(capa_buf)[DEVICE_CAPA_INDEX(c)] &= ~DEVICE_CAPA_MASK(c); \
-} while (0)
-
-struct mts_id_eeprom_overlay {
-	char vendor_id[32];
-	char product_id[32];
-	char device_id[32];
-	char hw_version[32];
-	uint8_t capa[32];
-	uint8_t reserved[352];
-};
-
 extern uint8_t mts_id_eeprom[512];
-struct mts_id_eeprom_overlay *id_eeprom =
-  (struct mts_id_eeprom_overlay *) mts_id_eeprom;
-
-#define HWV_MTCDP_0_0			"MTCDP-0.0"
-#define HWV_MTCDP_1_0			"MTCDP-1.0"
+static struct mts_id_eeprom_layout *id_eeprom =
+	(struct mts_id_eeprom_layout *) mts_id_eeprom;
 
 static int mts_id_eeprom_load(void)
 {
@@ -313,18 +277,35 @@ static int mts_id_eeprom_load(void)
 		log_error("uninitialized eeprom");
 		return -EIO;
 	} else if (id_eeprom->vendor_id[0] == 0x00) {
-		log_debug("MTCDP-0.0 hardware found");
-		strcpy(id_eeprom->hw_version, HWV_MTCDP_0_0);
+		strncpy(id_eeprom->vendor_id, VENDOR_ID_MULTITECH, sizeof(id_eeprom->vendor_id) - 1);
+		strncpy(id_eeprom->product_id, PRODUCT_ID_MTCDP_E1_DK, sizeof(id_eeprom->product_id) - 1);
+		strncpy(id_eeprom->device_id, "", sizeof(id_eeprom->device_id) - 1);
+		strncpy(id_eeprom->hw_version, HW_VERSION_MTCDP_0_0, sizeof(id_eeprom->hw_version) - 1);
+
+		DEVICE_CAPA_SET(id_eeprom->capa, CAPA_GPS);
+
 		gpio_pins = gpio_pins_mtcdp_0_0;
 	} else {
 		gpio_pins = gpio_pins_mtcdp_1_0;
 	}
 
-	log_info("vendor_id: %.32s", id_eeprom->vendor_id);
-	log_info("product_id: %.32s",  id_eeprom->product_id);
-	log_info("device_id: %.32s",  id_eeprom->device_id);
-	log_info("hw_version: %.32s",  id_eeprom->hw_version);
-	log_info("capa: %02X",  id_eeprom->capa[0]);
+	log_info("sizeof: %lu", (unsigned long) sizeof(struct mts_id_eeprom_layout));
+	log_info("vendor-id: %.32s", id_eeprom->vendor_id);
+	log_info("product-id: %.32s",  id_eeprom->product_id);
+	log_info("device-id: %.32s",  id_eeprom->device_id);
+	log_info("hw-version: %.32s",  id_eeprom->hw_version);
+	log_info("mac-addr: %02X:%02X:%02X:%02X:%02X:%02X",
+            id_eeprom->mac_addr[0],
+            id_eeprom->mac_addr[1],
+            id_eeprom->mac_addr[2],
+            id_eeprom->mac_addr[3],
+            id_eeprom->mac_addr[4],
+            id_eeprom->mac_addr[5]);
+	log_info("imei: %.32s",  id_eeprom->imei);
+	log_info("capa-gps: %s", DEVICE_CAPA(id_eeprom->capa, CAPA_GPS) ? "yes" : "no");
+	log_info("capa-din: %s", DEVICE_CAPA(id_eeprom->capa, CAPA_DIN) ? "yes" : "no");
+	log_info("capa-dout: %s", DEVICE_CAPA(id_eeprom->capa, CAPA_DOUT) ? "yes" : "no");
+	log_info("capa-adc: %s", DEVICE_CAPA(id_eeprom->capa, CAPA_ADC) ? "yes" : "no");
 
 	return 0;
 }
@@ -1367,7 +1348,7 @@ static ssize_t mts_attr_show_adc(struct device *dev,
 	int offset;
 	u32 value;
 
-	if (!strcmp(id_eeprom->hw_version, HWV_MTCDP_0_0)) {
+	if (!strcmp(id_eeprom->hw_version, HW_VERSION_MTCDP_0_0)) {
 		log_debug("ADC not available on 0.0 hw");
 		return -ENODEV;
 	}
@@ -1532,7 +1513,7 @@ static int __devinit mts_spi_dout_probe(struct spi_device *spi)
 {
 	int tmp;
 
-	if (!strcmp(id_eeprom->hw_version, HWV_MTCDP_0_0)) {
+	if (!strcmp(id_eeprom->hw_version, HW_VERSION_MTCDP_0_0)) {
 		log_debug("digital outputs not available on 0.0 hw");
 		return -ENODEV;
 	}
@@ -1576,7 +1557,7 @@ static int __devinit mts_spi_din_probe(struct spi_device *spi)
 {
 	int tmp;
 
-	if (!strcmp(id_eeprom->hw_version, HWV_MTCDP_0_0)) {
+	if (!strcmp(id_eeprom->hw_version, HW_VERSION_MTCDP_0_0)) {
 		log_debug("digital inputs not available on 0.0 hw");
 		return -ENODEV;
 	}
@@ -1712,7 +1693,7 @@ static int __init mts_io_init(void)
 	ADC_CONVERT_RESET(adc_base);
 	writel(ADC_MODE_DEFAULT, adc_base + ADC_MR_OFFSET);
 	writel(0x000F0F0F, adc_base + ADC_IDR_OFFSET);
-	if (!strcmp(id_eeprom->hw_version, HWV_MTCDP_0_0)) {
+	if (!strcmp(id_eeprom->hw_version, HW_VERSION_MTCDP_0_0)) {
 		writel(0x0F, adc_base + ADC_CHDR_OFFSET);
 	} else {
 		writel(0x0F, adc_base + ADC_CHER_OFFSET);