打印
[STM32F4]

请教一下做过stm32步进电机T型加减速的大佬帮忙看一下啊?

[复制链接]
1258|10
手机看帖
扫描二维码
随时随地手机跟帖
跳转到指定楼层
楼主
cry1109|  楼主 | 2020-2-27 17:14 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
本帖最后由 cry1109 于 2020-2-27 17:23 编辑

        STM32F407的TIM1输出PWM,cubeMX配置。使用的是内部时钟,配置系统时钟为64MHz。TIM2每200us进入一次中断,每次中断中增加或减少PWM脉冲频率,达到匀加速、匀减速的效果。但是匀加速期间发出的PWM脉冲个数并不等与计算的个数,而匀减速期间所发的脉冲个数等于计算的个数。
        比如说脉冲频率从50Hz增加到28346Hz,期间需要发出502脉冲,可实际至发了6个脉冲;脉冲频率从28346Hz降低到50Hz时,实际发出的脉冲个数504个。从大降到小没问题,从小增到大就不对了,求解。
速度调节函数:void Speed_Adjust(uint16_t delta_speed)
{
                if(Motor.ActiveSpeed > (Motor.TargetSpeed+delta_speed))
                {
                                Motor.ActiveSpeed -= delta_speed;
                }
                else if(Motor.ActiveSpeed < (Motor.TargetSpeed-delta_speed))
                {
                                Motor.ActiveSpeed += delta_speed;
                }
                else
                {
                                Motor.ActiveSpeed = Motor.TargetSpeed;
                }

                if(Motor.ActiveSpeed < 50)
                {
                                Motor.ActiveSpeed = 50;
                }
                else if(Motor.ActiveSpeed > 1000000)
                {
                                Motor.ActiveSpeed = 1000000;
                }
               
                __HAL_TIM_SET_AUTORELOAD(&htim1,MOTOR_TIME_FREQ/Motor.ActiveSpeed);
                __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, (MOTOR_TIME_FREQ/Motor.ActiveSpeed)/2);
}
期望的电机运动轨迹:




495795e5788eae0043.png (308.58 KB )

495795e5788eae0043.png

使用特权

