积分商城

最新搜索： 应用分析精粹 编译软件 JESD79-3F 变送器 环路补偿 uvc
您现在的位置是：首页 > 技术资料 > 四轴同款传感器方案设计ICM20602+AK8975+SPL06-001
推荐星级：
  • 1
  • 2
  • 3
  • 4
  • 5

四轴同款传感器方案设计ICM20602+AK8975+SPL06-001

更新时间：2019-11-14 08:43:53 大小：1M 上传用户：liqiang9090查看TA发布的资源 标签：传感器 下载积分：2分 评价赚积分 （如何评价?） 打赏 收藏 评论(0) 举报

资料介绍

 四轴起飞时，发出触发信号使导航模块开始工作，同时读取ICM20602的加速度计、陀螺仪数据，对数据卡尔曼滤波后姿态解算，对角度与角速度采取串级PID调节。

控制系统算法设计主要有ICM20602滤波算法，姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限，下面介绍最重要的串级PID控制算法和定高部分控制算法。

地理坐标系中重力的水平分量为零，仅用三轴陀螺仪和三轴加速度计无法计算出航向角，由于巡线机器人保持稳定飞行只需要横滚角（roll）和俯仰角（pitch），所以四元数转换成欧拉角。

定高控制算法采用的是增量式PID控制，定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波，采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值，即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制，其中欧拉角作为外环，角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。


部分文件列表

文件名大小
ahrs/
ahrs/ahrs.uvguix.12531
ahrs/ahrs.uvoptx
ahrs/ahrs.uvprojx
ahrs/driver/
ahrs/driver/ak8975.c2KB
ahrs/driver/ak8975.h
ahrs/driver/icm20602.c7KB
ahrs/driver/icm20602.h2KB
ahrs/driver/myiic.c
ahrs/driver/myiic.h3KB
...

【关注视频号领20积分】   【关注公众号立即送20积分】

相关下载

全部评论(0)

暂无评论
评论赚积分>>

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

热门标签

更多>>

最新上传

  • 打赏
  • 30日榜单

热门下载

推荐下载

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

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

京ICP备11013301号

京公网安备 11010802024343号