欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標(biāo)題: stm32 mpu6050測(cè)試代碼 [打印本頁]
作者: blackantywj123    時(shí)間: 2018-11-17 22:35
標(biāo)題: stm32 mpu6050測(cè)試代碼

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


單片機(jī)源程序如下:

  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "key.h"
  5. #include "usart.h"
  6. #include "MPU6050.h"
  7. #include "HMC5883L.h"


  10. int16_t ax, ay, az;       
  11. int16_t gx, gy, gz;
  12. int16_t hx, hy, hz;
  13. int16_t hmcvalue[3],XA;

  15. u8        hbuffer[6];
  16. u8         abuffer[6];
  17. float sum=0,sum1=0,sum2=0;       

  19. int main(void)
  20. {
  21.         u8 t;
  22.         u8 len;       
  23.         u16 times=0;  
  24.         u8 X[6],A[10];
  25.         u8 AX[6],AY[6],AZ[6],HX[6],HY[6],HZ[6];  //測(cè)試用
  26.         float angle,direction;       
  27.         SystemInit();//系統(tǒng)時(shí)鐘等初始化
  28.         delay_init(72);             //延時(shí)初始化
  29.         NVIC_Configuration();//設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級(jí)，2位響應(yīng)優(yōu)先級(jí)
  30.         IIC_Init();         //初始化I2C接口
  31.         uart_init(115200);//串口初始化為9600
  32.         LED_Init();         //LED端口初始化115200
  33.         MPU6050_initialize();
  34.         HMC5883L_SetUp();
  35.         delay_ms(50);
  36.         HMC5883L_SetUp();
  37.         IICreadBytes(devAddr, MPU6050_RA_ACCEL_XOUT_H, 2, abuffer);
  38.         XA=(((int16_t)abuffer[0]) << 8) | abuffer[1];
  39.         while(1)
  40.         {
  41.                 IICreadBytes(devAddr, MPU6050_RA_ACCEL_XOUT_H, 6, abuffer);
  42.                 ax=(((int16_t)abuffer[0]) << 8) | abuffer[1];
  43.                 ay=(((int16_t)abuffer[2]) << 8) | abuffer[3];
  44.                 az=(((int16_t)abuffer[4]) << 8) | abuffer[5];
  45.                 sum=(39.2/65536.0)*(ax-XA);
  46.                 sum1=ax*0.0025;
  47.                 sum2+=sum1;
  48.                 IICreadBytes(HMC58X3_ADDR,HMC58X3_R_XM,6,hbuffer);
  49.                 hx=(((int16_t)hbuffer[0]) << 8) | hbuffer[1];
  50.                 hz=(((int16_t)hbuffer[2]) << 8) | hbuffer[3];
  51.                 hy=(((int16_t)hbuffer[4]) << 8) | hbuffer[5];
  52.                
  53. //                acc_x= GetData(ACCEL_XOUT_H);
  54. //                acc_y= GetData(ACCEL_YOUT_H);
  55. //                acc_z= GetData(ACCEL_ZOUT_H);
  56. //                gy_x= GetData(GYRO_XOUT_H);
  57. //                gy_y= GetData(GYRO_YOUT_H);
  58. //                gy_z= GetData(GYRO_ZOUT_H);

  60.                 printf("ACC:  X=%d   Y=%d   Z=%d  \n",ax,ay,az);
  61.                 printf("GYRO:  X=%d   Y=%d   Z=%d  \n",hx,hy,hz);
  62.                 delay_ms(500);   
  63.         }         

  65. }
復(fù)制代碼

所有資料51hei提供下載:

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









歡迎光臨 (http://m.raoushi.com/bbs/) Powered by Discuz! X3.1