电子产品世界 » 论坛首页 » DIY与开源设计 » 电子DIY » 【Let'sdo2026第3期】基于边缘AI的电机状态检测——任务三驱动电机并获

共1条 1/1 1 跳转至页

【Let'sdo2026第3期】基于边缘AI的电机状态检测——任务三驱动电机并获取电机运行状态(停止与启动)的加速度数据

菜鸟
2026-11-16 21:33:16     打赏

一、硬件介绍

       步进电机的型号是CX28BYJ-48 减速步进电机,是常见的28BYJ-48小型永磁减速步进电机。其内置约1:64减速齿轮箱,通常按四相八拍驱动,输出轴约4096个脉冲转一圈。电机外径约28mm。具体参数如下

image.png

       对应常用的控制芯片为ULN2003 驱动芯片。控制方式为常用的四相八拍:A→AB→B→BC→C→CD→D→DA。正转按此顺序循环,反转则逆序。

二、接线方式

       首先是供电线,因为电机转动需要比较大的电压和电流,如果有条件的话最好单独给电机供电。但是也可以使用板卡上的5V给电机供电。5V端口对应的原理图为

image.png

IN1-----PC7

IN2-----PC6

IN3-----PC9

IN4-----PA7

       其中PC7、PC6、PC9和PA7是挨着的,方便接线。

三、代码驱动

1、电机的驱动使用的是定时器,时长是按照转速计算出来的。定时器的初始化代码如下,在main.c中定义并被调用

static void MX_TIM6_Init(void)
{
  TIM_MasterConfigTypeDef sMasterConfig = {0};
  htim6.Instance =TIM6;
  htim6.Init.Prescaler = 31;
  htim6.Init.CounterMode = TIM_COUNTERMODE_UP;
  htim6.Init.Period =999;
  htim6.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  if (HAL_TIM_Base_Init(&htim6) != HAL_OK)
 {
    Error_Handler();
 }
  sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  if (HAL_TIMEx_MasterConfigSynchronization(&htim6, &sMasterConfig) != HAL_OK)
 {
    Error_Handler();
 }
}

       电机驱动相关的代码是放在step_motor.c文件中。

2、电机的初始化函数为StepMotor_Init,对应函数定义如下

void StepMotor_Init(TIM_HandleTypeDef *htim)
{
  motor_timer = htim;
  motor_state = STEP_MOTOR_STOPPED;
  motor_direction =STEP_MOTOR_DIRECTION_FORWARD;
  motor_speed_rpm =STEP_MOTOR_DEFAULT_RPM;
  motor_step_interval_us = StepMotor_RpmToIntervalUs(motor_speed_rpm);
  motor_step_index =0U;
  StepMotor_ConfigurePeriod();
  StepMotor_ReleaseCoils();
}

       首先是通过main函数的调用告知使用的定时器是哪个,这里使用的是定时器6,即htim6。然后是设置默认的电机状态,并设置四相连接端口的电平。其中电机状态设置的是停止状态,有运行状态;电机方向是正向,在使用上位机软件时没有设置转速和方向直接点击继续的话,就是按照正向6RPM转动的;电机转速默认是6RPM。StepMotor_RpmToIntervalUs函数是计算定时器根据转速设置的计时数,微妙级的。StepMotor_ConfigurePeriod函数是配置定时器的。StepMotor_ReleaseCoils是配置四相端口的电平,因为状态是停止的,所以电平都设置为高电平状态。

3、开启电机的函数为StepMotor_Start,该函数的定义如下

void StepMotor_Start(StepMotor_DirectionTypeDefdirection)
{
  if (motor_timer == NULL)
 {
    return;
 }
  (void)HAL_TIM_Base_Stop_IT(motor_timer);
  motor_direction =direction;
  motor_state = STEP_MOTOR_RUNNING;
  StepMotor_ApplyStep(motor_step_index);
  StepMotor_ConfigurePeriod();
  if (HAL_TIM_Base_Start_IT(motor_timer) != HAL_OK)
 {
    motor_state =STEP_MOTOR_STOPPED;
    StepMotor_ReleaseCoils();
 }
}

       函数的参数是电机转动的方向。函数实现逻辑是先关闭定时器,然后配置四相端口的电平状态,设置定时器参数,开启定时器。

4、关闭电机转动的函数为StepMotor_Stop,该函数的定义如下

void StepMotor_Stop(void)
{
  motor_state = STEP_MOTOR_STOPPED;
  if (motor_timer != NULL)
 {
    (void)HAL_TIM_Base_Stop_IT(motor_timer);
 }
  StepMotor_ReleaseCoils();
}

       函数的实现逻辑是停止定时器计数,初始化四相端口的输出电平为高电平。

5、继续电机的状态函数为StepMotor_Resume,该函数的定义如下

void StepMotor_Resume(void)
{
  StepMotor_Start(motor_direction);
}

       函数的实现逻辑是开启定时器计数。

