Removed compiler errors
Stop all motors on exception
Removed debug output