Skip to content

Commit

Permalink
merge followup
Browse files Browse the repository at this point in the history
  • Loading branch information
thinkyhead committed Jul 11, 2022
1 parent 5b853a2 commit 6460b5c
Show file tree
Hide file tree
Showing 5 changed files with 39 additions and 34 deletions.
2 changes: 1 addition & 1 deletion Marlin/src/gcode/bedlevel/G26.cpp
Expand Up @@ -306,7 +306,7 @@ typedef struct {
LIMIT(e.x, X_MIN_POS + 1, X_MAX_POS - 1);
#endif

if (position_is_reachable(s.x, s.y) && position_is_reachable(e.x, e.y))
if (position_is_reachable(s) && position_is_reachable(e))
print_line_from_here_to_there(s, e);
}
}
Expand Down
12 changes: 6 additions & 6 deletions Marlin/src/module/motion.cpp
Expand Up @@ -301,13 +301,13 @@ void report_current_position_projected() {
#endif

#if ENABLED(POLARGRAPH)
bool position_is_reachable(const_float_t rx, const_float_t ry, const float inset/*=0*/) {
const float x1 = rx - (draw_area_min.x), x2 = (draw_area_max.x) - rx, y = ry - (draw_area_max.y),
a = HYPOT(x1, y), b = HYPOT(x2, y);
return a < (polargraph_max_belt_len) + 1
&& b < (polargraph_max_belt_len) + 1
bool position_is_reachable(const_float_t rx, const_float_t ry, const float inset/*=0*/) {
const float x1 = rx - (draw_area_min.x), x2 = (draw_area_max.x) - rx,
y = ry - (draw_area_max.y), a = HYPOT(x1, y), b = HYPOT(x2, y);
return a < polargraph_max_belt_len + 1
&& b < polargraph_max_belt_len + 1
&& (a + b) > _MIN(draw_area_size.x, draw_area_size.y);
}
}
#endif

void home_if_needed(const bool keeplev/*=false*/) {
Expand Down
49 changes: 26 additions & 23 deletions Marlin/src/module/motion.h
Expand Up @@ -549,39 +549,42 @@ void home_if_needed(const bool keeplev=false);
#endif

#if ENABLED(POLARGRAPH)

// Return true if the given point is within the printable area
bool position_is_reachable(const_float_t rx, const_float_t ry, const float inset=0);

#else

// Return true if the given point is within the printable area
inline bool position_is_reachable(const_float_t rx, const_float_t ry, const float inset=0) {
#if ENABLED(DELTA)
inline bool position_is_reachable(const_float_t rx, const_float_t ry, const float inset=0) {
#if ENABLED(DELTA)

return HYPOT2(rx, ry) <= sq(DELTA_PRINTABLE_RADIUS - inset + fslop);
return HYPOT2(rx, ry) <= sq(DELTA_PRINTABLE_RADIUS - inset + fslop);

#elif ENABLED(AXEL_TPARA)
#elif ENABLED(AXEL_TPARA)

const float R2 = HYPOT2(rx - TPARA_OFFSET_X, ry - TPARA_OFFSET_Y);
return (
R2 <= sq(L1 + L2) - inset
#if MIDDLE_DEAD_ZONE_R > 0
&& R2 >= sq(float(MIDDLE_DEAD_ZONE_R))
#endif
);
const float R2 = HYPOT2(rx - TPARA_OFFSET_X, ry - TPARA_OFFSET_Y);
return (
R2 <= sq(L1 + L2) - inset
#if MIDDLE_DEAD_ZONE_R > 0
&& R2 >= sq(float(MIDDLE_DEAD_ZONE_R))
#endif
);

#elif IS_SCARA
#elif IS_SCARA

const float R2 = HYPOT2(rx - SCARA_OFFSET_X, ry - SCARA_OFFSET_Y);
return (
R2 <= sq(L1 + L2) - inset
#if MIDDLE_DEAD_ZONE_R > 0
&& R2 >= sq(float(MIDDLE_DEAD_ZONE_R))
#endif
);
const float R2 = HYPOT2(rx - SCARA_OFFSET_X, ry - SCARA_OFFSET_Y);
return (
R2 <= sq(L1 + L2) - inset
#if MIDDLE_DEAD_ZONE_R > 0
&& R2 >= sq(float(MIDDLE_DEAD_ZONE_R))
#endif
);

#endif
}

#endif
}
#endif

inline bool position_is_reachable(const xy_pos_t &pos, const float inset=0) {
return position_is_reachable(pos.x, pos.y, inset);
}
Expand Down
7 changes: 5 additions & 2 deletions Marlin/src/module/polargraph.cpp
Expand Up @@ -38,9 +38,12 @@
#include "../MarlinCore.h"

float segments_per_second; // Initialized by settings.load()
xy_pos_t draw_area_min = { X_MIN_POS, Y_MIN_POS };
xy_pos_t draw_area_max = { X_MAX_POS, Y_MAX_POS };

xy_pos_t draw_area_min = { X_MIN_POS, Y_MIN_POS },
draw_area_max = { X_MAX_POS, Y_MAX_POS };

xy_float_t draw_area_size = { X_MAX_POS - X_MIN_POS, Y_MAX_POS - Y_MIN_POS };

float polargraph_max_belt_len = HYPOT(draw_area_size.x, draw_area_size.y);

void inverse_kinematics(const xyz_pos_t &raw) {
Expand Down
3 changes: 1 addition & 2 deletions Marlin/src/module/polargraph.h
Expand Up @@ -29,8 +29,7 @@
#include "../core/macros.h"

extern float segments_per_second;
extern xy_pos_t draw_area_min;
extern xy_pos_t draw_area_max;
extern xy_pos_t draw_area_min, draw_area_max;
extern xy_float_t draw_area_size;
extern float polargraph_max_belt_len;

Expand Down

0 comments on commit 6460b5c

Please sign in to comment.