Bump the driver level

1 files changed, 27 insertions, 0 deletions

diff --git a/io-module/mts_io.c b/io-module/mts_io.c
index 1f12b86..abac4bb 100644
--- a/io-module/mts_io.c
+++ b/io-module/mts_io.c
@@ -1010,6 +1010,33 @@ mts_id_eeprom_load(void)
                     }
                 }
                 
+                /* mtcdt gnss and wifi for future devices.  We assume the same
+                 * pinout as mtcdt on MTR. */
+		if(DEVICE_CAPA(id_eeprom.capa, CAPA_WIFI)) {
+			attr_blength += sizeof mtcdt_0_1_wifi_bt_attributes;
+		}
+		if(DEVICE_CAPA(id_eeprom.capa, CAPA_GPS)) {
+			attr_blength += sizeof mtcdt_0_1_gnss_attributes;
+		}
+                if (current_blength+(sizeof(struct attribute *)) != attr_blength) {
+			freelater = all_attrs = kmalloc(attr_blength,GFP_KERNEL);
+			current_count = current_blength/(sizeof (struct attribute *));
+			memcpy(all_attrs,mtrv1_0_1_platform_attributes,current_blength);
+			if(DEVICE_CAPA(id_eeprom.capa, CAPA_WIFI)) {
+				log_info("Adding WiFi/BT to mts-io driver");
+				memcpy(all_attrs + current_count,mtcdt_0_1_wifi_bt_attributes,sizeof mtcdt_0_1_wifi_bt_attributes);
+				current_count += sizeof mtcdt_0_1_wifi_bt_attributes / (sizeof  (struct attribute *));
+			}
+			if(DEVICE_CAPA(id_eeprom.capa, CAPA_GPS)) {
+				log_info("Adding GPS to mts-io driver");
+				attr_blength += sizeof mtcdt_0_1_gnss_attributes;
+				memcpy(all_attrs + current_count,mtcdt_0_1_gnss_attributes,sizeof mtcdt_0_1_gnss_attributes);
+				current_count += sizeof mtcdt_0_1_gnss_attributes / (sizeof  (struct attribute *));
+			}
+			all_attrs[current_count] = (struct attribute *)NULL;
+			mtrv1_0_1_platform_attribute_group.attrs = all_attrs;
+		}
+            
 		attr_group = &mtrv1_0_1_platform_attribute_group;
 		gpio_pins = gpio_pins_mtrv1_0_1;
 		mts_hw_version = MTRV1_0_1;