Fix issue that changing mode clears leds setting unexpectedly
Support Two-Headed Kimera (as a variant of Kimera)