标题: ADXL345+ITG3205引脚图与电路原理图等资料 九轴传感器程序与芯片数据手册GY-85 [打印本页]
作者: 犯二的Huskie    时间: 2017-11-27 16:37
标题: ADXL345+ITG3205引脚图与电路原理图等资料 九轴传感器程序与芯片数据手册GY-85
GY-85九轴传感器资料


模块的原理图：


ADXL345是一款小而薄的超低功耗3轴加速度计，分辨率高(13位)，测量范围达±  16g。数字输出数据为16位二进制补码格式，可通过SPI(3线或4线)或I2C数字接口访问。
ADXL345非常适合移动设备应用。它可以在倾斜检测应用中测量静态重力加速度，还可以测量运动或冲击导致的动态加速度。其高分辨率(3.9mg/LSB)，能够测量不到1.0°的倾斜角度变化。
该器件提供多种特殊检测功能。活动和非活动检测功能通过比较任意轴上的加速度与用户设置的阈值来检测有无运动发生。敲击检测功能可以检测任意方向的单振和双振动作。自由落体检测功能可以检测器件是否正在掉落。这些功能可以独立映射到两个中断输出引脚中的一个。正在申请专利的集成式存储器管理系统采用一个32级先进先出(FIFO)缓冲器，可用于存储数据，从而将主机处理器负荷降至最低，并降低整体系统功耗。

ADXL345引脚图与中文资料PDF：


HMC5883L中文规格书.pdf：


ITG3205引脚图：


ITG3205应用电路：


HMC5883L资料：


