原创 【东芝步进电机驱动器】+42步进电机驱动|平衡车驱动

2023-7-5 01:12 1179 6 6 分类: MCU/ 嵌入式


一、拆箱

东芝TB5128FTG是一款高性能的步进电机驱动器,它能够为两相和四相步进电机提供稳定、精确的控制。这款驱动器采用了先进的控制算法和驱动技术,确保电机在高速度和负载条件下也能稳定运行。它具有数字信号输入端口,可以轻松地通过微控制器控制电机的旋转方向、转速和定位。此外,东芝TB5128FTG还具有高温保护功能,确保在高温环境下也能可靠运行。总之,这款驱动器适用于各种工业自动化、机器人、打印机、雕刻机等领域,能够为项目提供出色的性能和可靠性。

在丝印可看出电源接入为直流电9-42v(推荐10-42v),以及接线端指示与拨码开关的设置示意。

二、步进电机的连接、驱动

步进电机是一种将电信号转化为角位移和线位移的电机,其转动角度和转速可以通过控制输入信号的脉冲数量和频率来精确控制。步进电机驱动板是用来驱动步进电机的专用电路板,它能够将STM32等微控制器的数字信号转换为适合步进电机的脉冲信号,同时提供电流和电压的放大,保护电机免受过流、过热等问题的损害。

在接线方面,

步进电机接线示意图如下:

我是用的是42BYGH47-401AS型号步进电机,在丝印上已经给了接线的示意:

对于步进电机的接线,四条引线,分别是A+、B+、A-和B-。将A和B线连接到驱动板的同名端口。这样,通过控制驱动板的ENA(使能)、DIR(方向)、PUL(脉冲)三对端口的状态,就可以控制步进电机的旋转方向和速度。

ENA、DIR和PUL三个信号的使用方法如下:

ENA信号的使用:ENA信号是使能信号,用于控制步进电机是否开始旋转。当ENA信号有效时,步进电机驱动器会接收PUL和DIR信号的控制,并驱动步进电机按照指定方向旋转。如果ENA信号无效,步进电机将不会受到任何控制,处于停止状态。

例如,当需要启动步进电机并正转时,可以将ENA信号设置为高电平,DIR信号设置为高电平,PUL信号设置为按照一定频率和数量变化的脉冲信号。这样,步进电机就会在PUL信号的控制下按照指定方向旋转。

DIR信号的使用:DIR信号是方向信号,用于控制步进电机的旋转方向。当DIR信号为高电平时,步进电机正转;当DIR信号为低电平时,步进电机反转。例如,如果要将步进电机反转,可以将DIR信号设置为低电平,同时保持PUL信号不变。这样,步进电机就会在PUL信号的控制下反向旋转。

PUL信号的使用:PUL信号是脉冲信号,用于控制步进电机的旋转速度和位置。PUL信号的脉冲数量和频率决定了步进电机的旋转角度和速度。

在编写驱动代码时,需要使用STM32的GPIO口控制步进电机驱动板,并提供合适的控制信号。

代码如下:

  1. #include "stm32f10x.h"
  2. // 定义控制步进电机的ENA、DIR和PUL信号的GPIO口
  3. #define ENA_PIN GPIO_Pin_5
  4. #define DIR_PIN GPIO_Pin_4
  5. #define PUL_PIN GPIO_Pin_3
  6. // 定义步进电机驱动板的控制端口
  7. #define ENA_PORT GPIOA
  8. #define DIR_PORT GPIOA
  9. #define PUL_PORT GPIOA
  10. void StepMotor(int stepCount)
  11. { // 设置方向端口状态
  12. GPIO_WriteBit(DIR_PORT, DIR_PIN, Bit_RESET);
  13. // 逐步旋转步进电机
  14. for (int i = 0; i < stepCount; i++)
  15. { // 设置步进电机步进端口状态
  16. GPIO_WriteBit(PUL_PORT, PUL_PIN, Bit_SET);
  17. // 延时一段时间
  18. delay(1);
  19. // 清除步进端口状态
  20. GPIO_WriteBit(PUL_PORT, PUL_PIN, Bit_RESET);
  21. // 延时一段时间
  22. delay(1);
  23. }
  24. }
  25. int main()
  26. { // 使能GPIOA和时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
  27. // 配置ENA、DIR和PUL信号为输出模式
  28. GPIO_InitTypeDef GPIO_InitStructure;
  29. GPIO_InitStructure.GPIO_Pin = ENA_PIN | DIR_PIN | PUL_PIN;
  30. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  31. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  32. GPIO_Init(ENA_PORT, &GPIO_InitStructure);
  33. GPIO_InitStructure.GPIO_Pin = DIR_PIN;
  34. GPIO_Init(DIR_PORT, &GPIO_InitStructure);
  35. GPIO_InitStructure.GPIO_Pin = PUL_PIN;
  36. GPIO_Init(PUL_PORT, &GPIO_InitStructure);
  37. // 循环旋转步进电机100圈
  38. for (int i = 0; i < 100; i++)
  39. {
  40. StepMotor(4096);
  41. // 4096为步进电机旋转一周的步数
  42. }
  43. return 0;
  44. }

