🎨 cosmetics
This commit is contained in:
parent
2d6454b352
commit
e8c0363051
5 changed files with 19 additions and 19 deletions
|
|
@ -582,7 +582,7 @@ void FTMotion::makeVector() {
|
|||
float accel_k = 0.0f; // (mm/s^2) Acceleration K factor
|
||||
float tau = (makeVector_idx + 1) * (FTM_TS); // (s) Time since start of block
|
||||
float dist = 0.0f; // (mm) Distance traveled
|
||||
|
||||
|
||||
if (makeVector_idx < N1) {
|
||||
// Acceleration phase
|
||||
dist = (f_s * tau) + (0.5f * accel_P * sq(tau)); // (mm) Distance traveled for acceleration phase since start of block
|
||||
|
|
@ -599,25 +599,25 @@ void FTMotion::makeVector() {
|
|||
dist = s_2e + F_P * tau + 0.5f * decel_P * sq(tau); // (mm) Distance traveled for deceleration phase since start of block
|
||||
accel_k = decel_P; // (mm/s^2) Acceleration K factor from Decel phase
|
||||
}
|
||||
|
||||
|
||||
#define _SET_TRAJ(q) traj.q[makeVector_batchIdx] = startPosn.q + ratio.q * dist;
|
||||
LOGICAL_AXIS_MAP_LC(_SET_TRAJ);
|
||||
|
||||
|
||||
#if HAS_EXTRUDERS
|
||||
if (cfg.linearAdvEna) {
|
||||
float dedt_adj = (traj.e[makeVector_batchIdx] - e_raw_z1) * (FTM_FS);
|
||||
if (ratio.e > 0.0f) dedt_adj += accel_k * cfg.linearAdvK * 0.0001f;
|
||||
|
||||
|
||||
e_raw_z1 = traj.e[makeVector_batchIdx];
|
||||
e_advanced_z1 += dedt_adj * (FTM_TS);
|
||||
traj.e[makeVector_batchIdx] = e_advanced_z1;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
// Update shaping parameters if needed.
|
||||
|
||||
|
||||
switch (cfg.dynFreqMode) {
|
||||
|
||||
|
||||
#if HAS_DYNAMIC_FREQ_MM
|
||||
case dynFreqMode_Z_BASED: {
|
||||
static float oldz = 0.0f;
|
||||
|
|
@ -635,7 +635,7 @@ void FTMotion::makeVector() {
|
|||
}
|
||||
} break;
|
||||
#endif
|
||||
|
||||
|
||||
#if HAS_DYNAMIC_FREQ_G
|
||||
case dynFreqMode_MASS_BASED:
|
||||
// Update constantly. The optimization done for Z value makes
|
||||
|
|
@ -648,10 +648,10 @@ void FTMotion::makeVector() {
|
|||
#endif
|
||||
break;
|
||||
#endif
|
||||
|
||||
|
||||
default: break;
|
||||
}
|
||||
|
||||
|
||||
// Apply shaping if active on each axis
|
||||
#if HAS_FTM_SHAPING
|
||||
#if HAS_X_AXIS
|
||||
|
|
@ -664,7 +664,7 @@ void FTMotion::makeVector() {
|
|||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
#if HAS_Y_AXIS
|
||||
if (shaping.y.ena) {
|
||||
shaping.y.d_zi[shaping.zi_idx] = traj.y[makeVector_batchIdx];
|
||||
|
|
@ -677,13 +677,13 @@ void FTMotion::makeVector() {
|
|||
#endif
|
||||
if (++shaping.zi_idx == (FTM_ZMAX)) shaping.zi_idx = 0;
|
||||
#endif // HAS_FTM_SHAPING
|
||||
|
||||
|
||||
// Filled up the queue with regular and shaped steps
|
||||
if (++makeVector_batchIdx == FTM_WINDOW_SIZE) {
|
||||
makeVector_batchIdx = BATCH_SIDX_IN_WINDOW;
|
||||
batchRdy = true;
|
||||
}
|
||||
|
||||
|
||||
if (++makeVector_idx == max_intervals) {
|
||||
blockProcRdy = false;
|
||||
makeVector_idx = 0;
|
||||
|
|
|
|||
|
|
@ -2626,7 +2626,7 @@ void prepare_line_to_destination() {
|
|||
default: return;
|
||||
}
|
||||
|
||||
// Phase distance to nearest home phase position when moving in the backout direction from endstop(may be negative).
|
||||
// Phase distance to nearest home phase position when moving in the backout direction from endstop (may be negative).
|
||||
int16_t phaseDelta = (home_phase[axis] - phaseCurrent) * stepperBackoutDir;
|
||||
|
||||
// Check if home distance within endstop assumed repeatability noise of .05mm and warn.
|
||||
|
|
@ -2638,7 +2638,7 @@ void prepare_line_to_destination() {
|
|||
// Skip to next if target position is behind current. So it only moves away from endstop.
|
||||
if (phaseDelta < 0) phaseDelta += 1024;
|
||||
|
||||
// Convert TMC µsteps(phase) to whole Marlin µsteps to effector backout direction to mm
|
||||
// Convert TMC µsteps (phase) to whole Marlin µsteps to effector backout direction to mm
|
||||
const float mmDelta = int16_t(phaseDelta / phasePerUStep) * effectorBackoutDir * planner.mm_per_step[axis];
|
||||
|
||||
// Optional debug messages
|
||||
|
|
|
|||
|
|
@ -37,7 +37,7 @@ _Min_Stack_Size = 0x400; /* required amount of stack */
|
|||
MEMORY
|
||||
{
|
||||
RAM (xrw) : ORIGIN = 0x20000000, LENGTH = 16K
|
||||
FLASH (rx) : ORIGIN = 0x8000000 , LENGTH = 128K
|
||||
FLASH (rx) : ORIGIN = 0x8000000 , LENGTH = 128K
|
||||
}
|
||||
|
||||
/* Sections */
|
||||
|
|
|
|||
|
|
@ -37,7 +37,7 @@ _Min_Stack_Size = 0x400; /* required amount of stack */
|
|||
MEMORY
|
||||
{
|
||||
RAM (xrw) : ORIGIN = 0x20000000, LENGTH = 16K
|
||||
FLASH (rx) : ORIGIN = 0x8000000 , LENGTH = 128K
|
||||
FLASH (rx) : ORIGIN = 0x8000000 , LENGTH = 128K
|
||||
}
|
||||
|
||||
/* Sections */
|
||||
|
|
|
|||
|
|
@ -199,7 +199,7 @@ WEAK const PinMap PinMap_TIM[] = {
|
|||
WEAK const PinMap PinMap_UART_TX[] = {
|
||||
// {PA_0, UART4, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF8_UART4)},
|
||||
// {PA_2, USART2, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF7_USART2)},
|
||||
// {PA_9, LPUART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF3_LPUART)},
|
||||
// {PA_9, LPUART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF3_LPUART)},
|
||||
{PA_9_ALT1, USART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF7_USART1)},// EXP2_03_PIN
|
||||
// {PA_12, UART4, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF6_UART4)},
|
||||
// {PA_15, UART7, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF11_UART7)},
|
||||
|
|
@ -231,7 +231,7 @@ WEAK const PinMap PinMap_UART_RX[] = {
|
|||
// {PA_1, UART4, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF8_UART4)},
|
||||
// {PA_3, USART2, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF7_USART2)},
|
||||
// {PA_8, UART7, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF11_UART7)},
|
||||
// {PA_10, LPUART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF3_LPUART)},
|
||||
// {PA_10, LPUART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF3_LPUART)},
|
||||
{PA_10_ALT1, USART1, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF7_USART1)},// EXP2_05_PIN
|
||||
// {PA_11, UART4, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF6_UART4)},
|
||||
// {PB_3, UART7, STM_PIN_DATA(STM_MODE_AF_PP, GPIO_PULLUP, GPIO_AF11_UART7)},
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue