基于stm32的恒功率无线充电

void Add_pid_update(PID2* pid)  

{  

    float ep,ei,ed;  

    ep = pid->err - pid->last_err;  

    ei = pid->err;  

    ed = pid->err - 2*pid->last_err + pid->prev_err;  

    pid->pidout = pid->pGain * ep + pid->iGain*ei + pid->dGain*ed;  

    pid->prev_err = pid->last_err;  

    pid->last_err = pid->err;  

} 

void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)  

{  

    if (htim == (&htim2))  

    {  

            //计算40次取均值  

            for(int i=0;i<40;i++)  

            {  

                HAL_ADC_Start_DMA(&hadc1,ADC_Value,4);  

                voltage_ISN_sum+=ADC_Value[1]*3.3/4096.0*11;  

                electric_current_sum+=(ADC_Value[3]*33/4096.0-16.8);  

            }  

            voltage_ISN=voltage_ISN_sum/40;  

            electric_current=electric_current_sum/40;  

            voltage_ISN_sum=0;  

            electric_current_sum=0;  

            if(electric_current<0)  

            {  

                electric_current=0;  

            }  

            //计算功率  

            power=voltage_ISN*electric_current;  

            //计算误差  

            pid.err=power_want-power;  

            //计算pid输出  

            Add_pid_update(&pid);  

            //将输出与原来的占空比叠加  

            duty+=(int)pid.pidout;  

            if(duty>100)//限制功率  

            {  

                duty=100;  

            }  

            if(duty<0)  

            {  

                duty=0;  

            }  

            //duty=40;  

            Set_Tim3_Duty(&htim3,duty);  

             //串口发送数据  

            printf("%04.2f %04.2f %04.2f %03d %04.2f\r\n",voltage_ISN,electric_current,power,duty,pid.err);  

    }  

} 

if(pid.err<-2.2)  //超出10W，增大i消去尖峰  

{  

    pid.iGain=25;  

}  

else  

{  

    pid.iGain=0.5;  

}

% 关闭所有的Figure窗口  

close all;   

% 清除工作空间的所有变量，函数，和MEX文件  

clear all;  

  

% 加载数据文件，并命名为A  

A = load('data_add.txt');  

% 矩阵A的规模，[行,列]  

[m,n] = size(A);  

  

% 绘制txt文件第一列的数据s  

figure(1);  

plot(A(:,1));  

axis([0 10000 0 10]);   

% 横坐标  

xlabel('数据点数(个)');  

% 纵坐标  

ylabel('幅值(V)');  

% 标题  

title('电压波形图');  

  

figure(2);  

plot(A(:,2));  

axis([0 10000 0 10]);   

% 横坐标  

xlabel('数据点数(个)');  

% 纵坐标  

ylabel('幅值(A)');  

% 标题  

title('电流波形图');  

  

figure(3);  

plot(A(:,3));  

axis([0 10000 0 15]);   

% 横坐标  

xlabel('数据点数(个)');  

% 纵坐标  

ylabel('幅值(W)');  

% 标题  

title('功率波形图');  

  

figure(4);  

plot(A(:,4));  

axis([0 10000 0 120]);   

% 横坐标  

xlabel('数据点数(个)');  

% 纵坐标  

ylabel('幅值(%)');  

% 标题  

title('占空比波形图');