积分商城

最新搜索： 海尔单片机 SX1278 创龙 RK3562 绝缘电阻表 ADP32 芯片包
您现在的位置是：首页 > 技术资料 > 陀螺和加速度核心程序详解
推荐星级：
  • 1
  • 2
  • 3
  • 4
  • 5

陀螺和加速度核心程序详解

更新时间：2018-07-31 22:45:08 大小：61K 上传用户：潜力变实力查看TA发布的资源 标签：陀螺加速度程序 下载积分：5分 评价赚积分 （如何评价?） 打赏 收藏 评论(1) 举报

资料介绍

// 叉积法融合陀螺和加速度。
void mix_gyrAcc_crossMethod(quaternion_yuandian * attitude,const float gyr[3],const float acc[3],float interval)
{
const static float FACTOR = 0.001;//两个重力矢量叉积后所乘的系数 p，用于和陀螺仪积分角度相叠加来修正陀螺仪（这里只用了比例 p，没用积分 i， ）
//FACTOR 为 1，则完全信任加速度计，为 0，则完全信任陀螺仪
float w_q = attitude->w;//w=cos(alpha/2)
float x_q = attitude->x;//x=ax*sin(alpha/2)
float y_q = attitude->y;//y=ay*sin(alpha/2)
float z_q = attitude->z;//z=az*sin(alpha/2)
float x_q_2 = x_q * 2;
float y_q_2 = y_q * 2;
float z_q_2 = z_q * 2;
//
// 加速度计的读数，单位化。
float a_rsqrt = math_rsqrt(acc[0]*acc[0]+acc[1]*acc[1]+acc[2]*acc[2]);
float x_aa = acc[0] * a_rsqrt;
float y_aa = acc[1] * a_rsqrt;
float z_aa = acc[2] * a_rsqrt;    


部分文件列表

文件名文件大小修改时间
陀螺和加速度核心程序详解.pdf63KB2018-07-31 22:43:42

【关注B站账户领20积分】

相关下载

全部评论(1)

  • 2023-02-14 15:19:24wzszzxj

    厉害，学习了

评论赚积分>>

上传资源 上传优质资源有赏金

热门标签

更多>>

最新上传

  • 打赏
  • 30日榜单

热门下载

资料专题

推荐下载

本站上的所有资源均为源于网上收集或者由用户自行上传，仅供学习和研究使用，无任何商业目的，版权归原作如有侵权，请 来信指出，本站将立即改正。

ICP许可证号：京ICP证070360号     21IC电子网 2000- 版权所有

京ICP备11013301号

京公网安备 11010802024343号