一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

云台控制方法、装置、云台控制设备及存储介质与流程

2022-03-02 01:49:18 来源:中国专利 TAG:

技术特征:
1.一种云台控制方法,其特征在于,所述云台设置有增量式编码器;所述方法包括:获取所述云台从初始位姿状态调整至当前位姿状态的目标位姿变化角度;获取所述云台的初始码盘计数值;其中,所述初始码盘计数值为所述云台处于所述初始位姿状态下所述增量式编码器的码盘计数值;根据所述目标位姿变化角度以及所述初始码盘计数值,计算出所述云台处于所述当前位姿状态下的当前码盘计数值,以基于所述当前码盘计数值和所述初始位姿状态对所述云台进行姿态控制。2.如权利要求1所述的方法,其特征在于,所述获取所述云台的初始码盘计数值,包括:当在所述云台本地读取到保存的所述云台处于初始位姿状态下所述增量式编码器的码盘计数值,则将读取到的码盘计数值作为初始码盘计数值;当在所述云台本地未读取到保存的所述云台处于初始位姿状态下所述增量式编码器的码盘计数值,则调整所述云台的位姿状态,直至所述增量式编码器的码盘计数值指示为所述增量式编码器的索引信号;调整所述云台的位姿状态至所述初始位姿状态,并将所述增量式编码器在所述云台处于所述初始位姿状态时的码盘计数值确定为初始码盘计数值;将所述初始码盘计数值保存在所述云台本地。3.如权利要求1所述的方法,其特征在于,所述云台还包括有惯性测量单元imu;所述获取所述云台从初始位姿状态调整至当前位姿状态的目标位姿变化角度,包括:基于所述imu测得的所述云台在所述当前位姿状态下的加速度值,计算出所述云台从初始位姿状态调整至所述当前位姿状态对应的目标位姿变化角度。4.如权利要求3所述的方法,其特征在于,在所述基于所述imu测得的所述云台在所述当前位姿状态下的加速度值,计算出所述云台从初始位姿状态调整至所述当前位姿状态对应的目标位姿变化角度之前,所述方法还包括:获取所述imu对应的零漂调整参数;所述基于所述imu测得的所述云台从所述当前位姿状态下的加速度值,计算出所述云台从初始位姿状态调整至所述当前位姿状态对应的目标位姿变化角度,包括:基于所述imu测得的所述云台在所述当前位姿状态下的加速度值以及所述零漂调整参数,计算出所述云台从初始位姿状态调整至所述当前位姿状态对应的目标位姿变化角度。5.如权利要求1所述的方法,其特征在于,所述云台还设置有第一imu和第二imu;所述获取所述云台从初始位姿状态调整至当前位姿状态的目标位姿变化角度,包括:根据所述第一imu测得的第一加速度值,以及所述第二imu测得的第二加速度值,分别计算出所述第一imu对应的第一对地角度以及所述第二imu对应的第二对地角度;其中,所述第一加速度值为所述云台从初始位姿状态调整至当前位姿状态的过程中,所述第一imu在所述当前位姿状态下测得的加速度值,所述第二加速度值为所述第二imu在所述当前位姿状态下测得的加速度值;根据所述第一对地角度以及所述第二对地角度,计算出所述云台对应的目标位姿变化角度。6.如权利要求5所述的方法,其特征在于,所述目标位姿变化角度包括所述云台在俯仰方向的第一位姿变化角度;所述第一对地角度包括所述第一imu测得的在俯仰方向的第一
俯仰角度,所述第二对地角度为所述第二imu测得的在俯仰方向的第二俯仰角度;所述根据所述第一对地角度以及所述第二对地角度,计算出所述云台对应的目标位姿变化角度,包括:根据所述第一俯仰角度与所述第二俯仰角度之差,生成所述云台对应的第一位姿变化角度。7.如权利要求6所述的方法,其特征在于,所述目标位姿变化角度还包括所述云台在横滚方向的第二位姿变化角度;所述第一对地角度还包括所述第一imu测得的在横滚方向的第一横滚角度,所述第二对地角度还包括所述第二imu测得的在横滚方向的第二横滚角度;所述根据所述第一对地角度以及所述第二对地角度,计算出所述云台对应的目标位姿变化角度,还包括:利用预设的横滚角处理函数对所述第一俯仰角度、所述第二俯仰角度、所述第一横滚角度及所述第二横滚角度进行处理,生成所述云台对应的第二位姿变化角度。8.一种云台控制装置,其特征在于,所述云台设置有增量式编码器;所述装置包括:获取模块,用于获取所述云台从初始位姿状态调整至当前位姿状态的目标位姿变化角度;所述获取模块还用于,获取所述云台的初始码盘计数值;其中,所述初始码盘计数值为所述云台处于所述初始位姿状态下所述增量式编码器的码盘计数值;处理模块,用于根据所述目标位姿变化角度以及所述初始码盘计数值,计算出所述云台处于所述当前位姿状态下的当前码盘计数值,以基于所述当前码盘计数值和所述初始位姿状态对所述云台进行姿态控制。9.一种云台控制设备,其特征在于,包括:存储器,用于存储一个或多个程序;处理器;当所述一个或多个程序被所述处理器执行时,实现如权利要求1-7中任一项所述的方法。10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该计算机程序被处理器执行时实现如权利要求1-7中任一项所述的方法。

技术总结
本申请提出一种云台控制方法、装置、云台控制设备及存储介质,涉及云台控制技术领域,通过获取云台从初始位姿状态调整至当前位姿状态的目标位姿变化角度,并获取云台在初始位姿状态下增量式编码器的初始码盘计数值,从而根据该目标位姿角度以及该初始码盘计数值,计算出云台处于当前位姿状态下的当前码盘计数值,以基于该当前码盘计数值以及初始位姿状态对云台进行姿态控制;如此,能够利用比IMU等设备测得的惯性姿态角精度更高的码盘计数值作为云台姿态控制的输入,以减少云台在进行姿态控制时输入的噪声,提升云台的姿态控制效果。提升云台的姿态控制效果。提升云台的姿态控制效果。


技术研发人员:谭程元
受保护的技术使用者:重庆市亿飞智联科技有限公司
技术研发日:2021.12.03
技术公布日:2022/2/28
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献