Fix constants for when motors wired correctly
Remove debug junk from interrupt handlers