Add motor and servo initializations