stm32 mpu6050測試代碼

ID:371542 · 發(fā)表于 2018-11-17 22:35

stm32 mpu6050測試代碼陀螺儀數(shù)據(jù)接受有問題還要大佬們再調(diào)調(diào)看

單片機源程序如下:

#include "led.h"
#include "delay.h"
#include "sys.h"
#include "key.h"
#include "usart.h"
#include "MPU6050.h"
#include "HMC5883L.h"
int16_t ax, ay, az;
int16_t gx, gy, gz;
int16_t hx, hy, hz;
int16_t hmcvalue[3],XA;
u8 hbuffer[6];
u8 abuffer[6];
float sum=0,sum1=0,sum2=0;
int main(void)
{
u8 t;
u8 len;
u16 times=0;
u8 X[6],A[10];
u8 AX[6],AY[6],AZ[6],HX[6],HY[6],HZ[6]; //測試用
float angle,direction;
SystemInit();//系統(tǒng)時鐘等初始化
delay_init(72); //延時初始化
NVIC_Configuration();//設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應(yīng)優(yōu)先級
IIC_Init(); //初始化I2C接口
uart_init(115200);//串口初始化為9600
LED_Init(); //LED端口初始化115200
MPU6050_initialize();
HMC5883L_SetUp();
delay_ms(50);
HMC5883L_SetUp();
IICreadBytes(devAddr, MPU6050_RA_ACCEL_XOUT_H, 2, abuffer);
XA=(((int16_t)abuffer[0]) << 8) | abuffer[1];
while(1)
{
IICreadBytes(devAddr, MPU6050_RA_ACCEL_XOUT_H, 6, abuffer);
ax=(((int16_t)abuffer[0]) << 8) | abuffer[1];
ay=(((int16_t)abuffer[2]) << 8) | abuffer[3];
az=(((int16_t)abuffer[4]) << 8) | abuffer[5];
sum=(39.2/65536.0)*(ax-XA);
sum1=ax*0.0025;
sum2+=sum1;
IICreadBytes(HMC58X3_ADDR,HMC58X3_R_XM,6,hbuffer);
hx=(((int16_t)hbuffer[0]) << 8) | hbuffer[1];
hz=(((int16_t)hbuffer[2]) << 8) | hbuffer[3];
hy=(((int16_t)hbuffer[4]) << 8) | hbuffer[5];
// acc_x= GetData(ACCEL_XOUT_H);
// acc_y= GetData(ACCEL_YOUT_H);
// acc_z= GetData(ACCEL_ZOUT_H);
// gy_x= GetData(GYRO_XOUT_H);
// gy_y= GetData(GYRO_YOUT_H);
// gy_z= GetData(GYRO_ZOUT_H);
printf("ACC: X=%d Y=%d Z=%d \n",ax,ay,az);
printf("GYRO: X=%d Y=%d Z=%d \n",hx,hy,hz);
delay_ms(500);
}
}

復(fù)制代碼

所有資料51hei提供下載:

MPU6050.rar (302.78 KB, 下載次數(shù): 7)

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

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

stm32 mpu6050測試代碼