123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195 |
-
-
- #ifndef __NOZZLE_H__
- #define __NOZZLE_H__
-
- #include "Marlin.h"
- #include "point_t.h"
-
-
- class Nozzle {
- private:
-
-
- static void stroke(
- __attribute__((unused)) point_t const &start,
- __attribute__((unused)) point_t const &end,
- __attribute__((unused)) uint8_t const &strokes
- ) __attribute__((optimize ("Os"))) {
- #if ENABLED(NOZZLE_CLEAN_FEATURE)
-
- #if ENABLED(NOZZLE_CLEAN_GOBACK)
-
- 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_GOBACK)
-
- do_blocking_move_to_z(initial.z);
- do_blocking_move_to_xy(initial.x, initial.y);
- #endif
-
- #endif
- }
-
-
-
- static void zigzag(
- __attribute__((unused)) point_t const &start,
- __attribute__((unused)) point_t const &end,
- __attribute__((unused)) uint8_t const &strokes,
- __attribute__((unused)) uint8_t const &objects
- ) __attribute__((optimize ("Os"))) {
- #if ENABLED(NOZZLE_CLEAN_FEATURE)
- 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_GOBACK)
-
- 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_GOBACK)
-
- do_blocking_move_to_z(initial.z);
- do_blocking_move_to_xy(initial.x, initial.y);
- #endif
-
- #endif
- }
-
- public:
-
-
- static void clean(
- __attribute__((unused)) uint8_t const &pattern,
- __attribute__((unused)) uint8_t const &strokes,
- __attribute__((unused)) uint8_t const &objects = 0
- ) __attribute__((optimize ("Os"))) {
- #if ENABLED(NOZZLE_CLEAN_FEATURE)
- switch (pattern) {
- case 1:
- Nozzle::zigzag(
- NOZZLE_CLEAN_START_POINT,
- NOZZLE_CLEAN_END_POINT, strokes, objects);
- break;
-
- default:
- Nozzle::stroke(
- NOZZLE_CLEAN_START_POINT,
- NOZZLE_CLEAN_END_POINT, strokes);
- }
- #endif
- }
-
- static void park(
- __attribute__((unused)) uint8_t const &z_action
- ) __attribute__((optimize ("Os"))) {
- #if ENABLED(NOZZLE_PARK_FEATURE)
- float const z = current_position[Z_AXIS];
- point_t const park = NOZZLE_PARK_POINT;
-
- switch(z_action) {
- case 1:
- do_blocking_move_to_z(park.z);
- break;
-
- case 2:
- do_blocking_move_to_z(
- (z + park.z > Z_MAX_POS) ? Z_MAX_POS : z + park.z);
- break;
-
- default:
- if (current_position[Z_AXIS] < park.z)
- do_blocking_move_to_z(park.z);
- }
-
- do_blocking_move_to_xy(park.x, park.y);
-
- #endif
- }
- };
-
- #endif
|