Fixed for Robot Configuration

Add some code for inverting motors for configuration problems.