四轴起飞时,发出触发信号使导航模块开始工作,同时读取ICM20602的加速度计、陀螺仪数据,对数据卡尔曼滤波后姿态解算,对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法,姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限,下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零,仅用三轴陀螺仪和三轴加速度计无法计算出航向角,由于巡线机器人保持稳定飞行只需要横滚角(roll)和俯仰角(pitch),所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制,定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波,采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值,即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制,其中欧拉角作为外环,角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签: 传感器
上传时间: 2022-06-24
上传用户:默默
ADIADXL362微功耗三轴MEMS加速度计解决方案
上传时间: 2022-07-05
上传用户:canderile
加速度计与陀螺仪互补滤波与卡尔曼滤波核心程序
上传时间: 2022-07-06
上传用户:qingfengchizhu
STM32控制 MPU6050 六轴陀螺仪原理图及PCB截图源码
标签: stm32 mpu6050 六轴陀螺仪 原理图 pcb
上传时间: 2022-07-19
上传用户:
ADIS16480是一款MEMS惯性测量单元(IMU),内置一个三轴加速度计、一个三轴陀螺仪、一个三轴磁力计和一个气压计。除了提供完全校准、帧同步的惯性MEMS传感器,ADIS16480还集成了一个扩展卡尔曼滤波器(EKF),可计算动态方位角。
上传时间: 2013-10-22
上传用户:上善若水
才接触四轴飞行,关于陀螺仪资料分享!共同学习。。
标签: 陀螺仪
上传时间: 2013-11-07
上传用户:dajin
陀螺仪应用开发调试学习 三轴 加速度感应
上传时间: 2018-07-17
上传用户:723966145
STM32L475开发板PDF原理图+AD集成3D封装库+主要器件技术手册,集成封装库型号列表如下:Library Component Count : 44Name Description----------------------------------------------------------------------------------------------------ANT-2.4G ANT,2.4G,PCB天线ATK-TEST-1*4-2.54mm 测试点ATK_MODULE 单排母,1*6,2.54mmBEEP 3.3V有源蜂鸣器BUTTON_DIP3 拨动开关SS-12F44C-0402-SMD C-0603-SMD C-CAP-SMD-220uF/10V C-CEP-220uF/16V D-1N4148 Header-1*3-2.54mm 单排针-2.54mmHeader-2*10-2.54mm 双排针-2.54mmHeader-2*2-2.54mm 双排针-2.54mmHeader-2*3-2.54mm 双排针-2.54mmHeader-2*4-2.54mm 双排座-2.54mmIR-LED 1206红外发射管(侧)IR-LF0038GKLL-1 红外接收管SMDJ-MICRO-USB-5S Micro USB 5.9有柱脚长1.25加长针L-0420-4.7uH 电感,4.7uH,3ALCD-TFT-H13TS38A LCD,TFT,1.3'240*240,禹龙LED-0603-RED 发光二极管-红色LED-RGB-1615-0603 RGB,共阳,1615,0603MIC-6022 MICMotor-SMD 电机,SMDPhone-3-M 耳机座,三节R-0402-SMD 贴片电阻R-0805-SMD 贴片电阻RT9193-3.3S-KEY-SMD-324225 KEY,SMD,324225S8050-SMD SD-MICRO-TF SD,MICRO,TFU-AHT10 Sensor,温湿度传感器U-AP3216C Sensor.光照/距离U-AP6181 WIFI Module,SDIOU-ES8388 AUDIO,2-ch DAC,2-ch ADCU-ICM-20608 三轴陀螺仪/三轴加速度计,U-L9110S 电机驱动,800mAU-RT9013-3.3 LDO,500mAU-STM32F103C8T6 U-STM32L475VET6 MCU,LQFP100,512K FLASH,128K RAMU-W25Q128 SPI FLASH,16MY-12M-SMD 晶振 - 12M贴片Y-3215-32.768K XTAL,3215,32.768KY-3215-8M XTAL,3215,8MHz
上传时间: 2021-12-15
上传用户:
人口老龄化是世界各国正在面对的一个普遍问题。随着我国老龄化程度的持续加剧,对于老年人群体的医疗资源投入会不断提高。而与此同时,跌倒已经成为老年人日常生活中最为常见的危险行为活动。所以,跌倒检测系统的研究和应用对降低老年人受到的身心伤害和医疗成本具有显著的意义。目前解决老年人跌倒检测的方案仍存在许多不足。其中,基于计算机视觉的跌倒检测技术在无干扰的场景下检测较为有效,但其易受环境变化(如背景光线影响、人遮挡问题等)影响。此外,基于可穿戴计算的跌倒检测技术受限于算法稳定性和识别准确率,系统的灵敏度和特异性难以同时得到保证。针对上述问题本文提出一种融合计算机视觉和可穿戴计算数据的跌倒检测新的方法。首先,设计并开发了集成三轴加速度计、三轴陀螺仪和蓝牙的活动感知模块,实现实时采集、传输人体活动数据:其次,使用深度学习算法从摄像头采集的图像数据提取人体姿态特征数据:最后,对采集的人体活动数据和姿态数据进行规范化和时序化处理,设计了两个深度学习网络分别对数据进行特征提取,并将两特征进行特征层数据融合,在此基础上构建神经网络对融合数据进行活动本文搭建了实验平台并进行了算法测试,其中,本文跌倒检测算法针对离线测试数据的准确率为992%,平均敏感度为995%、平均特异性为99.8%:针对在线数据系统测试准确率为98.9%、平均敏感度为99.2%、平均特异性为99.5%实验结果证明了利用计算机视觉和可穿戴计算数据融合的跌倒检测具有较高的准确率和鲁棒性。
上传时间: 2022-03-14
上传用户:bluedrops
最完整的基于stm32的3轴云台开源程序EvvGC,包含MPU6050检测加速度和陀螺仪,并对3轴的3个电机进行控制
标签: stm32
上传时间: 2022-05-19
上传用户:jason_vip1