diff -r 2c8ba1964db7 -r b584642d4f58 stepper.cpp --- a/stepper.cpp Sat Nov 07 13:23:07 2015 +0100 +++ b/stepper.cpp Sat Nov 07 13:24:46 2015 +0100 @@ -291,6 +291,13 @@ current_block = plan_get_current_block(); if (current_block != NULL) { current_block->busy = true; + + if (current_block->laser_on) { + WRITE(M571_PIN, HIGH);// Fire the laser! + } else { + WRITE(M571_PIN, LOW);// Shutdown the laser! + } + trapezoid_generator_reset(); counter_x = -(current_block->step_event_count >> 1); counter_y = counter_x;