平衡车的连接、驱动

平衡车是一种通过感知车身姿态和用户指令来保持平衡的交通工具,它由平衡控制系统、电机驱动系统、传感器系统和人机交互系统等部分组成。其中,平衡控制系统是平衡车的核心部分,它根据传感器系统的数据和用户指令来控制电机驱动系统,以实现平衡车的稳定和控制。

在平衡车中,STM32F103Z8T6作为主控制器,负责接收传感器系统的数据和用户指令,并控制电机驱动系统。MPU6050是一种姿态传感器,它通过检测加速度和角速度来获取平衡车的姿态信息,包括俯仰角、横滚角和偏航角等。STM32F103Z8T6通过读取MPU6050的传感器数据,可以获得平衡车的实时姿态信息,并根据这些信息来控制电机驱动系统。

在电机驱动系统中,平衡车使用的大功率编减速电机的驱动需要更高的电流和电压,东芝TB5128FTG支持高分辨率的细分控制,提高电机的运动平滑和精准度

通过以上组件的协同工作,平衡车可以实现以下工作原理:

姿态感知:MPU6050传感器通过检测加速度和角速度来获取平衡车的姿态信息,包括俯仰角、横滚角和偏航角等。这些信息被STM32F103Z8T6读取并进行处理。

控制系统:STM32F103Z8T6根据读取的MPU6050传感器数据和用户指令,计算出平衡车需要进行的调整动作,如向前、向后、向左或向右等。

驱动系统:根据STM32F103Z8T6的计算结果,电机驱动板控制步进电机的旋转方向和速度,以实现平衡车的移动和姿态调整。

动力系统:步进电机作为动力源,通过电机驱动板的控制实现旋转,从而带动平衡车的轮子或支撑结构运动。

通过以上工作原理,平衡车可以实现自动平衡和移动。当平衡车检测到姿态发生变化时,控制系统会根据传感器数据和用户指令进行调整,通过驱动系统控制步进电机旋转,带动平衡车的轮子或支撑结构运动,从而实现平衡车的稳定和控制。

 

此处仅讨论大功率编码减速电机的连接与驱动。

 

根据丝印分别是:

 

电线+

编码器GND

编码器 B相

编码器 A相

编码器 5v

电线-

 

 

