[发明专利]云台控制方法、装置、云台控制设备及存储介质

权利要求书

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测得的在俯仰方向的第二俯仰角度；

所述根据所述第一对地角度以及所述第二对地角度，计算出所述云台对应的目标位姿变化角度，包括：

根据所述第一俯仰角度与所述第二俯仰角度之差，生成所述云台对应的第一位姿变化角度。