Changed code to start with motor 1