评论回复
沙发
cry1109|  楼主 | 2020-2-27 17:20 | 只看该作者
定时器配置函数:
void MX_TIM1_Init(void)
{
  TIM_ClockConfigTypeDef sClockSourceConfig = {0};
  TIM_MasterConfigTypeDef sMasterConfig = {0};
  TIM_OC_InitTypeDef sConfigOC = {0};
  TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig = {0};

  htim1.Instance = TIM1;
  htim1.Init.Prescaler = 31;
  htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
  htim1.Init.Period = 40000;
  htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  htim1.Init.RepetitionCounter = 0;
  htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
  {
    Error_Handler();
  }
  sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
  if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
  {
    Error_Handler();
  }
  if (HAL_TIM_PWM_Init(&htim1) != HAL_OK)
  {
    Error_Handler();
  }
  sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
  {
    Error_Handler();
  }
  sConfigOC.OCMode = TIM_OCMODE_PWM1;
  sConfigOC.Pulse = 20000;
  sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
  sConfigOC.OCNPolarity = TIM_OCNPOLARITY_HIGH;
  sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
  sConfigOC.OCIdleState = TIM_OCIDLESTATE_RESET;
  sConfigOC.OCNIdleState = TIM_OCNIDLESTATE_RESET;
  if (HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
  {
    Error_Handler();
  }
  __HAL_TIM_DISABLE_OCxPRELOAD(&htim1, TIM_CHANNEL_1);
  sBreakDeadTimeConfig.OffStateRunMode = TIM_OSSR_DISABLE;
  sBreakDeadTimeConfig.OffStateIDLEMode = TIM_OSSI_DISABLE;
  sBreakDeadTimeConfig.LockLevel = TIM_LOCKLEVEL_OFF;
  sBreakDeadTimeConfig.DeadTime = 0;
  sBreakDeadTimeConfig.BreakState = TIM_BREAK_DISABLE;
  sBreakDeadTimeConfig.BreakPolarity = TIM_BREAKPOLARITY_HIGH;
  sBreakDeadTimeConfig.AutomaticOutput = TIM_AUTOMATICOUTPUT_DISABLE;
  if (HAL_TIMEx_ConfigBreakDeadTime(&htim1, &sBreakDeadTimeConfig) != HAL_OK)
  {
    Error_Handler();
  }
  HAL_TIM_MspPostInit(&htim1);

}

使用特权

评论回复
板凳
cry1109|  楼主 | 2020-2-27 17:23 | 只看该作者
使能定时器的预重载寄存器和输出比较预装载寄存器后,加速阶段的脉冲个数好转,但是减速阶段的脉冲个数又不对了。。。
所以我怀疑问题出在定时器的影子寄存器。没有使能的时候,减速阶段的脉冲个数是对的。

使用特权

评论回复
地板
cry1109|  楼主 | 2020-2-27 17:25 | 只看该作者
通过修改定时器的自动重载值,改变输出的PWM频率,同时修改输出比较值,使占空比维持在50%。定时器1的时钟频率为2MHz。

使用特权

评论回复
5
mmuuss586| | 2020-2-28 11:44 | 只看该作者
没看出来哪里程序问题,跟踪下看看;
一个方向没问题,另一个方向有问题,问题应该好找的

使用特权

评论回复
6
cry1109|  楼主 | 2020-2-28 14:41 | 只看该作者
mmuuss586 发表于 2020-2-28 11:44
没看出来哪里程序问题,跟踪下看看;
一个方向没问题,另一个方向有问题,问题应该好找的

找到问题了。频率从小增到大的过程中,自动重载值是由大变小的,在实时的调节频率时由于禁止了影子寄存器,如果最新设置的自动重载值小于定时器的当前计数值,就会导致当前即将发出的脉冲丢失;如果频率从大减小的过程自动重载值是由小变大的,所以最新设置的自动重载值不会大于定时器的当前计数值,脉冲也就不会丢失。

使用特权

评论回复
7
cry1109|  楼主 | 2020-2-28 14:44 | 只看该作者
mmuuss586 发表于 2020-2-28 11:44
没看出来哪里程序问题,跟踪下看看;
一个方向没问题,另一个方向有问题,问题应该好找的

void Speed_Adjust(uint16_t delta_speed)
{
                if(Motor.ActiveSpeed > (Motor.TargetSpeed+delta_speed))
                {
                                Motor.ActiveSpeed -= delta_speed;
                }
                else if(Motor.ActiveSpeed < (Motor.TargetSpeed-delta_speed))
                {
                                Motor.ActiveSpeed += delta_speed;
                }
                else
                {
                                Motor.ActiveSpeed = Motor.TargetSpeed;
                }

                if(Motor.ActiveSpeed < 50)
                {
                                Motor.ActiveSpeed = 50;
                }
                else if(Motor.ActiveSpeed > 1000000)
                {
                                Motor.ActiveSpeed = 1000000;
                }
               
                if((MOTOR_TIME_FREQ/Motor.ActiveSpeed) > (__HAL_TIM_GET_COUNTER(&htim1)))
                {
                                __HAL_TIM_SET_AUTORELOAD(&htim1,MOTOR_TIME_FREQ/Motor.ActiveSpeed);
                                __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, (MOTOR_TIME_FREQ/Motor.ActiveSpeed)/2);
                }
}
代码加一句,只有设置的自动重载在大于当前计数值时才更新自动重装值和输出比较值。

使用特权

评论回复
8
七颗咖啡豆| | 2020-2-29 11:16 | 只看该作者
提示一下  PWM输出时一个周期内电平变化的时刻会触发中断,在这个中断里面重新设置arr就行,当然脉冲输出有极限,极限取决于中断执行的时间,中断时间超过arr时间会多发脉冲出来

使用特权

评论回复
9
cry1109|  楼主 | 2020-3-1 12:18 | 只看该作者
七颗咖啡豆 发表于 2020-2-29 11:16
提示一下  PWM输出时一个周期内电平变化的时刻会触发中断,在这个中断里面重新设置arr就行,当然脉冲输出有 ...

谢谢。刚才试了一下,方法可行,必须使能影子寄存器,加减速阶段的脉冲误差和我现在的差不多。

使用特权

评论回复
10
lvface123654| | 2020-3-1 16:41 | 只看该作者
为什么不用S型,启动停止都稳,梯形是入门。

使用特权

评论回复
11
cry1109|  楼主 | 2020-3-2 09:25 | 只看该作者
lvface123654 发表于 2020-3-1 16:41
为什么不用S型,启动停止都稳,梯形是入门。

这不是不会嘛。先把简单的搞出来。

使用特权

评论回复
发新帖 我要提问
您需要登录后才可以回帖 登录 | 注册

本版积分规则

40

主题

172

帖子

4

粉丝