代码如下:

  1. #include "stm32f10x.h"
  2. // 定义GPIO端口
  3. #define ENCODER_PORT GPIOA
  4. #define ENCODER_PIN_A GPIO_Pin_11
  5. #define ENCODER_PIN_B GPIO_Pin_12
  6. #define MOTOR_ENA_PORT GPIOB
  7. #define MOTOR_ENA_PIN GPIO_Pin_0
  8. #define MOTOR_DIR_PORT GPIOB
  9. #define MOTOR_DIR_PIN GPIO_Pin_1
  10. #define MOTOR_PUL_PORT GPIOB
  11. #define MOTOR_PUL_PIN GPIO_Pin_2
  12. // 定义中断向量函数
  13. void EXTI9_5_IRQHandler(void)
  14. {
  15. if (EXTI_GetITStatus(EXTI_Line12) != RESET)
  16. { // 处理编码器A相中断
  17. handle_encoder_phase_a_interrupt
  18. ();
  19. }
  20. if (EXTI_GetITStatus(EXTI_Line13) != RESET)
  21. { // 处理编码器B相中断
  22. handle_encoder_phase_a_interrupt
  23. ();
  24. }
  25. // 清除中断标志位
  26. EXTI_ClearITPendingBit(EXTI_Line12);
  27. EXTI_ClearITPendingBit(EXTI_Line13);
  28. }
  29. int main(void)
  30. {
  31. // 初始化GPIO端口
  32. GPIO_InitTypeDef GPIO_InitStructure;
  33. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB, ENABLE);
  34. GPIO_InitStructure.GPIO_Pin = ENCODER_PIN_A | ENCODER_PIN_B;
  35. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN;
  36. GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  37. GPIO_Init(ENCODER_PORT, &GPIO_InitStructure);
  38. GPIO_InitStructure.GPIO_Pin = MOTOR_ENA_PIN | MOTOR_DIR_PIN | MOTOR_PUL_PIN;
  39. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
  40. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  41. GPIO_Init(MOTOR_ENA_PORT, &GPIO_InitStructure);
  42. GPIO_Init(MOTOR_DIR_PORT, &GPIO_InitStructure);
  43. GPIO5->BSRR = 0x00001000;
  44. // 使能EXTI11中断线(编码器A相)和EXTI12中断线(编码器B相)
  45. // 初始化定时器
  46. TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
  47. TIM_TimeBaseStructure.TIM_Prescaler = 7199;
  48. TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
  49. TIM_TimeBaseStructure.TIM_Period = 999;
  50. TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  51. TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);
  52. // 配置脉冲输出通道1和2
  53. TIM_OCInitTypeDef TIM_OCInitStructure;
  54. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
  55. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  56. TIM_OCInitStructure.TIM_Pulse = 100;
  57. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
  58. TIM_OC1Init(TIM3, &TIM_OCInitStructure);
  59. TIM_OC2Init(TIM3, &TIM_OCInitStructure);
  60. // 使能定时器3脉冲输出通道1和2
  61. TIM_CtrlPWREnables(TIM3, TIM_CCxChannel1);
  62. TIM_CtrlPWREnables(TIM3, TIM_CCxChannel2);
  63. TIM_Cmd(TIM3, ENABLE);
  64. // 配置编码器
  65. TIM_EncoderInitTypeDef TIM_EncoderInitStructure;
  66. TIM_EncoderInitStructure.TIM_EncoderMode = TIM_EncoderMode_TI12;
  67. TIM_EncoderInitStructure.TIM_IC1Polarity = TIM_ICPolarity_Rising;
  68. TIM_EncoderInitStructure.TIM_IC1Selection = TIM_ICSelection_DirectTI;
  69. TIM_EncoderInitStructure.TIM_IC2Polarity = TIM_ICPolarity_Rising;
  70. TIM_EncoderInitStructure.TIM_IC2Selection = TIM_ICSelection_DirectTI;
  71. TIM_EncoderInitStructure.TIM_IC1Prescaler = TIM_ICPSC_DIV1;
  72. TIM_EncoderInitStructure.TIM_IC2Prescaler = TIM_ICPSC_DIV1;
  73. TIM_EncoderInit(TIM3, &TIM_EncoderInitStructure);
  74. // 启用编码器
  75. TIM_EncoderInterfaceEnable(TIM3, TIM_EncoderMode_TI12, TIM3_IC1, TIM3_IC2);
  76. // 启用全局中断和编码器中断
  77. enableInterrupts(IRQ_MASK15);
  78. enableInterrupts(IRQ_MASK13);
  79. TIM3->SR = 0;
  80. // 清除中断标志位
  81. TIM3->DIER = TIM3_DIER_UIE;
  82. // 允许更新中断
  83. NVIC_SetPriority(TIM3_IRQn, 0);
  84. // 设置中断优先级
  85. NVIC_EnableIRQ(TIM3_IRQn);
  86. // 使能中断向量
  87. // 启动定时器3
  88. TIM_Cmd(TIM3, ENABLE);
  89. // 电机控制逻辑
  90. if(GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_1) == RESET)
  91. // 编码器A相输入为高电平 {
  92. if(IfPositiveRotation())
  93. {
  94. NegativeReversal();
  95. }
  96. }
  97. else if(GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_2) == RESET)
  98. // 编码器B相输入为高电平
  99. { if(NegativeReversal())
  100. { PositiveRotation();
  101. }
  102. }
  103. else
  104. // 编码器A相和B相均为低电平,停止电机
  105. {
  106. StopMotor();
  107. }
  108. }

作者: chenqiguang98, 来源:面包板社区

链接: https://mbb.eet-china.com/blog/uid-me-3945995.html

版权声明:本文为博主原创,未经本人允许,禁止转载!

PARTNER CONTENT

文章评论0条评论)

登录后参与讨论
EE直播间
更多
我要评论
0
6
关闭 站长推荐上一条 /3 下一条