遥操作指令处理方法、装置、电子设备及存储介质与流程
本公开涉及计算机,尤其涉及一种遥操作指令处理方法、装置、电子设备及存储介质。
背景技术:
1、随着科学技术的发展,遥操作机器人应运而生并便利着生产生活。其中,操作者通过主端设备(如手柄、主机械臂)生成运动指令,该指令由规划器1(如高性能的orin板)进行初步处理后,通过网络(如wi-fi、5g、以太网)传输至从端的规划器2,最终由规划器2驱动执行器(如电机)完成动作。这种架构充分利用了主端强大的计算能力和从端可靠的实时控制能力。但是如何提高动作执行的准确性成为关注的重心。
技术实现思路
1、本公开提供一种遥操作指令处理方法、装置、电子设备及存储介质,可以提高遥操作指令获取的准确性,提高电子设备控制的准确性。本公开的技术方案如下:
2、根据本公开实施例的第一方面,提供一种遥操作指令处理方法,应用于第一电子设备,包括:
3、在接收到第二电子设备传输的第一遥操作指令的情况下,获取所述第一电子设备的第一状态向量;
4、根据所述第一状态向量,获取第一测量噪声协方差矩阵和第一过程噪声协方差矩阵,其中,所述第一过程噪声协方差矩阵包括所述第一状态向量中各参数对应的过程噪声,所述第一测量噪声协方差矩阵包括当前控制周期对应的测量噪声;
5、根据所述第一电子设备对应的每个控制周期的测量残差,对所述第一测量噪声协方差矩阵进行更新,获取第二测量噪声协方差矩阵;
6、根据所述第一电子设备对应的每个控制周期的估计状态和先验误差协方差,对所述第一过程噪声协方差矩阵进行更新,获取第二过程噪声协方差矩阵;
7、根据所述第二测量噪声协方差矩阵、所述第二过程噪声协方差矩阵、所述第一状态向量和所述第一遥操作指令,获取第二状态向量,并根据所述第二状态向量,获取第二遥操作指令,其中,所述第二遥操作指令用于指示所述第一电子设备的执行装置执行与所述第二遥操作指令对应的操作。
8、根据一些实施例,所述根据所述第一电子设备对应的每个控制周期的测量残差,对所述第一测量噪声协方差矩阵进行更新,获取第二测量噪声协方差矩阵,包括:
9、获取所述第一电子设备在上一控制周期对应的第一状态转移矩阵和第一观测矩阵;
10、获取所述第一电子设备在所述上一控制周期的第一估计状态;
11、根据第一状态转移矩阵和所述第一估计状态,获取当前控制周期对应的第二估计状态;
12、根据所述第二估计状态和第一观测矩阵,获取所述当前控制周期对应的测量残差;
13、基于所述当前控制周期对应的测量残差和滑动时间窗口,获取所述第一电子设备对应的每个控制周期的测量残差;
14、根据所述第一电子设备对应的每个控制周期的测量残差,获取当前控制周期对应的目标测量残差;
15、根据采用所述目标测量残差和先验误差协方差,对所述第一测量噪声协方差矩阵进行更新,获取第二测量噪声协方差矩阵。
16、根据一些实施例,所述根据所述第一电子设备对应的每个控制周期的估计状态和先验误差协方差,对所述第一过程噪声协方差矩阵进行更新,获取第二过程噪声协方差矩阵,包括:
17、获取所述第一电子设备在上一控制周期对应的第一状态转移矩阵;
18、获取所述第一电子设备在所述上一控制周期的第一估计状态;
19、根据第一状态转移矩阵和所述第一估计状态,获取当前控制周期对应的第二估计状态;
20、根据所述第一估计状态和所述第二估计状态,获取所述当前控制周期对应的状态修正量;
21、根据所述当前控制周期对应的状态修正量和滑动时间窗口,获取当前控制周期对应的目标修正值;
22、根据采用所述目标修正值和先验误差协方差,对所述第一过程噪声协方差矩阵进行更新,获取第二过程噪声协方差矩阵。
23、根据一些实施例,所述方法还包括:
24、获取上一控制周期对应的后验误差协方差;
25、根据所述上一控制周期对应的后验误差协方差、所述状态转移矩阵和所述上一控制周期对应的过程噪声协方差矩阵,获取所述先验误差协方差。
26、根据一些实施例,所述根据所述第二测量噪声协方差矩阵、所述第二过程噪声协方差矩阵、所述第一状态向量和所述第一遥操作指令,获取第二状态向量,并根据所述第二状态向量,获取第二遥操作指令,包括:
27、根据所述先验误差协方差、第一观测矩阵和第二测量噪声协方差矩阵,获取卡尔曼增益;
28、根据所述卡尔曼增益、所述当前控制周期对应的第二估计状态和所述第一遥操作指令,获取第二状态向量;
29、提取所述第二状态向量中的目标参数,获取第二遥操作指令。
30、根据一些实施例,所述方法还包括:
31、采用所述卡尔曼增益和所述第一观测矩阵,对所述先验误差协方差进行更新,获取当前控制周期对应的后验误差协方差。
32、根据一些实施例,所述方法还包括:
33、根据所述第一电子设备对应的自适应调节参数,获取第一滑动窗口系数和第二滑动窗口系数,其中,所述第一滑动窗口系数用于对所述第一过程噪声协方差矩阵进行更新,所述第二滑动窗口系数用于对所述第一测量噪声协方差矩阵进行更新。
34、根据本公开实施例的第二方面,提供一种遥操作指令处理装置,包括:
35、向量获取单元,用于在接收到第二电子设备传输的第一遥操作指令的情况下,获取所述第一电子设备的第一状态向量;
36、矩阵获取单元,用于根据所述第一状态向量,获取第一测量噪声协方差矩阵和第一过程噪声协方差矩阵,其中,所述第一过程噪声协方差矩阵包括所述第一状态向量中各参数对应的过程噪声,所述第一测量噪声协方差矩阵包括当前控制周期对应的测量噪声;
37、矩阵更新单元,用于根据所述第一电子设备对应的每个控制周期的测量残差,对所述第一测量噪声协方差矩阵进行更新,获取第二测量噪声协方差矩阵;
38、所述矩阵更新单元,还用于根据所述第一电子设备对应的每个控制周期的估计状态和先验误差协方差,对所述第一过程噪声协方差矩阵进行更新,获取第二过程噪声协方差矩阵;
39、指令处理单元,用于根据所述第二测量噪声协方差矩阵、所述第二过程噪声协方差矩阵、所述第一状态向量和所述第一遥操作指令,获取第二状态向量,并根据所述第二状态向量,获取第二遥操作指令,其中,所述第二遥操作指令用于指示所述第一电子设备的执行装置执行与所述第二遥操作指令对应的操作。
40、根据本公开实施例的第三方面,提供一种电子设备,包括:
41、处理器;
42、用于存储所述处理器可执行指令的存储器;
43、其中,所述处理器被配置为执行所述指令,以实现前述一方面中任一项所述的遥操作指令处理方法。
44、根据本公开实施例的第四方面,提供了一种存储介质,当所述存储介质中的指令由电子设备的处理器执行时,使得电子设备能够执行前述一方面中任一项所述的遥操作指令处理方法。
45、根据本公开实施例的第五方面,提供了一种计算机程序产品,包括计算机程序,所述计算机程序在被处理器执行时实现前述一方面中任一项所述的方法。
46、本公开的实施例提供的技术方案至少带来以下有益效果:
47、在一些或者相关实施例中,通过在接收到第二电子设备传输的第一遥操作指令的情况下,获取所述第一电子设备的第一状态向量;根据所述第一状态向量,获取第一测量噪声协方差矩阵和第一过程噪声协方差矩阵,其中,所述第一过程噪声协方差矩阵包括所述第一状态向量中各参数对应的过程噪声,所述第一测量噪声协方差矩阵包括当前控制周期对应的测量噪声;根据所述第一电子设备对应的每个控制周期的测量残差,对所述第一测量噪声协方差矩阵进行更新,获取第二测量噪声协方差矩阵;根据所述第一电子设备对应的每个控制周期的估计状态和先验误差协方差,对所述第一过程噪声协方差矩阵进行更新,获取第二过程噪声协方差矩阵;根据所述第二测量噪声协方差矩阵、所述第二过程噪声协方差矩阵、所述第一状态向量和所述第一遥操作指令,获取第二状态向量,并根据所述第二状态向量,获取第二遥操作指令,其中,所述第二遥操作指令用于指示所述第一电子设备的执行装置执行与所述第二遥操作指令对应的操作。因此,可以根据网络环境和状态变化,动态调整测量噪声协方差矩阵和过程噪声协方差矩阵,减少固定预设测量噪声协方差矩阵和过程噪声协方差矩阵、离线后无法修改的情况,可以自适应调整滤波参数,可以提高设备操作的稳定性,可以从“静态开环整定”转变为“动态闭环自适应”,可以通过各个控制周期进行相应调整,提高测量噪声协方差矩阵和过程噪声协方差矩阵获取的准确性,可以提高每个控制周期噪声与滤波器的匹配,可以提高遥操作系统对动态网络环境的鲁棒性,提高遥操作指令获取的准确性,提高电子设备控制的准确性。
48、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本公开。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com