亚洲春色中文字幕久久久-三上亚,91精品国产亚一区二区三区,久久久九色综合亚洲成色777,涩涩视频下载,国产午夜亚洲精品午夜鲁丝片,国产精品A一区二区三区腾讯导航,影音先锋色情AV在线看片,蜜臀国产在线视频,极品少妇高潮啪啪无码吴梦梦 ,精品人妻无码一区二区三区手机版
標題:
MiniBalanceV3.5[大功率版]平衡小車庫函數(shù)版源碼(互補濾波1)
[打印本頁]
作者:
hcq...
時間:
2018-6-26 14:16
標題:
MiniBalanceV3.5[大功率版]平衡小車庫函數(shù)版源碼(互補濾波1)
平衡車代碼!
單片機源程序如下:
#include "stm32f10x.h"
#include "sys.h"
#include "motor.h"
/**************************************************************************
作者:平衡小車之家
**************************************************************************/
u8 Way_Angle=3; //獲取角度的算法,1:四元數(shù) 2:卡爾曼 3:互補濾波
u8 Flag_Qian,Flag_Hou,Flag_Left,Flag_Right,Flag_sudu=2; //藍牙遙控相關(guān)的變量
u8 Flag_Stop=1,Flag_Show=0; //停止標志位和 顯示標志位 默認停止 顯示打開
int Encoder_Left,Encoder_Right; //左右編碼器的脈沖計數(shù)
int Moto1,Moto2; //電機PWM變量 應(yīng)是Motor的 向Moto致敬
int Temperature; //顯示溫度
int Voltage; //電池電壓采樣相關(guān)的變量
float Angle_Balance,Gyro_Balance,Gyro_Turn; //平衡傾角 平衡陀螺儀 轉(zhuǎn)向陀螺儀
float Show_Data_Mb; //全局顯示變量,用于顯示需要查看的數(shù)據(jù)
u32 Distance; //超聲波測距
u8 delay_50,delay_flag,Bi_zhang=0; //默認情況下,不開啟避障功能,長按用戶按鍵2s以上可以進入避障模式
float Acceleration_Z; //Z軸加速度計
int main(void)
{
delay_init(); //=====延時函數(shù)初始化
// uart_init(128000); //=====串口初始化為
uart_init(9600);
JTAG_Set(JTAG_SWD_DISABLE); //=====關(guān)閉JTAG接口
JTAG_Set(SWD_ENABLE); //=====打開SWD接口 可以利用主板的SWD接口調(diào)試
// LED_Init(); //=====初始化與 LED 連接的硬件接口
// KEY_Init(); //=====按鍵初始化
MiniBalance_PWM_Init(7199,0); //=====初始化PWM 10KHZ,用于驅(qū)動電機 如需初始化電調(diào)接口
MiniBalance_Motor_Init();
uart3_init(9600); //=====串口3初始化
Encoder_Init_TIM2(); //=====編碼器接口
Encoder_Init_TIM4(); //=====初始化編碼器2
Adc_Init(); //=====adc初始化
IIC_Init(); //=====IIC初始化
MPU6050_initialize(); //=====MPU6050初始化
DMP_Init(); //=====初始化DMP
OLED_Init(); //=====OLED初始化
TIM3_Cap_Init(0XFFFF,72-1); //=====超聲波初始化
MiniBalance_EXTI_Init(); //=====MPU6050 5ms定時中斷初始化
while(1)
{
if(Flag_Show==0) //使用MiniBalanceV3.5 APP和OLED顯示屏
{
APP_Show();
oled_show(); //===顯示屏打開
}
else //使用MiniBalanceV3.5上位機 上位機使用的時候需要嚴格的時序,故此時關(guān)閉app監(jiān)控部分和OLED顯示屏
{
DataScope(); //開啟MiniBalanceV3.5上位機
}
delay_flag=1;
delay_50=0;
while(delay_flag); //通過MPU6050的INT中斷實現(xiàn)的50ms精準延時
}
}
復(fù)制代碼
所有資料51hei提供下載:
MiniBalanceV3.5【大功率版】平衡小車庫函數(shù)版源碼(互補濾波1).rar
(461.94 KB, 下載次數(shù): 25)
2018-6-27 01:39 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
作者:
云墜啊
時間:
2018-7-14 16:58
謝謝分享
歡迎光臨 (http://www.denmoz.com/bbs/)
Powered by Discuz! X3.1