STM32倒立擺平衡源代碼

ID:514559 · 發表于 2019-7-26 13:13

#include "stm32f10x.h"
#include "led.h"
#include "delay.h"
#include "usart1.h"
#include "135.h"
#include "time.h"
#include "moto.h"
#include "adc.h"
#include "PID.h"
#include "inv_mpu.h"
#include "inv_mpu_dmp_motion_driver.h"
#include "mpu6050.h"
/*使用的資源老王2017/7/13 --倒立擺
串口1：TX--PA9 RX--PA10
key：PE0 ~ 9 上拉輸入
LED: PD8 9 10 推挽輸出
OLED: 3.3v
D0(SCLK)--PC0 | D1(SDIN)--PC1 | RST--PG15 | DS-- PD3| CS--PD6 | RST--PG15
角度傳感器：PB0
*/
//#define zero_angle 3195
#define ok_angle 230//倒立時候的傳感器的值
//#define task2_start_angle 1250
vu16 len=0;//串口1接收數據的長度
u8 task_flag=0;
extern int pwm;
extern int flag;
extern int number;
short aacx,aacy,aacz; //加速度傳感器原始數據 --三軸加速度
short gyrox,gyroy,gyroz; //陀螺儀原始數據 --三軸角速度
float pitch,roll,yaw; //歐拉角 x z y
int adc_result;
u8 dis_flag=0;
void Init(void) // 初始化函數
{
delay_init();
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4); //設置NVIC中斷分組2:2位搶占優先級，2位響應優先級
LED_Init();
adc_config(); //傳感器
DC_motor_init();
DC_Set_Pwm (0);
time5_Init(9999,71); //1ms控制
time4_Init(9999,71); //1ms控制
LocPIDInit(); //位移式PID初始化
LocPIDSet(ok_angle);//設定初值
uart_init(112500);
time3_PWM_Init(5000,71); //不分頻。PWM頻率=72000000/900=80Khz 越大卻快(370-899)
}
int main()
{
Init();
while(1)
{
int pwm;
int right,left;
int dig_right,dig_left;
right=ok_angle+50;
left=ok_angle-50;
dig_right=ok_angle+500;
dig_left=ok_angle-2000;
adc_result = Get_Adc();
if(adc_result>=dig_left && adc_result<=dig_right )
{
LocP_I_D_Set(10,0,10); //PID參數的賦予
pwm=LocPIDCalc(adc_result);
DC_Set_Pwm(pwm);
if(pwm>999) pwm=999;
else if(pwm<-999) pwm=-999;
}
if(adc_result>=left&& adc_result<=right) DC_Set_Pwm(0); //降低靈敏性
if(adc_result>dig_right&& adc_result<4100) DC_Set_Pwm(0);
else if(adc_result<dig_left) DC_Set_Pwm(0);
printf("pwm==%d\r",pwm);
printf(" adc==%d\r\n",adc_result);
}
/*void renwu_2(void)
{
while(1)
{
int right,left;
int dig_right,dig_left;
right=ok_angle+5;
left=ok_angle-5;
dig_right=ok_angle+330;
dig_left=ok_angle-330;
adc_result = Get_Adc();
if((adc_result>0&&adc_result<dig_left)||(adc_result>dig_right&&adc_result<4100))
{
TIM_Cmd(TIM4, ENABLE); //使能TIM4
if(flag==1) DC_Set_Pwm(610);
else if(flag==2) DC_Set_Pwm(-610);
}
else if(adc_result>=dig_left && adc_result<=dig_right )
{
TIM_Cmd(TIM4, DISABLE); //關閉TIM4
number=0;
flag=0;
LocP_I_D_Set(20,2.1,80); //PID參數的賦予
pwm=LocPIDCalc(adc_result);
DC_Set_Pwm(pwm);
if(pwm>899) pwm=899;
else if(pwm<-899) pwm=-899;
if(adc_result>=left&& adc_result<=right) DC_Set_Pwm(0); //降低靈敏性
}
printf("adc==%d\r\n",adc_result);
}
}*/
}

復制代碼

ID:514559 · 發表于 2019-7-26 13:14

謝謝謝謝

ID:1 · 發表于 2019-7-27 00:38

本帖需要重新編輯補全電路原理圖,源碼,詳細說明與圖片即可獲得100+黑幣(帖子下方有編輯按鈕)

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

STM32倒立擺平衡源代碼