Changed to use servo library and detach/attach when changing motors