diff --git a/extruder/extruder.c b/extruder/extruder.c
index 4f227d0..3882564 100644
--- a/extruder/extruder.c
+++ b/extruder/extruder.c
@@ -79,12 +79,12 @@ ISR(PCINT0_vect) {
 		else
 			coil_pos--;
 
-		coil_pos &= 31;
+		coil_pos &= 7;
 
 		//Grab the latest motor power to use
 		pwm = motor_pwm;
 
-		switch(coil_pos >> 2) {
+		switch(coil_pos) {
 			case 0:
 			  WRITE(H1D, 0);
 			  WRITE(H2D, 0);