四轴起飞时,发出触发信号使导航模块开始工作,同时读取ICM20602的加速度计、陀螺仪数据,对数据卡尔曼滤波后姿态解算,对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法,姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限,下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零,仅用三轴陀螺仪和三轴加速度计无法计算出航向角,由于巡线机器人保持稳定飞行只需要横滚角(roll)和俯仰角(pitch),所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制,定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波,采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值,即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制,其中欧拉角作为外环,角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签: 传感器
上传时间: 2022-06-24
上传用户:默默
该板是MikroKopter 四轴飞行器的控制板。它可以实现下列任务:• 测量三轴角速度• 测量三轴加速度数据• 测量大气压力,用于高度控制• 接收数字罗盘信号• 测量电池电压• 接收R/C 信号• 处理传感器数据以及计算真实角位置• 驱动四个无刷电调尺寸50 * 50mm• 两个LED(如显示正确和错误)• 两个三极管,输出到外部灯(或其他功能)• 低压检测• 为接收机提供5V 电压三轴磁阻传感器和ASIC 都被封装在3.0×3.0×0.9mm LCC 表面装配中► 12-bit ADC 与低干扰AMR 传感器,能在±8 高斯的磁场中实现5 毫高斯分辨率► 内置自检功能► 低 电压工作(2.16-3.6V) 和超低功耗(100uA)► 内置驱动电路► I2C 数字接口► 无引线封装结构► 磁场范围广(+/-8Oe)
标签: 四轴飞行器
上传时间: 2022-07-23
上传用户:
STM推出一款全新数字信号输出三轴加速传感器。新产品的最大可测量值达到24g,相当于一级方程式赛车(F1)在强劲刹车时产生的加速度的5倍左右。LIS331HH拥有市场上独一无二的性能组合,包括10g以上量程,紧凑的尺寸,高分辨率,低功耗,以及嵌入式智能功能,可在广泛的消费电子和工业应用中实现高精确度的运动测量。 在±6/±12/±24g的全量程范围内,意法半导体最新的MEMS加速传感器LIS331HH的输出数据极其精确。LIS331HH的中g传感能够测量高强度震动,检测剧烈碰撞事件,不会丢失任何信息。在与游戏相关的应用中,中g检测器可提升用户界面体验,增加以前感受不到的真实程度
标签:
上传时间: 2013-04-24
上传用户:xzt
ADXL345是一款小巧纤薄的低功耗三轴加速度计,可以对高达±16 g的加速度进行高分辨率(13位)测量。数字输出数据为16位二进制补码格式,可通过SPI(3线或4线)或者I2C数字接口访问。
上传时间: 2014-12-23
上传用户:Andy123456
ADIS16480是一款MEMS惯性测量单元(IMU),内置一个三轴加速度计、一个三轴陀螺仪、一个三轴磁力计和一个气压计。除了提供完全校准、帧同步的惯性MEMS传感器,ADIS16480还集成了一个扩展卡尔曼滤波器(EKF),可计算动态方位角。
上传时间: 2013-10-22
上传用户:上善若水
提出了一个具有跌倒定位和远程报警功能的无线跌倒监控系统。跌倒监测是基于人体跌倒过程中加速度曲线的变化特性,由三轴加速度传感器和ARM处理器实现;同时介绍了一种新颖的基于ZigBee的定位方法,当监测到人体跌倒时, 一个带有跌倒位置的报警信息将立即发送到医护人员的移动手机上。实验结果表明,本系统可以100%监测到人体跌倒,提供精度为1 m的精确定位,使医护人员在5 s内收到跌倒报警信息。
上传时间: 2013-12-04
上传用户:fhzm5658
本文以对步伐特征的研究为基础,描述一个采用3轴加速度计ADXL345的全功能计步器参考设计,它能辨别并计数步伐,测量距离、速度甚至所消耗的卡路里。 ADXL345专有的(正在申请专利)片内32级先进先出(FIFO)缓冲器可以存储数据,并执行计步器应用的相关操作,从而最大程度地减少主处理器干预,为便携式设备节省宝贵的系统功率。其13位分辨率(4 mg/LSB)甚至允许计步器以合理的精度测量超低速步行(每步加速度变化约55 mg)。
上传时间: 2013-12-22
上传用户:wff
MPU6050数据分析与滤波,三轴加速度传感器
上传时间: 2013-10-15
上传用户:fanboynet
RSA算法 :首先, 找出三个数, p, q, r, 其中 p, q 是两个相异的质数, r 是与 (p-1)(q-1) 互质的数...... p, q, r 这三个数便是 person_key,接著, 找出 m, 使得 r^m == 1 mod (p-1)(q-1)..... 这个 m 一定存在, 因为 r 与 (p-1)(q-1) 互质, 用辗转相除法就可以得到了..... 再来, 计算 n = pq....... m, n 这两个数便是 public_key ,编码过程是, 若资料为 a, 将其看成是一个大整数, 假设 a < n.... 如果 a >= n 的话, 就将 a 表成 s 进位 (s
标签: person_key RSA 算法
上传时间: 2013-12-14
上传用户:zhuyibin
* 高斯列主元素消去法求解矩阵方程AX=B,其中A是N*N的矩阵,B是N*M矩阵 * 输入: n----方阵A的行数 * a----矩阵A * m----矩阵B的列数 * b----矩阵B * 输出: det----矩阵A的行列式值 * a----A消元后的上三角矩阵 * b----矩阵方程的解X
上传时间: 2015-07-26
上传用户:xauthu