Merge pull request #7128 from thinkyhead/bf_enhanced_arcs
Enhance G2/G3 with 'P' and G17/G18/G19 Plane Select
This commit is contained in:
commit
ebe6719e12
|
@ -72,14 +72,14 @@ script:
|
||||||
- build_marlin
|
- build_marlin
|
||||||
#
|
#
|
||||||
# Test 2 extruders (one MAX6675) and heated bed on basic RAMPS 1.4
|
# Test 2 extruders (one MAX6675) and heated bed on basic RAMPS 1.4
|
||||||
# plus a "Fix Mounted" Probe with Safe Homing
|
# plus a "Fix Mounted" Probe with Safe Homing and some arc options
|
||||||
#
|
#
|
||||||
- opt_set MOTHERBOARD BOARD_RAMPS_14_EEB
|
- opt_set MOTHERBOARD BOARD_RAMPS_14_EEB
|
||||||
- opt_set EXTRUDERS 2
|
- opt_set EXTRUDERS 2
|
||||||
- opt_set TEMP_SENSOR_0 -2
|
- opt_set TEMP_SENSOR_0 -2
|
||||||
- opt_set TEMP_SENSOR_1 1
|
- opt_set TEMP_SENSOR_1 1
|
||||||
- opt_set TEMP_SENSOR_BED 1
|
- opt_set TEMP_SENSOR_BED 1
|
||||||
- opt_enable PIDTEMPBED FIX_MOUNTED_PROBE Z_SAFE_HOMING
|
- opt_enable PIDTEMPBED FIX_MOUNTED_PROBE Z_SAFE_HOMING ARC_P_CIRCLES CNC_WORKSPACE_PLANES
|
||||||
- build_marlin
|
- build_marlin
|
||||||
#
|
#
|
||||||
# ...with AUTO_BED_LEVELING_LINEAR, Z_MIN_PROBE_REPEATABILITY_TEST, and DEBUG_LEVELING_FEATURE
|
# ...with AUTO_BED_LEVELING_LINEAR, Z_MIN_PROBE_REPEATABILITY_TEST, and DEBUG_LEVELING_FEATURE
|
||||||
|
|
|
@ -108,6 +108,9 @@
|
||||||
|
|
||||||
#if ENABLED(REPRAPWORLD_KEYPAD)
|
#if ENABLED(REPRAPWORLD_KEYPAD)
|
||||||
#define NEWPANEL
|
#define NEWPANEL
|
||||||
|
#if ENABLED(ULTIPANEL) && !defined(REPRAPWORLD_KEYPAD_MOVE_STEP)
|
||||||
|
#define REPRAPWORLD_KEYPAD_MOVE_STEP 1.0
|
||||||
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(RA_CONTROL_PANEL)
|
#if ENABLED(RA_CONTROL_PANEL)
|
||||||
|
|
|
@ -678,10 +678,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -370,9 +370,9 @@ extern float soft_endstop_min[XYZ], soft_endstop_max[XYZ];
|
||||||
extern bool filament_sensor; // Flag that filament sensor readings should control extrusion
|
extern bool filament_sensor; // Flag that filament sensor readings should control extrusion
|
||||||
extern float filament_width_nominal, // Theoretical filament diameter i.e., 3.00 or 1.75
|
extern float filament_width_nominal, // Theoretical filament diameter i.e., 3.00 or 1.75
|
||||||
filament_width_meas; // Measured filament diameter
|
filament_width_meas; // Measured filament diameter
|
||||||
extern int8_t measurement_delay[]; // Ring buffer to delay measurement
|
extern uint8_t meas_delay_cm, // Delay distance
|
||||||
extern int filwidth_delay_index[2]; // Ring buffer indexes. Used by planner, temperature, and main code
|
measurement_delay[]; // Ring buffer to delay measurement
|
||||||
extern int meas_delay_cm; // Delay distance
|
extern int8_t filwidth_delay_index[2]; // Ring buffer indexes. Used by planner, temperature, and main code
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(ADVANCED_PAUSE_FEATURE)
|
#if ENABLED(ADVANCED_PAUSE_FEATURE)
|
||||||
|
|
|
@ -54,6 +54,9 @@
|
||||||
* G10 - Retract filament according to settings of M207
|
* G10 - Retract filament according to settings of M207
|
||||||
* G11 - Retract recover filament according to settings of M208
|
* G11 - Retract recover filament according to settings of M208
|
||||||
* G12 - Clean tool
|
* G12 - Clean tool
|
||||||
|
* G17 - Select Plane XY (Requires CNC_WORKSPACE_PLANES)
|
||||||
|
* G18 - Select Plane ZX (Requires CNC_WORKSPACE_PLANES)
|
||||||
|
* G19 - Select Plane YZ (Requires CNC_WORKSPACE_PLANES)
|
||||||
* G20 - Set input units to inches
|
* G20 - Set input units to inches
|
||||||
* G21 - Set input units to millimeters
|
* G21 - Set input units to millimeters
|
||||||
* G26 - Mesh Validation Pattern (Requires UBL_G26_MESH_VALIDATION)
|
* G26 - Mesh Validation Pattern (Requires UBL_G26_MESH_VALIDATION)
|
||||||
|
@ -73,7 +76,7 @@
|
||||||
* "M" Codes
|
* "M" Codes
|
||||||
*
|
*
|
||||||
* M0 - Unconditional stop - Wait for user to press a button on the LCD (Only if ULTRA_LCD is enabled)
|
* M0 - Unconditional stop - Wait for user to press a button on the LCD (Only if ULTRA_LCD is enabled)
|
||||||
* M1 - Same as M0
|
* M1 -> M0
|
||||||
* M3 - Turn laser/spindle on, set spindle/laser speed/power, set rotation to clockwise
|
* M3 - Turn laser/spindle on, set spindle/laser speed/power, set rotation to clockwise
|
||||||
* M4 - Turn laser/spindle on, set spindle/laser speed/power, set rotation to counter-clockwise
|
* M4 - Turn laser/spindle on, set spindle/laser speed/power, set rotation to counter-clockwise
|
||||||
* M5 - Turn laser/spindle off
|
* M5 - Turn laser/spindle off
|
||||||
|
@ -630,9 +633,9 @@ float cartes[XYZ] = { 0 };
|
||||||
bool filament_sensor = false; // M405 turns on filament sensor control. M406 turns it off.
|
bool filament_sensor = false; // M405 turns on filament sensor control. M406 turns it off.
|
||||||
float filament_width_nominal = DEFAULT_NOMINAL_FILAMENT_DIA, // Nominal filament width. Change with M404.
|
float filament_width_nominal = DEFAULT_NOMINAL_FILAMENT_DIA, // Nominal filament width. Change with M404.
|
||||||
filament_width_meas = DEFAULT_MEASURED_FILAMENT_DIA; // Measured filament diameter
|
filament_width_meas = DEFAULT_MEASURED_FILAMENT_DIA; // Measured filament diameter
|
||||||
int8_t measurement_delay[MAX_MEASUREMENT_DELAY + 1]; // Ring buffer to delayed measurement. Store extruder factor after subtracting 100
|
uint8_t meas_delay_cm = MEASUREMENT_DELAY_CM, // Distance delay setting
|
||||||
int filwidth_delay_index[2] = { 0, -1 }; // Indexes into ring buffer
|
measurement_delay[MAX_MEASUREMENT_DELAY + 1]; // Ring buffer to delayed measurement. Store extruder factor after subtracting 100
|
||||||
int meas_delay_cm = MEASUREMENT_DELAY_CM; // Distance delay setting
|
int8_t filwidth_delay_index[2] = { 0, -1 }; // Indexes into ring buffer
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(FILAMENT_RUNOUT_SENSOR)
|
#if ENABLED(FILAMENT_RUNOUT_SENSOR)
|
||||||
|
@ -688,6 +691,10 @@ static bool send_ok[BUFSIZE];
|
||||||
millis_t lastUpdateMillis;
|
millis_t lastUpdateMillis;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
static WorkspacePlane workspace_plane = PLANE_XY;
|
||||||
|
#endif
|
||||||
|
|
||||||
FORCE_INLINE float pgm_read_any(const float *p) { return pgm_read_float_near(p); }
|
FORCE_INLINE float pgm_read_any(const float *p) { return pgm_read_float_near(p); }
|
||||||
FORCE_INLINE signed char pgm_read_any(const signed char *p) { return pgm_read_byte_near(p); }
|
FORCE_INLINE signed char pgm_read_any(const signed char *p) { return pgm_read_byte_near(p); }
|
||||||
|
|
||||||
|
@ -3264,12 +3271,16 @@ inline void gcode_G0_G1(
|
||||||
* X or Y must differ from the current XY.
|
* X or Y must differ from the current XY.
|
||||||
* Mixing R with I or J will throw an error.
|
* Mixing R with I or J will throw an error.
|
||||||
*
|
*
|
||||||
|
* - P specifies the number of full circles to do
|
||||||
|
* before the specified arc move.
|
||||||
|
*
|
||||||
* Examples:
|
* Examples:
|
||||||
*
|
*
|
||||||
* G2 I10 ; CW circle centered at X+10
|
* G2 I10 ; CW circle centered at X+10
|
||||||
* G3 X20 Y12 R14 ; CCW circle with r=14 ending at X20 Y12
|
* G3 X20 Y12 R14 ; CCW circle with r=14 ending at X20 Y12
|
||||||
*/
|
*/
|
||||||
#if ENABLED(ARC_SUPPORT)
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
|
||||||
inline void gcode_G2_G3(bool clockwise) {
|
inline void gcode_G2_G3(bool clockwise) {
|
||||||
if (IsRunning()) {
|
if (IsRunning()) {
|
||||||
|
|
||||||
|
@ -3287,27 +3298,39 @@ inline void gcode_G0_G1(
|
||||||
float arc_offset[2] = { 0.0, 0.0 };
|
float arc_offset[2] = { 0.0, 0.0 };
|
||||||
if (parser.seen('R')) {
|
if (parser.seen('R')) {
|
||||||
const float r = parser.value_linear_units(),
|
const float r = parser.value_linear_units(),
|
||||||
x1 = current_position[X_AXIS], y1 = current_position[Y_AXIS],
|
p1 = current_position[X_AXIS], q1 = current_position[Y_AXIS],
|
||||||
x2 = destination[X_AXIS], y2 = destination[Y_AXIS];
|
p2 = destination[X_AXIS], q2 = destination[Y_AXIS];
|
||||||
if (r && (x2 != x1 || y2 != y1)) {
|
if (r && (p2 != p1 || q2 != q1)) {
|
||||||
const float e = clockwise ^ (r < 0) ? -1 : 1, // clockwise -1/1, counterclockwise 1/-1
|
const float e = clockwise ^ (r < 0) ? -1 : 1, // clockwise -1/1, counterclockwise 1/-1
|
||||||
dx = x2 - x1, dy = y2 - y1, // X and Y differences
|
dx = p2 - p1, dy = q2 - q1, // X and Y differences
|
||||||
d = HYPOT(dx, dy), // Linear distance between the points
|
d = HYPOT(dx, dy), // Linear distance between the points
|
||||||
h = SQRT(sq(r) - sq(d * 0.5)), // Distance to the arc pivot-point
|
h = SQRT(sq(r) - sq(d * 0.5)), // Distance to the arc pivot-point
|
||||||
mx = (x1 + x2) * 0.5, my = (y1 + y2) * 0.5, // Point between the two points
|
mx = (p1 + p2) * 0.5, my = (q1 + q2) * 0.5, // Point between the two points
|
||||||
sx = -dy / d, sy = dx / d, // Slope of the perpendicular bisector
|
sx = -dy / d, sy = dx / d, // Slope of the perpendicular bisector
|
||||||
cx = mx + e * h * sx, cy = my + e * h * sy; // Pivot-point of the arc
|
cx = mx + e * h * sx, cy = my + e * h * sy; // Pivot-point of the arc
|
||||||
arc_offset[X_AXIS] = cx - x1;
|
arc_offset[0] = cx - p1;
|
||||||
arc_offset[Y_AXIS] = cy - y1;
|
arc_offset[1] = cy - q1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
if (parser.seen('I')) arc_offset[X_AXIS] = parser.value_linear_units();
|
if (parser.seen('I')) arc_offset[0] = parser.value_linear_units();
|
||||||
if (parser.seen('J')) arc_offset[Y_AXIS] = parser.value_linear_units();
|
if (parser.seen('J')) arc_offset[1] = parser.value_linear_units();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (arc_offset[0] || arc_offset[1]) {
|
if (arc_offset[0] || arc_offset[1]) {
|
||||||
// Send an arc to the planner
|
|
||||||
|
#if ENABLED(ARC_P_CIRCLES)
|
||||||
|
// P indicates number of circles to do
|
||||||
|
int8_t circles_to_do = parser.seen('P') ? parser.value_byte() : 0;
|
||||||
|
if (!WITHIN(circles_to_do, 0, 100)) {
|
||||||
|
SERIAL_ERROR_START();
|
||||||
|
SERIAL_ERRORLNPGM(MSG_ERR_ARC_ARGS);
|
||||||
|
}
|
||||||
|
while (circles_to_do--)
|
||||||
|
plan_arc(current_position, arc_offset, clockwise);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
// Send the arc to the planner
|
||||||
plan_arc(destination, arc_offset, clockwise);
|
plan_arc(destination, arc_offset, clockwise);
|
||||||
refresh_cmd_timeout();
|
refresh_cmd_timeout();
|
||||||
}
|
}
|
||||||
|
@ -3318,7 +3341,8 @@ inline void gcode_G0_G1(
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
|
#endif // ARC_SUPPORT
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* G4: Dwell S<seconds> or P<milliseconds>
|
* G4: Dwell S<seconds> or P<milliseconds>
|
||||||
|
@ -3406,6 +3430,25 @@ inline void gcode_G4() {
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
|
||||||
|
void report_workspace_plane() {
|
||||||
|
SERIAL_ECHO_START();
|
||||||
|
SERIAL_ECHOPGM("Workspace Plane ");
|
||||||
|
serialprintPGM(workspace_plane == PLANE_YZ ? PSTR("YZ\n") : workspace_plane == PLANE_ZX ? PSTR("ZX\n") : PSTR("XY\n"));
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* G17: Select Plane XY
|
||||||
|
* G18: Select Plane ZX
|
||||||
|
* G19: Select Plane YZ
|
||||||
|
*/
|
||||||
|
inline void gcode_G17() { workspace_plane = PLANE_XY; }
|
||||||
|
inline void gcode_G18() { workspace_plane = PLANE_ZX; }
|
||||||
|
inline void gcode_G19() { workspace_plane = PLANE_YZ; }
|
||||||
|
|
||||||
|
#endif // CNC_WORKSPACE_PLANES
|
||||||
|
|
||||||
#if ENABLED(INCH_MODE_SUPPORT)
|
#if ENABLED(INCH_MODE_SUPPORT)
|
||||||
/**
|
/**
|
||||||
* G20: Set input mode to inches
|
* G20: Set input mode to inches
|
||||||
|
@ -3720,6 +3763,10 @@ inline void gcode_G28(const bool always_home_all) {
|
||||||
set_bed_leveling_enabled(false);
|
set_bed_leveling_enabled(false);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
workspace_plane = PLANE_XY;
|
||||||
|
#endif
|
||||||
|
|
||||||
// Always home with tool 0 active
|
// Always home with tool 0 active
|
||||||
#if HOTENDS > 1
|
#if HOTENDS > 1
|
||||||
const uint8_t old_tool_index = active_extruder;
|
const uint8_t old_tool_index = active_extruder;
|
||||||
|
@ -8898,11 +8945,11 @@ inline void gcode_M400() { stepper.synchronize(); }
|
||||||
inline void gcode_M405() {
|
inline void gcode_M405() {
|
||||||
// This is technically a linear measurement, but since it's quantized to centimeters and is a different unit than
|
// This is technically a linear measurement, but since it's quantized to centimeters and is a different unit than
|
||||||
// everything else, it uses parser.value_int() instead of parser.value_linear_units().
|
// everything else, it uses parser.value_int() instead of parser.value_linear_units().
|
||||||
if (parser.seen('D')) meas_delay_cm = parser.value_int();
|
if (parser.seen('D')) meas_delay_cm = parser.value_byte();
|
||||||
NOMORE(meas_delay_cm, MAX_MEASUREMENT_DELAY);
|
NOMORE(meas_delay_cm, MAX_MEASUREMENT_DELAY);
|
||||||
|
|
||||||
if (filwidth_delay_index[1] == -1) { // Initialize the ring buffer if not done since startup
|
if (filwidth_delay_index[1] == -1) { // Initialize the ring buffer if not done since startup
|
||||||
const int temp_ratio = thermalManager.widthFil_to_size_ratio() - 100; // -100 to scale within a signed byte
|
const uint8_t temp_ratio = thermalManager.widthFil_to_size_ratio() - 100; // -100 to scale within a signed byte
|
||||||
|
|
||||||
for (uint8_t i = 0; i < COUNT(measurement_delay); ++i)
|
for (uint8_t i = 0; i < COUNT(measurement_delay); ++i)
|
||||||
measurement_delay[i] = temp_ratio;
|
measurement_delay[i] = temp_ratio;
|
||||||
|
@ -10309,6 +10356,18 @@ void process_next_command() {
|
||||||
break;
|
break;
|
||||||
#endif // NOZZLE_CLEAN_FEATURE
|
#endif // NOZZLE_CLEAN_FEATURE
|
||||||
|
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
case 17: // G17: Select Plane XY
|
||||||
|
gcode_G17();
|
||||||
|
break;
|
||||||
|
case 18: // G18: Select Plane ZX
|
||||||
|
gcode_G18();
|
||||||
|
break;
|
||||||
|
case 19: // G19: Select Plane YZ
|
||||||
|
gcode_G19();
|
||||||
|
break;
|
||||||
|
#endif // CNC_WORKSPACE_PLANES
|
||||||
|
|
||||||
#if ENABLED(INCH_MODE_SUPPORT)
|
#if ENABLED(INCH_MODE_SUPPORT)
|
||||||
case 20: //G20: Inch Mode
|
case 20: //G20: Inch Mode
|
||||||
gcode_G20();
|
gcode_G20();
|
||||||
|
@ -11920,6 +11979,12 @@ void prepare_move_to_destination() {
|
||||||
}
|
}
|
||||||
|
|
||||||
#if ENABLED(ARC_SUPPORT)
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
|
||||||
|
#if N_ARC_CORRECTION < 1
|
||||||
|
#undef N_ARC_CORRECTION
|
||||||
|
#define N_ARC_CORRECTION 1
|
||||||
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Plan an arc in 2 dimensions
|
* Plan an arc in 2 dimensions
|
||||||
*
|
*
|
||||||
|
@ -11934,26 +11999,36 @@ void prepare_move_to_destination() {
|
||||||
float *offset, // Center of rotation relative to current_position
|
float *offset, // Center of rotation relative to current_position
|
||||||
uint8_t clockwise // Clockwise?
|
uint8_t clockwise // Clockwise?
|
||||||
) {
|
) {
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
AxisEnum p_axis, q_axis, l_axis;
|
||||||
|
switch (workspace_plane) {
|
||||||
|
case PLANE_XY: p_axis = X_AXIS; q_axis = Y_AXIS; l_axis = Z_AXIS; break;
|
||||||
|
case PLANE_ZX: p_axis = Z_AXIS; q_axis = X_AXIS; l_axis = Y_AXIS; break;
|
||||||
|
case PLANE_YZ: p_axis = Y_AXIS; q_axis = Z_AXIS; l_axis = X_AXIS; break;
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
constexpr AxisEnum p_axis = X_AXIS, q_axis = Y_AXIS, l_axis = Z_AXIS;
|
||||||
|
#endif
|
||||||
|
|
||||||
float r_X = -offset[X_AXIS], // Radius vector from center to current location
|
// Radius vector from center to current location
|
||||||
r_Y = -offset[Y_AXIS];
|
float r_P = -offset[0], r_Q = -offset[1];
|
||||||
|
|
||||||
const float radius = HYPOT(r_X, r_Y),
|
const float radius = HYPOT(r_P, r_Q),
|
||||||
center_X = current_position[X_AXIS] - r_X,
|
center_P = current_position[p_axis] - r_P,
|
||||||
center_Y = current_position[Y_AXIS] - r_Y,
|
center_Q = current_position[q_axis] - r_Q,
|
||||||
rt_X = logical[X_AXIS] - center_X,
|
rt_X = logical[p_axis] - center_P,
|
||||||
rt_Y = logical[Y_AXIS] - center_Y,
|
rt_Y = logical[q_axis] - center_Q,
|
||||||
linear_travel = logical[Z_AXIS] - current_position[Z_AXIS],
|
linear_travel = logical[l_axis] - current_position[l_axis],
|
||||||
extruder_travel = logical[E_AXIS] - current_position[E_AXIS];
|
extruder_travel = logical[E_AXIS] - current_position[E_AXIS];
|
||||||
|
|
||||||
// CCW angle of rotation between position and target from the circle center. Only one atan2() trig computation required.
|
// CCW angle of rotation between position and target from the circle center. Only one atan2() trig computation required.
|
||||||
float angular_travel = ATAN2(r_X * rt_Y - r_Y * rt_X, r_X * rt_X + r_Y * rt_Y);
|
float angular_travel = ATAN2(r_P * rt_Y - r_Q * rt_X, r_P * rt_X + r_Q * rt_Y);
|
||||||
if (angular_travel < 0) angular_travel += RADIANS(360);
|
if (angular_travel < 0) angular_travel += RADIANS(360);
|
||||||
if (clockwise) angular_travel -= RADIANS(360);
|
if (clockwise) angular_travel -= RADIANS(360);
|
||||||
|
|
||||||
// Make a circle if the angular rotation is 0
|
// Make a circle if the angular rotation is 0 and the target is current position
|
||||||
if (angular_travel == 0 && current_position[X_AXIS] == logical[X_AXIS] && current_position[Y_AXIS] == logical[Y_AXIS])
|
if (angular_travel == 0 && current_position[p_axis] == logical[p_axis] && current_position[q_axis] == logical[q_axis])
|
||||||
angular_travel += RADIANS(360);
|
angular_travel = RADIANS(360);
|
||||||
|
|
||||||
const float mm_of_travel = HYPOT(angular_travel * radius, FABS(linear_travel));
|
const float mm_of_travel = HYPOT(angular_travel * radius, FABS(linear_travel));
|
||||||
if (mm_of_travel < 0.001) return;
|
if (mm_of_travel < 0.001) return;
|
||||||
|
@ -11996,7 +12071,7 @@ void prepare_move_to_destination() {
|
||||||
cos_T = 1 - 0.5 * sq(theta_per_segment); // Small angle approximation
|
cos_T = 1 - 0.5 * sq(theta_per_segment); // Small angle approximation
|
||||||
|
|
||||||
// Initialize the linear axis
|
// Initialize the linear axis
|
||||||
arc_target[Z_AXIS] = current_position[Z_AXIS];
|
arc_target[l_axis] = current_position[l_axis];
|
||||||
|
|
||||||
// Initialize the extruder axis
|
// Initialize the extruder axis
|
||||||
arc_target[E_AXIS] = current_position[E_AXIS];
|
arc_target[E_AXIS] = current_position[E_AXIS];
|
||||||
|
@ -12005,7 +12080,10 @@ void prepare_move_to_destination() {
|
||||||
|
|
||||||
millis_t next_idle_ms = millis() + 200UL;
|
millis_t next_idle_ms = millis() + 200UL;
|
||||||
|
|
||||||
int8_t count = 0;
|
#if N_ARC_CORRECTION > 1
|
||||||
|
int8_t count = N_ARC_CORRECTION;
|
||||||
|
#endif
|
||||||
|
|
||||||
for (uint16_t i = 1; i < segments; i++) { // Iterate (segments-1) times
|
for (uint16_t i = 1; i < segments; i++) { // Iterate (segments-1) times
|
||||||
|
|
||||||
thermalManager.manage_heater();
|
thermalManager.manage_heater();
|
||||||
|
@ -12014,28 +12092,33 @@ void prepare_move_to_destination() {
|
||||||
idle();
|
idle();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (++count < N_ARC_CORRECTION) {
|
#if N_ARC_CORRECTION > 1
|
||||||
// Apply vector rotation matrix to previous r_X / 1
|
if (--count) {
|
||||||
const float r_new_Y = r_X * sin_T + r_Y * cos_T;
|
// Apply vector rotation matrix to previous r_P / 1
|
||||||
r_X = r_X * cos_T - r_Y * sin_T;
|
const float r_new_Y = r_P * sin_T + r_Q * cos_T;
|
||||||
r_Y = r_new_Y;
|
r_P = r_P * cos_T - r_Q * sin_T;
|
||||||
}
|
r_Q = r_new_Y;
|
||||||
else {
|
}
|
||||||
|
else
|
||||||
|
#endif
|
||||||
|
{
|
||||||
|
#if N_ARC_CORRECTION > 1
|
||||||
|
count = N_ARC_CORRECTION;
|
||||||
|
#endif
|
||||||
|
|
||||||
// Arc correction to radius vector. Computed only every N_ARC_CORRECTION increments.
|
// Arc correction to radius vector. Computed only every N_ARC_CORRECTION increments.
|
||||||
// Compute exact location by applying transformation matrix from initial radius vector(=-offset).
|
// Compute exact location by applying transformation matrix from initial radius vector(=-offset).
|
||||||
// To reduce stuttering, the sin and cos could be computed at different times.
|
// To reduce stuttering, the sin and cos could be computed at different times.
|
||||||
// For now, compute both at the same time.
|
// For now, compute both at the same time.
|
||||||
const float cos_Ti = cos(i * theta_per_segment),
|
const float cos_Ti = cos(i * theta_per_segment), sin_Ti = sin(i * theta_per_segment);
|
||||||
sin_Ti = sin(i * theta_per_segment);
|
r_P = -offset[0] * cos_Ti + offset[1] * sin_Ti;
|
||||||
r_X = -offset[X_AXIS] * cos_Ti + offset[Y_AXIS] * sin_Ti;
|
r_Q = -offset[0] * sin_Ti - offset[1] * cos_Ti;
|
||||||
r_Y = -offset[X_AXIS] * sin_Ti - offset[Y_AXIS] * cos_Ti;
|
|
||||||
count = 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Update arc_target location
|
// Update arc_target location
|
||||||
arc_target[X_AXIS] = center_X + r_X;
|
arc_target[p_axis] = center_P + r_P;
|
||||||
arc_target[Y_AXIS] = center_Y + r_Y;
|
arc_target[q_axis] = center_Q + r_Q;
|
||||||
arc_target[Z_AXIS] += linear_per_segment;
|
arc_target[l_axis] += linear_per_segment;
|
||||||
arc_target[E_AXIS] += extruder_per_segment;
|
arc_target[E_AXIS] += extruder_per_segment;
|
||||||
|
|
||||||
clamp_to_software_endstops(arc_target);
|
clamp_to_software_endstops(arc_target);
|
||||||
|
@ -12201,7 +12284,7 @@ void prepare_move_to_destination() {
|
||||||
#endif
|
#endif
|
||||||
HOTEND_LOOP()
|
HOTEND_LOOP()
|
||||||
max_temp = MAX3(max_temp, thermalManager.degHotend(e), thermalManager.degTargetHotend(e));
|
max_temp = MAX3(max_temp, thermalManager.degHotend(e), thermalManager.degTargetHotend(e));
|
||||||
bool new_led = (max_temp > 55.0) ? true : (max_temp < 54.0) ? false : red_led;
|
const bool new_led = (max_temp > 55.0) ? true : (max_temp < 54.0) ? false : red_led;
|
||||||
if (new_led != red_led) {
|
if (new_led != red_led) {
|
||||||
red_led = new_led;
|
red_led = new_led;
|
||||||
#if PIN_EXISTS(STAT_LED_RED)
|
#if PIN_EXISTS(STAT_LED_RED)
|
||||||
|
|
|
@ -167,12 +167,23 @@ enum LCDViewAction {
|
||||||
LCDVIEW_CALL_NO_REDRAW
|
LCDVIEW_CALL_NO_REDRAW
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Dual X Carriage modes. A Dual Nozzle can also do duplication.
|
||||||
|
*/
|
||||||
#if ENABLED(DUAL_X_CARRIAGE) || ENABLED(DUAL_NOZZLE_DUPLICATION_MODE)
|
#if ENABLED(DUAL_X_CARRIAGE) || ENABLED(DUAL_NOZZLE_DUPLICATION_MODE)
|
||||||
enum DualXMode {
|
enum DualXMode {
|
||||||
DXC_FULL_CONTROL_MODE,
|
DXC_FULL_CONTROL_MODE, // DUAL_X_CARRIAGE only
|
||||||
DXC_AUTO_PARK_MODE,
|
DXC_AUTO_PARK_MODE, // DUAL_X_CARRIAGE only
|
||||||
DXC_DUPLICATION_MODE
|
DXC_DUPLICATION_MODE
|
||||||
};
|
};
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Workspace planes only apply to G2/G3 moves
|
||||||
|
* (and "canned cycles" - not a current feature)
|
||||||
|
*/
|
||||||
|
#if ENABLED(CNC_WORKSPACE_PLANES)
|
||||||
|
enum WorkspacePlane { PLANE_XY, PLANE_ZX, PLANE_YZ };
|
||||||
|
#endif
|
||||||
|
|
||||||
#endif // __ENUM_H__
|
#endif // __ENUM_H__
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -678,10 +678,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -654,10 +654,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -684,10 +684,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -678,10 +678,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -674,10 +674,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -676,10 +676,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -676,10 +676,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -673,10 +673,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -673,10 +673,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -678,10 +678,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -673,10 +673,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -678,10 +678,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -671,10 +671,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -674,10 +674,16 @@
|
||||||
|
|
||||||
// @section extras
|
// @section extras
|
||||||
|
|
||||||
// Arc interpretation settings:
|
//
|
||||||
#define ARC_SUPPORT // Disabling this saves ~2738 bytes
|
// G2/G3 Arc Support
|
||||||
#define MM_PER_ARC_SEGMENT 1
|
//
|
||||||
#define N_ARC_CORRECTION 25
|
#define ARC_SUPPORT // Disable this feature to save ~3226 bytes
|
||||||
|
#if ENABLED(ARC_SUPPORT)
|
||||||
|
#define MM_PER_ARC_SEGMENT 1 // Length of each arc segment
|
||||||
|
#define N_ARC_CORRECTION 25 // Number of intertpolated segments between corrections
|
||||||
|
//#define ARC_P_CIRCLES // Enable the 'P' parameter to specify complete circles
|
||||||
|
//#define CNC_WORKSPACE_PLANES // Allow G2/G3 to operate in XY, ZX, or YZ planes
|
||||||
|
#endif
|
||||||
|
|
||||||
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
// Support for G5 with XYZE destination and IJPQ offsets. Requires ~2666 bytes.
|
||||||
//#define BEZIER_CURVE_SUPPORT
|
//#define BEZIER_CURVE_SUPPORT
|
||||||
|
|
|
@ -41,7 +41,7 @@ bool endstop_monitor_flag = false;
|
||||||
|
|
||||||
// first pass - put the name strings into FLASH
|
// first pass - put the name strings into FLASH
|
||||||
|
|
||||||
#define _ADD_PIN_2(PIN_NAME, ENTRY_NAME) static const unsigned char ENTRY_NAME[] PROGMEM = { PIN_NAME };
|
#define _ADD_PIN_2(PIN_NAME, ENTRY_NAME) static const char ENTRY_NAME[] PROGMEM = { PIN_NAME };
|
||||||
#define _ADD_PIN(PIN_NAME, COUNTER) _ADD_PIN_2(PIN_NAME, entry_NAME_##COUNTER)
|
#define _ADD_PIN(PIN_NAME, COUNTER) _ADD_PIN_2(PIN_NAME, entry_NAME_##COUNTER)
|
||||||
#define REPORT_NAME_DIGITAL(NAME, COUNTER) _ADD_PIN(#NAME, COUNTER)
|
#define REPORT_NAME_DIGITAL(NAME, COUNTER) _ADD_PIN(#NAME, COUNTER)
|
||||||
#define REPORT_NAME_ANALOG(NAME, COUNTER) _ADD_PIN(#NAME, COUNTER)
|
#define REPORT_NAME_ANALOG(NAME, COUNTER) _ADD_PIN(#NAME, COUNTER)
|
||||||
|
@ -64,12 +64,18 @@ bool endstop_monitor_flag = false;
|
||||||
#undef REPORT_NAME_DIGITAL
|
#undef REPORT_NAME_DIGITAL
|
||||||
#undef REPORT_NAME_ANALOG
|
#undef REPORT_NAME_ANALOG
|
||||||
|
|
||||||
#define _ADD_PIN_2(ENTRY_NAME, NAME, IS_DIGITAL) { (const char*)ENTRY_NAME, (const char*)NAME, (const char*)IS_DIGITAL },
|
#define _ADD_PIN_2(ENTRY_NAME, NAME, IS_DIGITAL) { ENTRY_NAME, NAME, IS_DIGITAL },
|
||||||
#define _ADD_PIN(NAME, COUNTER, IS_DIGITAL) _ADD_PIN_2(entry_NAME_##COUNTER, NAME, IS_DIGITAL)
|
#define _ADD_PIN(NAME, COUNTER, IS_DIGITAL) _ADD_PIN_2(entry_NAME_##COUNTER, NAME, IS_DIGITAL)
|
||||||
#define REPORT_NAME_DIGITAL(NAME, COUNTER) _ADD_PIN(NAME, COUNTER, (uint8_t)1)
|
#define REPORT_NAME_DIGITAL(NAME, COUNTER) _ADD_PIN(NAME, COUNTER, true)
|
||||||
#define REPORT_NAME_ANALOG(NAME, COUNTER) _ADD_PIN(analogInputToDigitalPin(NAME), COUNTER, 0)
|
#define REPORT_NAME_ANALOG(NAME, COUNTER) _ADD_PIN(analogInputToDigitalPin(NAME), COUNTER, false)
|
||||||
|
|
||||||
const char* const pin_array[][3] PROGMEM = {
|
typedef struct {
|
||||||
|
const char * const name;
|
||||||
|
uint8_t pin;
|
||||||
|
bool is_digital;
|
||||||
|
} PinInfo;
|
||||||
|
|
||||||
|
const PinInfo pin_array[] PROGMEM = {
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* [pin name] [pin number] [is digital or analog] 1 = digital, 0 = analog
|
* [pin name] [pin number] [is digital or analog] 1 = digital, 0 = analog
|
||||||
|
@ -83,21 +89,19 @@ const char* const pin_array[][3] PROGMEM = {
|
||||||
// manually add pins ...
|
// manually add pins ...
|
||||||
#if SERIAL_PORT == 0
|
#if SERIAL_PORT == 0
|
||||||
#if AVR_ATmega2560_FAMILY
|
#if AVR_ATmega2560_FAMILY
|
||||||
{ RXD_NAME, 0, 1 },
|
{ RXD_NAME, 0, true },
|
||||||
{ TXD_NAME, 1, 1 },
|
{ TXD_NAME, 1, true },
|
||||||
#elif AVR_ATmega1284_FAMILY
|
#elif AVR_ATmega1284_FAMILY
|
||||||
{ RXD_NAME, 8, 1 },
|
{ RXD_NAME, 8, true },
|
||||||
{ TXD_NAME, 9, 1 },
|
{ TXD_NAME, 9, true },
|
||||||
#endif
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#include "pinsDebug_list.h"
|
#include "pinsDebug_list.h"
|
||||||
#line 96
|
#line 102
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#define n_array (sizeof(pin_array) / sizeof(char*)) / 3
|
|
||||||
|
|
||||||
#define AVR_ATmega2560_FAMILY_PLUS_70 (MOTHERBOARD == BOARD_BQ_ZUM_MEGA_3D \
|
#define AVR_ATmega2560_FAMILY_PLUS_70 (MOTHERBOARD == BOARD_BQ_ZUM_MEGA_3D \
|
||||||
|| MOTHERBOARD == BOARD_MIGHTYBOARD_REVE \
|
|| MOTHERBOARD == BOARD_MIGHTYBOARD_REVE \
|
||||||
|| MOTHERBOARD == BOARD_MINIRAMBO \
|
|| MOTHERBOARD == BOARD_MINIRAMBO \
|
||||||
|
@ -439,12 +443,12 @@ static void print_input_or_output(const bool isout) {
|
||||||
}
|
}
|
||||||
|
|
||||||
// pretty report with PWM info
|
// pretty report with PWM info
|
||||||
inline void report_pin_state_extended(int8_t pin, bool ignore, bool extended = false,const char *start_string = "") {
|
inline void report_pin_state_extended(int8_t pin, bool ignore, bool extended = false, const char *start_string = "") {
|
||||||
uint8_t temp_char;
|
uint8_t temp_char;
|
||||||
char *name_mem_pointer, buffer[30]; // for the sprintf statements
|
char *name_mem_pointer, buffer[30]; // for the sprintf statements
|
||||||
bool found = false, multi_name_pin = false;
|
bool found = false, multi_name_pin = false;
|
||||||
for (uint8_t x = 0; x < n_array; x++) { // scan entire array and report all instances of this pin
|
for (uint8_t x = 0; x < COUNT(pin_array); x++) { // scan entire array and report all instances of this pin
|
||||||
if (pgm_read_byte(&pin_array[x][1]) == pin) {
|
if (pgm_read_byte(&pin_array[x].pin) == pin) {
|
||||||
if (found) multi_name_pin = true;
|
if (found) multi_name_pin = true;
|
||||||
found = true;
|
found = true;
|
||||||
if (!multi_name_pin) { // report digitial and analog pin number only on the first time through
|
if (!multi_name_pin) { // report digitial and analog pin number only on the first time through
|
||||||
|
@ -461,7 +465,7 @@ inline void report_pin_state_extended(int8_t pin, bool ignore, bool extended = f
|
||||||
SERIAL_CHAR('.');
|
SERIAL_CHAR('.');
|
||||||
SERIAL_ECHO_SP(26 + strlen(start_string)); // add padding if not the first instance found
|
SERIAL_ECHO_SP(26 + strlen(start_string)); // add padding if not the first instance found
|
||||||
}
|
}
|
||||||
name_mem_pointer = (char*)pgm_read_word(&pin_array[x][0]);
|
name_mem_pointer = (char*)pgm_read_word(&pin_array[x].name);
|
||||||
for (uint8_t y = 0; y < 28; y++) { // always print pin name
|
for (uint8_t y = 0; y < 28; y++) { // always print pin name
|
||||||
temp_char = pgm_read_byte(name_mem_pointer + y);
|
temp_char = pgm_read_byte(name_mem_pointer + y);
|
||||||
if (temp_char != 0)
|
if (temp_char != 0)
|
||||||
|
@ -489,7 +493,7 @@ inline void report_pin_state_extended(int8_t pin, bool ignore, bool extended = f
|
||||||
else
|
else
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
if (!(pgm_read_byte(&pin_array[x][2]))) {
|
if (!(pgm_read_byte(&pin_array[x].is_digital))) {
|
||||||
sprintf_P(buffer, PSTR("Analog in = %5d"), analogRead(pin - analogInputToDigitalPin(0)));
|
sprintf_P(buffer, PSTR("Analog in = %5d"), analogRead(pin - analogInputToDigitalPin(0)));
|
||||||
SERIAL_ECHO(buffer);
|
SERIAL_ECHO(buffer);
|
||||||
}
|
}
|
||||||
|
|
|
@ -1103,12 +1103,12 @@ void Planner::_buffer_line(const float &a, const float &b, const float &c, const
|
||||||
while (filwidth_delay_dist >= MMD_MM) filwidth_delay_dist -= MMD_MM;
|
while (filwidth_delay_dist >= MMD_MM) filwidth_delay_dist -= MMD_MM;
|
||||||
|
|
||||||
// Convert into an index into the measurement array
|
// Convert into an index into the measurement array
|
||||||
filwidth_delay_index[0] = (int)(filwidth_delay_dist * 0.1 + 0.0001);
|
filwidth_delay_index[0] = int8_t(filwidth_delay_dist * 0.1);
|
||||||
|
|
||||||
// If the index has changed (must have gone forward)...
|
// If the index has changed (must have gone forward)...
|
||||||
if (filwidth_delay_index[0] != filwidth_delay_index[1]) {
|
if (filwidth_delay_index[0] != filwidth_delay_index[1]) {
|
||||||
filwidth_e_count = 0; // Reset the E movement counter
|
filwidth_e_count = 0; // Reset the E movement counter
|
||||||
const int8_t meas_sample = thermalManager.widthFil_to_size_ratio() - 100; // Subtract 100 to reduce magnitude - to store in a signed char
|
const uint8_t meas_sample = thermalManager.widthFil_to_size_ratio() - 100; // Subtract 100 to reduce magnitude - to store in a signed char
|
||||||
do {
|
do {
|
||||||
filwidth_delay_index[1] = (filwidth_delay_index[1] + 1) % MMD_CM; // The next unused slot
|
filwidth_delay_index[1] = (filwidth_delay_index[1] + 1) % MMD_CM; // The next unused slot
|
||||||
measurement_delay[filwidth_delay_index[1]] = meas_sample; // Store the measurement
|
measurement_delay[filwidth_delay_index[1]] = meas_sample; // Store the measurement
|
||||||
|
|
|
@ -180,7 +180,7 @@ int16_t Temperature::minttemp_raw[HOTENDS] = ARRAY_BY_HOTENDS(HEATER_0_RAW_LO_TE
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
||||||
int16_t Temperature::meas_shift_index; // Index of a delayed sample in buffer
|
int8_t Temperature::meas_shift_index; // Index of a delayed sample in buffer
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if HAS_AUTO_FAN
|
#if HAS_AUTO_FAN
|
||||||
|
@ -196,7 +196,7 @@ uint8_t Temperature::soft_pwm_amount[HOTENDS],
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
||||||
int Temperature::current_raw_filwidth = 0; //Holds measured filament diameter - one extruder only
|
uint16_t Temperature::current_raw_filwidth = 0; // Measured filament diameter - one extruder only
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(PROBING_HEATERS_OFF)
|
#if ENABLED(PROBING_HEATERS_OFF)
|
||||||
|
@ -957,7 +957,7 @@ void Temperature::updateTemperaturesFromRawValues() {
|
||||||
|
|
||||||
// Convert raw Filament Width to millimeters
|
// Convert raw Filament Width to millimeters
|
||||||
float Temperature::analog2widthFil() {
|
float Temperature::analog2widthFil() {
|
||||||
return current_raw_filwidth / 16383.0 * 5.0;
|
return current_raw_filwidth * 5.0 * (1.0 / 16383.0);
|
||||||
//return current_raw_filwidth;
|
//return current_raw_filwidth;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -247,7 +247,7 @@ class Temperature {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
||||||
static int16_t meas_shift_index; // Index of a delayed sample in buffer
|
static int8_t meas_shift_index; // Index of a delayed sample in buffer
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if HAS_AUTO_FAN
|
#if HAS_AUTO_FAN
|
||||||
|
@ -255,7 +255,7 @@ class Temperature {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
#if ENABLED(FILAMENT_WIDTH_SENSOR)
|
||||||
static int current_raw_filwidth; //Holds measured filament diameter - one extruder only
|
static uint16_t current_raw_filwidth; // Measured filament diameter - one extruder only
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(PROBING_HEATERS_OFF)
|
#if ENABLED(PROBING_HEATERS_OFF)
|
||||||
|
|
|
@ -4001,7 +4001,7 @@ void kill_screen(const char* lcd_msg) {
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
#if ENABLED(REPRAPWORLD_KEYPAD)
|
#if ENABLED(REPRAPWORLD_KEYPAD)
|
||||||
void _reprapworld_keypad_move(AxisEnum axis, int16_t dir) {
|
void _reprapworld_keypad_move(const AxisEnum axis, const int16_t dir) {
|
||||||
move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
|
move_menu_scale = REPRAPWORLD_KEYPAD_MOVE_STEP;
|
||||||
encoderPosition = dir;
|
encoderPosition = dir;
|
||||||
switch (axis) {
|
switch (axis) {
|
||||||
|
|
Loading…
Reference in a new issue