Implement gear shift for "double speed" motor

Support shifting gears via the switches.
Document new switch actions in config.h, too