stm32cubemx hal学习记录:电机控制

  • Post author:
  • Post category:其他


一、基础配置

1、配置RCC、SYS,SYS的Timebase Source选择TIM6

2、配置USART1、时钟84MHz

3、激活FreeRTOS,选择CMSIS_V1,Config parameters种USE_TIMERS选择ENABLE

二、编码器及电机驱动引脚配置

1、选用TIM3的编码器模式

2、驱动使用L298N,将PB6、PB7设置为输出模式

3、使用TIM2的CH1输出1kHz的PWM

三、FreeRTOS配置

1、设置两个软件定时器,一个用于总控制,一个用于编码器读取数值,也可以用硬件定时器

2、设置一个队列,用于编码器数值传输

四、代码编写

硬件测试及传感器数据读取

在gpio.c中添加以下代码,完成电机限幅与方向控制

void Motor_Limit(int *speed)
{
	if(*speed>=100)
		*speed=100;
	if(*speed<=-100)
		*speed=-100;
}

uint8_t motor_dir;
void Motor_control(int speed)
{
	if(speed>=0)
	{
		motor_dir=1;
		Motor_Limit(&speed);
		__HAL_TIM_SetCompare(&htim2,TIM_CHANNEL_1,speed);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_6,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_7,GPIO_PIN_RESET);
	}
	else
	{
		motor_dir=0;
		Motor_Limit(&speed);
		__HAL_TIM_SetCompare(&htim2,TIM_CHANNEL_1,-speed);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_6,GPIO_PIN_RESET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_7,GPIO_PIN_SET);		
	}
}

在main.c中初始化TIM2,发出PWM波形

HAL_TIM_PWM_Start(&htim2,TIM_CHANNEL_1);

添加以下函数测试电机是否旋转,若电机旋转证明无错误,完成编码器测试后删掉

Motor_control(80);

添加编码器初始化代码

HAL_TIM_Encoder_Start(&htim3,TIM_CHANNEL_ALL);

在main中测试编码器是否正常,若正常将函数删掉。

enc=__HAL_TIM_GET_COUNTER(&htim3);

在freertos.c中的StartDefaultTask函数中添加代码,启动软件定时器,总控制周期设置10ms,编码器读取设置10ms

	osTimerStart(timer_controlHandle,10);
	osTimerStart(timer_encoderHandle,10);

编写编码器速度读取函数,debug后将enc放入函数内部

int32_t enc;
/* encoder_Callback function */
void encoder_Callback(void const * argument)
{
  /* USER CODE BEGIN encoder_Callback */
	enc=__HAL_TIM_GET_COUNTER(&htim3);
	__HAL_TIM_SET_COUNTER(&htim3,0);
  /* USER CODE END encoder_Callback */
}

此时发现反方向旋转时读出来的数据非常的大,且不是复数,此时更改代码,手动补偿

int32_t enc;
extern uint8_t motor_dir;
/* encoder_Callback function */
void encoder_Callback(void const * argument)
{
  /* USER CODE BEGIN encoder_Callback */
	if(motor_dir==1)
		enc=__HAL_TIM_GET_COUNTER(&htim3);
	else
		enc=-65535+__HAL_TIM_GET_COUNTER(&htim3);
	
	__HAL_TIM_SET_COUNTER(&htim3,0);
  /* USER CODE END encoder_Callback */
}

此时完成开环控制

增加pid.c与pid.h文件,完成闭环调参



版权声明:本文为ohhjack原创文章,遵循 CC 4.0 BY-SA 版权协议,转载请附上原文出处链接和本声明。