add support for MTAC-MFSER

1 files changed, 33 insertions, 2 deletions

diff --git a/io-module/mts_io.c b/io-module/mts_io.c
index b63a756..2ecc636 100644
--- a/io-module/mts_io.c
+++ b/io-module/mts_io.c
@@ -99,6 +99,7 @@ static DEFINE_MUTEX(mts_io_mutex);
 
 /* accessory card support */
 #include "mtdc_gpiob.c"
+#include "mtac_mfser.c"
 
 /* telit radio reset handling */
 #include "telit_radio.c"
@@ -440,6 +441,10 @@ static bool add_accessory_card_attributes(int slot)
 				card_attrs_size = ap1_gpio_attributes_size;
 				card_attrs = ap1_gpio_attributes;
 				break;
+			case MTAC_MFSER_0_0:
+				card_attrs_size = ap1_mfser_attributes_size;
+				card_attrs = ap1_mfser_attributes;
+				break;
 			default:
 				log_error("accessory card %s isn't supported", ap1_eeprom.hw_version);
 				return false;
@@ -450,6 +455,10 @@ static bool add_accessory_card_attributes(int slot)
 				card_attrs_size = ap2_gpio_attributes_size;
 				card_attrs = ap2_gpio_attributes;
 				break;
+			case MTAC_MFSER_0_0:
+				card_attrs_size = ap2_mfser_attributes_size;
+				card_attrs = ap2_mfser_attributes;
+				break;
 			default:
 				log_error("accessory card %s isn't supported", ap2_eeprom.hw_version);
 				return false;
@@ -715,7 +724,10 @@ static int __init mts_io_init(void)
 				// more elegant way to handle this?
 				if (strstr(ap1_eeprom.product_id, PRODUCT_ID_MTDC_GPIOB)) {
 					mts_ap1_product_id = MTDC_GPIOB_0_0;
-				} // else if (...) { }
+				}
+				else if (strstr(ap1_eeprom.product_id, PRODUCT_ID_MTAC_MFSER)) {
+					mts_ap1_product_id = MTAC_MFSER_0_0;
+				}
 
 				switch(mts_ap1_product_id) {
 					case MTDC_GPIOB_0_0:
@@ -747,6 +759,14 @@ static int __init mts_io_init(void)
 							goto error1;
 						}
 						break;
+					case MTAC_MFSER_0_0:
+						log_info("loading MFSER accessory card in slot 1");
+						if (! add_accessory_card_attributes(1)) {
+							log_error("failed to load MFSER accessory card in slot 1");
+						} else {
+							log_info("successfully loaded MFSER accessory card in slot 1");
+						}
+						break;
 
 					default:
 						log_error("accessory card %s unsupported", ap1_eeprom.product_id);
@@ -757,7 +777,10 @@ static int __init mts_io_init(void)
 				// more elegant way to handle this?
 				if (strstr(ap2_eeprom.product_id, PRODUCT_ID_MTDC_GPIOB)) {
 					mts_ap2_product_id = MTDC_GPIOB_0_0;
-				} // else if (...) { }
+				}
+				else if (strstr(ap2_eeprom.product_id, PRODUCT_ID_MTAC_MFSER)) {
+					mts_ap2_product_id = MTAC_MFSER_0_0;
+				}
 
 				switch(mts_ap2_product_id) {
 					case MTDC_GPIOB_0_0:
@@ -789,6 +812,14 @@ static int __init mts_io_init(void)
 							goto error1;
 						}
 						break;
+					case MTAC_MFSER_0_0:
+						log_info("loading MFSER accessory card in slot 2");
+						if (! add_accessory_card_attributes(2)) {
+							log_error("failed to load MFSER accessory card in slot 2");
+						} else {
+							log_info("successfully loaded MFSER accessory card in slot 2");
+						}
+						break;
 
 					default:
 						log_error("accessory card %s unsupported", ap1_eeprom.product_id);