Rebased onto super-abstracted msp

src/main/main.c

@@ -88,6 +88,7 @@
 #include "io/transponder_ir.h"
 #include "io/osd.h"
 #include "io/vtx.h"
+#include "io/cms.h"
 
 #include "scheduler/scheduler.h"
 
@@ -424,6 +425,10 @@ void init(void)
     }
 #endif
 
+#ifdef CMS
+    cmsInit();
+#endif
+
     if (!sensorsAutodetect(&masterConfig.sensorAlignmentConfig,
             masterConfig.acc_hardware,
             masterConfig.mag_hardware,