6、设置电机转速的函数是StepMotor_SetSpeedRpm,该函数的定义如下

HAL_StatusTypeDef StepMotor_SetSpeedRpm(uint16_t rpm)
{
  uint8_t was_running;
  if ((rpm < STEP_MOTOR_MIN_RPM) || (rpm > STEP_MOTOR_MAX_RPM))
 {
    return HAL_ERROR;
 }
  was_running = (motor_state == STEP_MOTOR_RUNNING) ? 1U : 0U;
  if ((was_running != 0U) &&(motor_timer != NULL))
 {
    (void)HAL_TIM_Base_Stop_IT(motor_timer);
 }
  motor_speed_rpm =rpm;
  motor_step_interval_us = StepMotor_RpmToIntervalUs(rpm);
  StepMotor_ConfigurePeriod();
  if ((was_running != 0U) &&(motor_timer != NULL))
 {
    if (HAL_TIM_Base_Start_IT(motor_timer) != HAL_OK)
 
  {
      motor_state = STEP_MOTOR_STOPPED;
      StepMotor_ReleaseCoils();
      returnHAL_ERROR;
 
  }
 }
  return HAL_OK;
}

       函数的实现逻辑是当电机处于运行状态的话,就重新计算定时的计数值,并先关闭定时器,配置定时器参数,开启定时器。

7、获取电机运行状态的函数为StepMotor_GetStatus,该函数的定义如下

void StepMotor_GetStatus(StepMotor_StatusTypeDef*status)
{
  if (status == NULL)
 {
    return;
 }
  status->state = motor_state;
  status->direction = motor_direction;
  status->speed_rpm = motor_speed_rpm;
  status->step_interval_us = motor_step_interval_us;
}

       主要是一些赋值代码,将电机的状态赋值到参数指针*status中。

8、定时器回调函数为StepMotor_TimerElapsedCallback,该函数的定义如下

void StepMotor_TimerElapsedCallback(TIM_HandleTypeDef *htim)
{
  if ((htim != motor_timer) || (motor_state != STEP_MOTOR_RUNNING))
 {
    return;
 }
  if (motor_direction == STEP_MOTOR_DIRECTION_FORWARD)
 {
    motor_step_index = (uint8_t)((motor_step_index+ 1U) & 0x07U);
 }
  else
 {
    motor_step_index = (uint8_t)((motor_step_index+ 7U) & 0x07U);
 }
  StepMotor_ApplyStep(motor_step_index);
}

       该函数被定时器中断函数HAL_TIM_PeriodElapsedCallback调用。函数的主要作用是判断电机的转向,不同的转向的拍数顺序是不一样的。其中StepMotor_ApplyStep函数定义如下

static void StepMotor_ApplyStep(uint8_t index)
{
  StepMotor_WritePhase(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, half_step_sequence[index][0]);
  StepMotor_WritePhase(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, half_step_sequence[index][1]);
  StepMotor_WritePhase(MOTOR_IN3_GPIO_Port, MOTOR_IN3_Pin, half_step_sequence[index][2]);
  StepMotor_WritePhase(MOTOR_IN4_GPIO_Port, MOTOR_IN4_Pin, half_step_sequence[index][3]);
}

       其中的主要代码内容是变量half_step_sequence的定义,定义内容如下

static const uint8_t half_step_sequence[8][4] =
{
  {0U, 1U, 1U, 1U},
  {0U, 0U, 1U, 1U},
  {1U, 0U, 1U, 1U},
  {1U, 0U, 0U, 1U},
  {1U, 1U, 0U, 1U},
  {1U, 1U, 0U, 0U},
  {1U, 1U, 1U, 0U},
  {0U, 1U, 1U, 0U}
};

       其中各列为A、B、C、D相的电平状态,从第一行到最后一行的四相电平逻辑是符合硬件介绍的四相八排的定义A→AB→B→BC→C→CD→D→DA。

四、效果展示

       编译好代码后可以下载到板卡上,断电接好线后可使用ST-Link的Type-C接口连接上电脑。在电脑端可以使用MotorControlHost压缩包下的STM32H533_Motor_Control.exe软件。该软件是为了方便控制电机的状态特意让AI写的一个上位机软件。打开软件的界面如下

image.png

       首先是找到ST-Link模拟的串口号,若电脑只连接了一个串口,可以点击刷新。然后点击连接,串口参数的配置波特率115200,8bit数据位,1个停止位,无奇偶校验是程序的配置,如果有修改的话需要将上位机软件改成对应参数。然后可以在电机控制栏中设置电机的运行状态,如正反转,停止和继续,以及电机的转速。

电机正转6RPM的效果如下

五、工程文件

      对应的程序工程文件:STM32H533_Task3.zip

      对应的上位机软件:MotorControlHost.rar




关键词: STM32H533     ULN2003 驱动芯片     CX    

共1条 1/1 1 跳转至页

回复

匿名不能发帖!请先 [ 登陆 注册 ]