//PB4 LEFT PC4
//PB5 RIGHT PC5
//PB0 FORTH PC0
//PB1 BACK PC1
單片機源程序如下:
- #include "sys.h"
- #include "l298n.h"
- #include "usart.h"
- void l298n_TIM3_PWM_init(u16 arr,u16 psc)
- //使用TIM3輸出四路pwm波
- {
- GPIO_InitTypeDef GPIO_InitStructure;//定義結構體
- TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;//定義初始化結構體
- TIM_OCInitTypeDef TIM_OCInitStructure;//定義結構體
-
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); //使能定時器3時鐘
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC | RCC_APB2Periph_AFIO, ENABLE);//使能GPIO外設和AFIO復用功能模塊時鐘
- GPIO_PinRemapConfig(GPIO_FullRemap_TIM3, ENABLE); //選擇Timer3完全重映像
- GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable,ENABLE);//禁用JTAG
-
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_9; //使用TIM3下的TIM_CH1/TIM_CH2/TIM_CH3/TIM_CH4
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; //復用推挽功能
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
-
- GPIO_Init(GPIOC, &GPIO_InitStructure);//初始化引腳
-
-
- //初始化TIM3
- TIM_TimeBaseStructure.TIM_Period = arr; //自動重裝載寄存器的值
- TIM_TimeBaseStructure.TIM_Prescaler =psc; //TIMX預分頻的值
- TIM_TimeBaseStructure.TIM_ClockDivision = 0; //時鐘分割
- TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //向上計數
-
- TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); //根據以上功能對定時器進行初始化
-
-
- TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;//選擇定時器模式,TIM脈沖寬度調制模式2
- TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;//比較輸出使能
- TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;//輸出比較極性低
-
-
- TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable);
- TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable);
- TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable);
- TIM_OC4PreloadConfig(TIM3, TIM_OCPreload_Enable);
- //使能預裝載寄存器
-
- TIM_OC1Init(TIM3, &TIM_OCInitStructure);
- TIM_OC2Init(TIM3, &TIM_OCInitStructure);
- TIM_OC3Init(TIM3, &TIM_OCInitStructure);
- TIM_OC4Init(TIM3, &TIM_OCInitStructure);
- //根據結構體信息進行初始化
-
- TIM_Cmd(TIM3, ENABLE); //使能定時器TIM3
- }
復制代碼- #include "stdio.h"
- #include "sys.h"
- #include "motor_pid.h"
- #define PITCH 0
- #define YAW 0
- #define ROW 0
- //定義結構體變量
- PIDTypeDef mypid;
- void PID_init()//結構體初始化
- {
- //實際值
- mypid.ActualPitch = 0;
- mypid.ActualRow = 0;
- mypid.ActualYaw = 0;
-
- //設定值
- mypid.SetPitch = 0;
- mypid.SetRow = 0;
- mypid.SetYaw = 0;
-
- //偏差
- mypid.err_pitch = 0;
- mypid.err_row = 0;
- mypid.err_yaw = 0;
-
- //最近偏差
- mypid.err_last_pitch = 0;
- mypid.err_last_row = 0;
- mypid.err_last_yaw = 0;
-
- //歷史偏差
- mypid.integral_pitch = 0;
- mypid.integral_row = 0;
- mypid.integral_yaw = 0;
-
- //比例 微分 積分
- mypid.Kp_left = 0;
- mypid.Ki_left = 0;
- mypid.Kd_left = 0;
-
- mypid.Kp_right = 0;
- mypid.Ki_right = 0;
- mypid.Kd_right = 0;
-
- mypid.Kp_forth = 0;
- mypid.Ki_forth = 0;
- mypid.Kd_forth = 0;
-
- mypid.Kp_back;
- }
- void PID_6050(int pitch,int yaw,int row)
- //pitch 俯仰角
- //yaw 偏航角
- //row 翻滾角
- {
- mypid.SetPitch = PITCH;
- mypid.SetRow = ROW;
- mypid.SetYaw = YAW;
-
- mypid.ActualPitch = pitch;
- mypid.ActualRow = row;
- mypid.ActualYaw = yaw;
-
- mypid.err_pitch = mypid.SetPitch - mypid.ActualPitch;
- mypid.err_row = mypid.SetRow - mypid.ActualRow;
- mypid.err_yaw = mypid.SetYaw - mypid.ActualYaw;
-
- mypid.integral_pitch += mypid.integral_pitch;
- mypid.integral_row += mypid.integral_row;
- mypid.integral_yaw += mypid.integral_yaw;
-
- mypid.inLeft =
- mypid.inRight =
- mypid.inForth =
- mypid.inBack =
-
- pi
- }
復制代碼
所有資料51hei提供下載:
比賽程序.rar
(295.06 KB, 下載次數: 179)
2018-7-17 03:25 上傳
點擊文件名下載附件
輸出思路pwm波 下載積分: 黑幣 -5
|