Initial motorcontrol software commit