|
@@ -1754,14 +1754,6 @@ void PLSR_Route_Set(PLSR_RouteConfig_t* route) |
|
|
// 新增:设置默认加减速时间 |
|
|
// 新增:设置默认加减速时间 |
|
|
route->default_accel_time_ms = ModbusSlave.holding_regs[11]; // 使用相同的加速时间 |
|
|
route->default_accel_time_ms = ModbusSlave.holding_regs[11]; // 使用相同的加速时间 |
|
|
route->default_decel_time_ms = ModbusSlave.holding_regs[12]; // 使用相同的减速时间 |
|
|
route->default_decel_time_ms = ModbusSlave.holding_regs[12]; // 使用相同的减速时间 |
|
|
if(route->ext_port == 0) |
|
|
|
|
|
{ |
|
|
|
|
|
HAL_NVIC_EnableIRQ(EXTI9_5_IRQn); |
|
|
|
|
|
} |
|
|
|
|
|
else |
|
|
|
|
|
{ |
|
|
|
|
|
HAL_NVIC_DisableIRQ(EXTI15_10_IRQn); |
|
|
|
|
|
} |
|
|
|
|
|
// 自动更新加减速度 |
|
|
// 自动更新加减速度 |
|
|
PLSR_Accel_UpdateRates(route); |
|
|
PLSR_Accel_UpdateRates(route); |
|
|
|
|
|
|
|
@@ -1866,11 +1858,15 @@ void PLSR_Route_Start(PLSR_RouteConfig_t* route) |
|
|
__HAL_TIM_SET_COUNTER(&htim2, 0); // 重置TIM2计数器 |
|
|
__HAL_TIM_SET_COUNTER(&htim2, 0); // 重置TIM2计数器 |
|
|
__HAL_TIM_SET_COUNTER(&htim6, 0); // 重置TIM6计数器 |
|
|
__HAL_TIM_SET_COUNTER(&htim6, 0); // 重置TIM6计数器 |
|
|
|
|
|
|
|
|
// 停止所有PWM输出,确保启动前处于停止状态 |
|
|
|
|
|
HAL_TIM_PWM_Stop(&htim10, TIM_CHANNEL_1); |
|
|
|
|
|
HAL_TIM_PWM_Stop(&htim11, TIM_CHANNEL_1); |
|
|
|
|
|
HAL_TIM_PWM_Stop(&htim13, TIM_CHANNEL_1); |
|
|
|
|
|
HAL_TIM_PWM_Stop(&htim14, TIM_CHANNEL_1); |
|
|
|
|
|
|
|
|
/*选择外部事件端口*/ |
|
|
|
|
|
if(route->ext_port == 0) |
|
|
|
|
|
{ |
|
|
|
|
|
HAL_NVIC_EnableIRQ(EXTI9_5_IRQn); |
|
|
|
|
|
} |
|
|
|
|
|
else |
|
|
|
|
|
{ |
|
|
|
|
|
HAL_NVIC_EnableIRQ(EXTI15_10_IRQn); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
// 启动第一段 |
|
|
// 启动第一段 |
|
|
PLSR_Section_StartNewSection(route); |
|
|
PLSR_Section_StartNewSection(route); |
|
|