123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154 |
-
-
- #ifndef __NOZZLE_H__
- #define __NOZZLE_H__
-
- #include "Marlin.h"
- #include "point_t.h"
-
-
- class Nozzle {
- private:
-
-
- static void stroke(point_t const &start, point_t const &end, uint8_t const &strokes)
- __attribute__ ((optimize ("Os"))) {
-
- #if ENABLED(NOZZLE_CLEAN_PARK)
-
- point_t const initial = {
- current_position[X_AXIS],
- current_position[Y_AXIS],
- current_position[Z_AXIS],
- current_position[E_AXIS]
- };
- #endif
-
-
- do_blocking_move_to_xy(start.x, start.y);
- do_blocking_move_to_z(start.z);
-
-
- for (uint8_t i = 0; i < (strokes >>1); i++) {
- do_blocking_move_to_xy(end.x, end.y);
- do_blocking_move_to_xy(start.x, start.y);
- }
-
- #if ENABLED(NOZZLE_CLEAN_PARK)
-
- do_blocking_move_to_z(initial.z);
- do_blocking_move_to_xy(initial.x, initial.y);
- #endif
- }
-
-
-
- static void zigzag(point_t const &start,
- point_t const &end, uint8_t const &strokes, uint8_t const &objects)
- __attribute__ ((optimize ("Os"))) {
- float A = fabs(end.y - start.y);
- float P = fabs(end.x - start.x) / (objects << 1);
-
-
- if (A <= 0.0f || P <= 0.0f ) return;
-
- #if ENABLED(NOZZLE_CLEAN_PARK)
-
- point_t const initial = {
- current_position[X_AXIS],
- current_position[Y_AXIS],
- current_position[Z_AXIS],
- current_position[E_AXIS]
- };
- #endif
-
- for (uint8_t j = 0; j < strokes; j++) {
- for (uint8_t i = 0; i < (objects << 1); i++) {
- float const x = start.x + i * P;
- float const y = start.y + (A/P) * (P - fabs(fmod((i*P), (2*P)) - P));
-
- do_blocking_move_to_xy(x, y);
- if (i == 0) do_blocking_move_to_z(start.z);
- }
-
- for (int i = (objects << 1); i > -1; i--) {
- float const x = start.x + i * P;
- float const y = start.y + (A/P) * (P - fabs(fmod((i*P), (2*P)) - P));
-
- do_blocking_move_to_xy(x, y);
- }
- }
-
- #if ENABLED(NOZZLE_CLEAN_PARK)
-
- do_blocking_move_to_z(initial.z);
- do_blocking_move_to_xy(initial.x, initial.y);
- #endif
- }
-
- public:
-
-
- static void clean(uint8_t const &pattern,
- uint8_t const &strokes, uint8_t const &objects = 0)
- __attribute__ ((optimize ("Os"))) {
- switch (pattern) {
- case 1:
- Nozzle::zigzag(
- NOZZLE_CLEAN_START_PT,
- NOZZLE_CLEAN_END_PT, strokes, objects);
- break;
-
- default:
- Nozzle::stroke(
- NOZZLE_CLEAN_START_PT,
- NOZZLE_CLEAN_END_PT, strokes);
- }
- }
- };
-
- #endif
|