单片机源程序如下:
  1. #include "IMU.h"
  2. #include "ADXL345.h"
  3. #include "ITG3205.h"
  4. #include "arm_math.h"
  5. #include <math.h>

  7. struct IMU_Data MyIMU={0,0,0};

  9. float ADXL_X=0,ADXL_Y=0,ADXL_Z=0;
  10. float ITG_X=0,ITG_Y=0,ITG_Z=0;
  11. short GetX,GetY,GetZ;

  13. void TIM4_IRQHandler(void)
  14. {
  15.         if(TIM_GetITStatus(TIM4,TIM_IT_Update)==SET)
  16.         {
  17.                 TIM_ClearFlag(TIM4,TIM_FLAG_Update);
  18.                 IMU_Update();
  19.         }
  20. }

  22. ////////////////////////////////////////////////////////////////////////////////
  23. #define Kp 10.0f                        // proportional gain governs rate of convergence to accelerometer/magnetometer
  24. #define Ki 0.008f                          // integral gain governs rate of convergence of gyroscope biases
  25. #define halfT 0.0025f                   // half the sample period采样周期的一半

  27. float q0 = 1, q1 = 0, q2 = 0, q3 = 0;    // quaternion elements representing the estimated orientation
  28. float exInt = 0, eyInt = 0, ezInt = 0;    // scaled integral error
  29. void IMUupdate(float gx, float gy, float gz, float ax, float ay, float az)
  30. {
  31.         float norm;
  32.         float vx, vy, vz;// wx, wy, wz;
  33.         float ex, ey, ez;

  35.         float q0q0 = q0*q0;
  36.         float q0q1 = q0*q1;
  37.         float q0q2 = q0*q2;
  38. //  float q0q3 = q0*q3;
  39.         float q1q1 = q1*q1;
  40. //  float q1q2 = q1*q2;
  41.         float q1q3 = q1*q3;
  42.         float q2q2 = q2*q2;
  43.         float q2q3 = q2*q3;
  44.         float q3q3 = q3*q3;

  46.         if(ax*ay*az==0)
  47.                 return;

  49.         norm = __sqrtf(ax*ax + ay*ay + az*az);//acc数据归一化
  50.         ax = ax /norm;
  51.         ay = ay / norm;
  52.         az = az / norm;

  54.         // estimated direction of gravity and flux (v and w)              估计重力方向和流量/变迁
  55.         vx = 2*(q1q3 - q0q2);//四元素中xyz的表示
  56.         vy = 2*(q0q1 + q2q3);
  57.         vz = q0q0 - q1q1 - q2q2 + q3q3 ;

  59.         // error is sum of cross product between reference direction of fields and direction measured by sensors
  60.         ex = (ay*vz - az*vy) ;//向量外积在相减得到差分就是误差
  61.         ey = (az*vx - ax*vz) ;
  62.         ez = (ax*vy - ay*vx) ;

  64.         exInt = exInt + ex * Ki;//对误差进行积分
  65.         eyInt = eyInt + ey * Ki;
  66.         ezInt = ezInt + ez * Ki;

  68.         // adjusted gyroscope measurements
  69.         gx = gx + Kp*ex + exInt;//将误差PI后补偿到陀螺仪，即补偿零点漂移
  70.         gy = gy + Kp*ey + eyInt;
  71.         gz = gz + Kp*ez + ezInt;//这里的gz由于没有观测者进行矫正会产生漂移，表现出来的就是积分自增或自减

  73.         // integrate quaternion rate and normalise//四元素的微分方程
  74.         q0 = q0 + (-q1*gx - q2*gy - q3*gz)*halfT;
  75.         q1 = q1 + (q0*gx + q2*gz - q3*gy)*halfT;
  76.         q2 = q2 + (q0*gy - q1*gz + q3*gx)*halfT;
  77.         q3 = q3 + (q0*gz + q1*gy - q2*gx)*halfT;

  79.         // normalise quaternion
  80.         norm = __sqrtf(q0*q0 + q1*q1 + q2*q2 + q3*q3);
  81.         q0 = q0 / norm;
  82.         q1 = q1 / norm;
  83.         q2 = q2 / norm;
  84.         q3 = q3 / norm;

  86.         MyIMU.Yaw = atan2(2 * q1 * q2 + 2 * q0 * q3, -2 * q2*q2 - 2 * q3* q3 + 1)* 57.3; // yaw
  87.         MyIMU.Pitch  = asin(-2 * q1 * q3 + 2 * q0* q2)* 57.3; // pitch
  88.         MyIMU.Roll = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2* q2 + 1)* 57.3; // roll
  89.         
  90.         /*if(GYRO_I.Z>=360)GYRO_I.Z=0;
  91.         Q_ANGLE.Z = GYRO_I.Z;*/
  92. }

  94. //#define NUMOFALL 8

  96. //short ADXL_X_Buf[NUMOFALL];
  97. //short ADXL_Y_Buf[NUMOFALL];
  98. //short ADXL_Z_Buf[NUMOFALL];
  99. //int ADXL_SumX=0,ADXL_SumY=0,ADXL_SumZ=0;
  100. //short ADXL_CurNum=0;
  101. void IMU_Update(void)
  102. {
  103.         ITG3205_ReadXYZ(&GetX,&GetY,&GetZ);//-27 13 5
  104.         GetX-=-27;GetY-=13;GetZ-=5;
  105.         ITG_X = (float)GetX/14.375/57.325;//14.375是转换为度每秒(来自与手册资料)  57.325是转换为弧度每秒(来源于180/π)
  106.         ITG_Y = (float)GetY/14.375/57.325;
  107.         ITG_Z = (float)GetZ/14.375/57.325;
  108.         
  109.         ADXL345_ReadXYZ(&GetX,&GetY,&GetZ);
  110.         
  111. //        ADXL_SumX-=ADXL_X_Buf[ADXL_CurNum];
  112. //        ADXL_SumY-=ADXL_Y_Buf[ADXL_CurNum];
  113. //        ADXL_SumZ-=ADXL_Z_Buf[ADXL_CurNum];
  114. //        
  115. ……………………

  117. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
GY-85发送资料.rar (12.95 MB, 下载次数: 72)


作者: donssn17989217    时间: 2018-4-15 04:12
好资料！学习学习！！！
作者: 年少有点狂    时间: 2018-10-8 14:56
学习学习
作者: 660022    时间: 2019-7-13 14:15
好资料！学习学习！！！
作者: 五五开    时间: 2020-2-27 18:17
好资料，多谢楼主！



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1