Motor Controller: Fixed bug with I reset.
Fixed wall brain for testing.