MPU6050匿名小四軸飛控源碼資料包 bee_source好用版

ID:194383 · 發表于 2017-5-5 22:19

新手來分享一下！互相學習，MPU6050 bee_source好用版，
編譯,下載,運行,連接飛控串口和FTDI串口,串口波特率500K,上位機打開高級收碼,在上位機飛控狀態標簽可以看到變化的傳感器數據,3D顯示可以跟隨roll和pitch的變化而變化,因為沒有寫yaw的上傳,所以yaw保持零度...此時打開飛控波形按鈕,打開波形顯示頁面,并打開相應波形開關,1到3為加速度,4到6為陀螺儀,10和11為roll和pitch,就可以看到變化的波形.

完整代碼下載：

bee_source好用版.7z (578.51 KB, 下載次數: 79)

2017-5-5 22:18 上傳

點擊文件名下載附件
bee系

stm32源程序：

#include "MPU6050.h"
#include "ANO_Tech_STM32F10x_I2C.h"
#include "tim.h"
u8 mpu6050_buffer[14]; //iic讀取后存放數據
S_INT16_XYZ GYRO_OFFSET,ACC_OFFSET; //零漂
u8 GYRO_OFFSET_OK = 1;
u8 ACC_OFFSET_OK = 1;
S_INT16_XYZ MPU6050_ACC_LAST,MPU6050_GYRO_LAST; //最新一次讀取值
void Delay_ms_mpu(u16 nms)
{
u8 delay_cnt = TIM3_IRQCNT;
while((delay_cnt+(nms*2)) > TIM3_IRQCNT);
}
/**************************實現函數********************************************
//將iic讀取到得數據分拆,放入相應寄存器
*******************************************************************************/
void MPU6050_Dataanl(void)
{
MPU6050_ACC_LAST.X=((((int16_t)mpu6050_buffer[0]) << 8) | mpu6050_buffer[1]) - ACC_OFFSET.X;
MPU6050_ACC_LAST.Y=((((int16_t)mpu6050_buffer[2]) << 8) | mpu6050_buffer[3]) - ACC_OFFSET.Y;
MPU6050_ACC_LAST.Z=((((int16_t)mpu6050_buffer[4]) << 8) | mpu6050_buffer[5]) - ACC_OFFSET.Z;
//跳過溫度ADC
MPU6050_GYRO_LAST.X=((((int16_t)mpu6050_buffer[8]) << 8) | mpu6050_buffer[9]) - GYRO_OFFSET.X;
MPU6050_GYRO_LAST.Y=((((int16_t)mpu6050_buffer[10]) << 8) | mpu6050_buffer[11]) - GYRO_OFFSET.Y;
MPU6050_GYRO_LAST.Z=((((int16_t)mpu6050_buffer[12]) << 8) | mpu6050_buffer[13]) - GYRO_OFFSET.Z;
if(!GYRO_OFFSET_OK)
{
static int32_t tempgx=0,tempgy=0,tempgz=0;
static uint8_t cnt_g=0;
// LED1_ON;
if(cnt_g==0)
{
GYRO_OFFSET.X=0;
GYRO_OFFSET.Y=0;
GYRO_OFFSET.Z=0;
tempgx = 0;
tempgy = 0;
tempgz = 0;
cnt_g = 1;
return;
}
tempgx+= MPU6050_GYRO_LAST.X;
tempgy+= MPU6050_GYRO_LAST.Y;
tempgz+= MPU6050_GYRO_LAST.Z;
if(cnt_g==200)
{
GYRO_OFFSET.X=tempgx/cnt_g;
GYRO_OFFSET.Y=tempgy/cnt_g;
GYRO_OFFSET.Z=tempgz/cnt_g;
cnt_g = 0;
GYRO_OFFSET_OK = 1;
// EE_SAVE_GYRO_OFFSET();//保存數據
return;
}
cnt_g++;
}
if(!ACC_OFFSET_OK)
{
static int32_t tempax=0,tempay=0,tempaz=0;
static uint8_t cnt_a=0;
// LED1_ON;
if(cnt_a==0)
{
ACC_OFFSET.X = 0;
ACC_OFFSET.Y = 0;
ACC_OFFSET.Z = 0;
tempax = 0;
tempay = 0;
tempaz = 0;
cnt_a = 1;
return;
}
tempax+= MPU6050_ACC_LAST.X;
tempay+= MPU6050_ACC_LAST.Y;
//tempaz+= MPU6050_ACC_LAST.Z;
if(cnt_a==200)
{
ACC_OFFSET.X=tempax/cnt_a;
ACC_OFFSET.Y=tempay/cnt_a;
ACC_OFFSET.Z=tempaz/cnt_a;
cnt_a = 0;
ACC_OFFSET_OK = 1;
// EE_SAVE_ACC_OFFSET();//保存數據
return;
}
cnt_a++;
}
}
/**************************實現函數********************************************
//將iic讀取到得數據分拆,放入相應寄存器,更新MPU6050_Last
*******************************************************************************/
void MPU6050_Read(void)
{
ANO_Tech_I2C1_Read_Int(devAddr,MPU6050_RA_ACCEL_XOUT_H,14,mpu6050_buffer);
}
/**************************實現函數********************************************
*函數原型: u8 IICwriteBit(u8 dev, u8 reg, u8 bitNum, u8 data)
*功　　能: 讀修改寫指定設備指定寄存器一個字節中的1個位
輸入 dev 目標設備地址
reg 寄存器地址
bitNum 要修改目標字節的bitNum位
data 為0 時，目標位將被清0 否則將被置位
返回成功為1
失敗為0
*******************************************************************************/
void IICwriteBit(u8 dev, u8 reg, u8 bitNum, u8 data){
u8 b;
ANO_Tech_I2C1_Read_Buf(dev, reg, 1, &b);
b = (data != 0) ? (b | (1 << bitNum)) : (b & ~(1 << bitNum));
ANO_Tech_I2C1_Write_1Byte(dev, reg, b);
}
/**************************實現函數********************************************
*函數原型: u8 IICwriteBits(u8 dev,u8 reg,u8 bitStart,u8 length,u8 data)
*功　　能: 讀修改寫指定設備指定寄存器一個字節中的多個位
輸入 dev 目標設備地址
reg 寄存器地址
bitStart 目標字節的起始位
length 位長度
data 存放改變目標字節位的值
返回成功為1
失敗為0
*******************************************************************************/
void IICwriteBits(u8 dev,u8 reg,u8 bitStart,u8 length,u8 data)
{
u8 b,mask;
ANO_Tech_I2C1_Read_Buf(dev, reg, 1, &b);
mask = (0xFF << (bitStart + 1)) | 0xFF >> ((8 - bitStart) + length - 1);
data <<= (8 - length);
data >>= (7 - bitStart);
b &= mask;
b |= data;
ANO_Tech_I2C1_Write_1Byte(dev, reg, b);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_setClockSource(uint8_t source)
*功　　能: 設置 MPU6050 的時鐘源
* CLK_SEL | Clock Source
* --------+--------------------------------------
* 0 | Internal oscillator
* 1 | PLL with X Gyro reference
* 2 | PLL with Y Gyro reference
* 3 | PLL with Z Gyro reference
* 4 | PLL with external 32.768kHz reference
* 5 | PLL with external 19.2MHz reference
* 6 | Reserved
* 7 | Stops the clock and keeps the timing generator in reset
*******************************************************************************/
void MPU6050_setClockSource(uint8_t source){
IICwriteBits(devAddr, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_CLKSEL_BIT, MPU6050_PWR1_CLKSEL_LENGTH, source);
}
/** Set full-scale gyroscope range.
* @param range New full-scale gyroscope range value
* @see getFullScaleRange()
* @see MPU6050_GYRO_FS_250
* @see MPU6050_RA_GYRO_CONFIG
* @see MPU6050_GCONFIG_FS_SEL_BIT
* @see MPU6050_GCONFIG_FS_SEL_LENGTH
*/
void MPU6050_setFullScaleGyroRange(uint8_t range) {
IICwriteBits(devAddr, MPU6050_RA_GYRO_CONFIG, MPU6050_GCONFIG_FS_SEL_BIT, MPU6050_GCONFIG_FS_SEL_LENGTH, range);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_setFullScaleAccelRange(uint8_t range)
*功　　能: 設置 MPU6050 加速度計的最大量程
*******************************************************************************/
void MPU6050_setFullScaleAccelRange(uint8_t range) {
IICwriteBits(devAddr, MPU6050_RA_ACCEL_CONFIG, MPU6050_ACONFIG_AFS_SEL_BIT, MPU6050_ACONFIG_AFS_SEL_LENGTH, range);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_setSleepEnabled(uint8_t enabled)
*功　　能: 設置 MPU6050 是否進入睡眠模式
enabled =1 睡覺
enabled =0 工作
*******************************************************************************/
void MPU6050_setSleepEnabled(uint8_t enabled) {
IICwriteBit(devAddr, MPU6050_RA_PWR_MGMT_1, MPU6050_PWR1_SLEEP_BIT, enabled);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_setI2CMasterModeEnabled(uint8_t enabled)
*功　　能: 設置 MPU6050 是否為AUX I2C線的主機
*******************************************************************************/
void MPU6050_setI2CMasterModeEnabled(uint8_t enabled) {
IICwriteBit(devAddr, MPU6050_RA_USER_CTRL, MPU6050_USERCTRL_I2C_MST_EN_BIT, enabled);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_setI2CBypassEnabled(uint8_t enabled)
*功　　能: 設置 MPU6050 是否為AUX I2C線的主機
*******************************************************************************/
void MPU6050_setI2CBypassEnabled(uint8_t enabled) {
IICwriteBit(devAddr, MPU6050_RA_INT_PIN_CFG, MPU6050_INTCFG_I2C_BYPASS_EN_BIT, enabled);
}
void MPU6050_setDLPF(uint8_t mode)
{
IICwriteBits(devAddr, MPU6050_RA_CONFIG, MPU6050_CFG_DLPF_CFG_BIT, MPU6050_CFG_DLPF_CFG_LENGTH, mode);
}
/**************************實現函數********************************************
*函數原型: void MPU6050_initialize(void)
*功　　能: 初始化 MPU6050 以進入可用狀態。
*******************************************************************************/
void MPU6050_Init(void)
{
ANO_Tech_I2C1_Write_1Byte(0xd0,0x19,0x07);//1khz
…………限于本文篇幅余下代碼請從51黑下載附件…………

復制代碼

ID:1 · 發表于 2017-5-5 23:06

好資料，51黑有你更精彩。

ID:194383 · 發表于 2017-5-7 22:50

admin 發表于 2017-5-5 23:06
好資料，51黑有你更精彩。

那才給那么低的分

ID:221145 · 發表于 2017-10-16 17:32

好資料

ID:305368 · 發表于 2018-9-9 15:52

好資料

ID:305368 · 發表于 2018-9-9 15:53

好資料，優秀

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

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

MPU6050匿名小四軸飛控源碼資料包 bee_source好用版

評分

相關帖子