289 if (current_block == NULL) { |
289 if (current_block == NULL) { |
290 // Anything in the buffer? |
290 // Anything in the buffer? |
291 current_block = plan_get_current_block(); |
291 current_block = plan_get_current_block(); |
292 if (current_block != NULL) { |
292 if (current_block != NULL) { |
293 current_block->busy = true; |
293 current_block->busy = true; |
|
294 |
|
295 if (current_block->laser_on) { |
|
296 WRITE(M571_PIN, HIGH);// Fire the laser! |
|
297 } else { |
|
298 WRITE(M571_PIN, LOW);// Shutdown the laser! |
|
299 } |
|
300 |
294 trapezoid_generator_reset(); |
301 trapezoid_generator_reset(); |
295 counter_x = -(current_block->step_event_count >> 1); |
302 counter_x = -(current_block->step_event_count >> 1); |
296 counter_y = counter_x; |
303 counter_y = counter_x; |
297 counter_z = counter_x; |
304 counter_z = counter_x; |
298 counter_e = counter_x; |
305 counter_e = counter_x; |