前言
主控板STM32F302R8+驱动板X-NUCLEO-IHM07M1+直流减速电机37GB3530,实现直流电机的电流闭环控制。 直流有刷电机电流采集请阅读此章节: 直流有刷电机电流采集基于STM32F302R8+X-NUCLEO-IHM07M1
PID算法请阅读此章节: 直流有刷电机闭环调速基于STM32F302R8+X-NUCLEO-IHM07M1
一、STM32F302R8+X-NUCLEO-IHM07M1直流电机的电流闭环控制
1.1.功能需求
实现直流减速电机37GB3530电流闭环控制
1.2.硬件设计
控制板:STM32F302R8 驱动板:X-NUCLEO-IHM07M1 直流电机:37GB3530,额定功率10W,额定电压12V,额定电流0.3A,
1.3.软件设计
1.3.1.底层配置
1、RCC设置为外部时钟,72MHz 2、PC13设置为输入,无上下拉电阻;PC10,PC11设置为输出,无上下拉电阻,高速,初值为0;PB13设置为输出,下拉电阻,高速,初值为0 3、PA8设置为TIM1_CH1,PA9设置为TIM1_CH2;TIM1时钟源设置为内部时钟,两通道均设置为PWM输出;TIM1时钟分频值设置为36-1,向上计数,ARR设置为100-1,PWM输出的周期为1/(72000000/36)100=510^-5s,也即20KHz,其余值保持默认即可 4、PC1设置为ADC1_IN7;单通道采集,ADC1采用异步时钟4分频,12位数据位,右对齐,连续转换模式使能,DMA请求使能,采样时间设置为19.5个周期,并进行DMA设置; 5、使能TIM6,TIM6时钟分频值设置为72-1,向上计数,ARR设置为1000-1;使能TIM6中断,中断优先级设置为1,0 6、USART2设置为异步;波特率115200,8位数据位,1位停止位,无奇偶检验位 7、IDE设置为Keil,在Keil环境中进行应用层编程 具体底层配置阅读此章节:
1.3.2.应用层开发
主函数:
int main(void)
{
uint8_t count=0;
HAL_Init();
SystemClock_Config();
MX_GPIO_Init();
MX_DMA_Init();
MX_ADC1_Init();
MX_TIM1_Init();
MX_USART2_UART_Init();
MX_TIM6_Init();
HAL_GPIO_WritePin(GPIOC, EN1_Pin, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOC, EN2_Pin, GPIO_PIN_SET);
HAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_1);
HAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_2);
HAL_ADC_Start_DMA(&hadc1,(uint32_t*)Get_ADC,1000);
HAL_TIM_Base_Start_IT(&htim6);
__HAL_TIM_CLEAR_IT(&htim6,TIM_IT_UPDATE);
pid_init();
debug_init();
while (1)
{
if(KEY_Scany(KEY_GPIO_Port,KEY_Pin)==1)
{
g_current_pid.SetPoint+=5;;
if(g_current_pid.SetPoint>=30)
g_current_pid.SetPoint=30;
}
HAL_Delay(10);
if(count%50==0)
{
HAL_GPIO_TogglePin(LED_GPIO_Port, LED_Pin);
debug_send_wave_data(1,Get_Current);
debug_send_wave_data(2,Get_ADC_Val);
debug_send_wave_data(3,g_current_pid.SetPoint);
count=0;
}
count++;
}
}
按键扫描函数:
uint8_t KEY_Scany(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin)
{
if(HAL_GPIO_ReadPin(GPIOx, GPIO_Pin)==0)
{
while(HAL_GPIO_ReadPin(GPIOx, GPIO_Pin)==0);
return 1;
}
else
return 0;
}
中断函数:
void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc)
{
uint32_t temp=0;
int i;
HAL_ADC_Stop_DMA(hadc);
for(i=0;i<1000;i++)
{
temp+=Get_ADC[i];
}
temp/=1000;
Get_ADC_Val=temp;
Get_Current=(float)(Get_ADC_Val*(float)(3.3f/4.096f/0.99f));
HAL_ADC_Start_DMA(&hadc1,(uint32_t*)Get_ADC,1000);
}
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
{
static uint8_t count=0;
int Duty_c=0;
if(count%SMAPLSE_PID_SPEED==0)
{
Duty_c=increment_pid_ctrl(&g_current_pid,Get_Current);
Duty=Duty*0.5+Duty_c*0.5;
if(Duty>=100)
{
Duty=100;
}
else if(Duty<=0)
{
Duty=0;
}
TIM1->CCR1=Duty;
count=0;
}
count++;
}
PID函数: 注:PID函数直接参考正点原子函数
int32_t increment_pid_ctrl(PID_TypeDef *PID,float Feedback_value)
{
PID->Error = (float)(PID->SetPoint - Feedback_value);
#if INCR_LOCT_SELECT
PID->ActualValue += (PID->Proportion * (PID->Error - PID->LastError))
+ (PID->Integral * PID->Error)
+ (PID->Derivative * (PID->Error - 2 * PID->LastError + PID->PrevError));
PID->PrevError = PID->LastError;
PID->LastError = PID->Error;
#else
PID->SumError += PID->Error;
PID->ActualValue = (PID->Proportion * PID->Error)
+ (PID->Integral * PID->SumError)
+ (PID->Derivative * (PID->Error - PID->LastError));
PID->LastError = PID->Error;
#endif
return ((int32_t)(PID->ActualValue));
}
上位机采用正点原子上位机,用于波形观察
1.4.下载验证
编译下载到控制器,观察实验现象
总结
主控板STM32F302R8+驱动板X-NUCLEO-IHM07M1+直流减速电机37GB3530,实现了直流电机的电流闭环控制,为后续章节的分析奠定基础
|