- make motorctl compatible with different drivers - pass set function instead of specific motor object - add lambda function in config.cpp - update config to use one new sabertooth driver instead of two single100a - main test controlled motor