物体间位置姿态关系实时统一系统及方法与流程

文档序号:12654982阅读:来源:国知局

技术特征:

1.一种物体间位置姿态关系实时统一系统,其特征在于,所述系统包括:两个位姿测量装置、相对位姿采集装置和上位机,所述两个位姿测量装置分为第一位姿测量装置和第二位姿测量装置;

所述相对位姿采集装置,用于采集所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系;

所述第一位姿测量装置,用于获取第一物体的第一图像,并将所述第一图像发送至所述上位机;

所述第二位姿测量装置,用于获取第二物体的第二图像,并将所述第二图像发送至所述上位机;

所述上位机,用于根据所述第一图像确定所述第一位姿测量装置和第一物体之间的第一位置姿态关系,根据所述第二图像确定所述第二位姿测量装置和第二物体之间的第二位置姿态关系,根据所述第一位置姿态关系、第二位置姿态关系及相对位置姿态关系将所述第一物体和第二物体转换至同一坐标系中。

2.如权利要求1所述的系统,其特征在于,所述相对位姿采集装置包括:摄像机和合作标志靶,所述摄像机和合作标志靶分别设于所述第一位姿测量装置和第二位姿测量装置上,所述摄像机与所述合作标志靶相对设置;

所述摄像机,用于获取所述合作标志靶的第三图像,并将所述第三图像发送至所述上位机;

所述上位机,还用于根据所述第三图像确定所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系。

3.如权利要求2所述的系统,其特征在于,所述上位机,还用于获取所述第一位姿测量装置和摄像机之间的第三位置姿态关系、以及所述第二位姿测量装置和合作标志靶之间的第四位置姿态关系,并根据所述第一位置姿态关系、第二位置姿态关系、第三位置姿态关系、第四位置姿态关系及相对位置姿态关系将所述第一物体和第二物体转换至同一坐标系中。

4.如权利要求2所述的系统,其特征在于,所述上位机,还用于根据所述第三图像采用正交迭代算法确定所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系。

5.一种物体间位置姿态关系实时统一方法,其特征在于,所述方法包括:

相对位姿采集装置采集第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系;

所述第一位姿测量装置获取第一物体的第一图像,并将所述第一图像发送至上位机,所述第二位姿测量装置获取第二物体的第二图像,并将所述第二图像发送至所述上位机;

所述上位机根据所述第一图像确定所述第一位姿测量装置和第一物体之间的第一位置姿态关系,根据所述第二图像确定所述第二位姿测量装置和第二物体之间的第二位置姿态关系;

所述上位机根据所述第一位置姿态关系、第二位置姿态关系及相对位置姿态关系将所述第一物体和第二物体转换至同一坐标系中。

6.如权利要求5所述的方法,其特征在于,所述相对位姿采集装置包括:摄像机和合作标志靶,所述摄像机和合作标志靶分别设于所述第一位姿测量装置和第二位姿测量装置上,所述摄像机与所述合作标志靶相对设置;

相应地,所述相对位姿采集装置采集第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系,具体包括:

所述摄像机获取所述合作标志靶的第三图像,并将所述第三图像发送至所述上位机;

所述上位机根据所述第三图像确定所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系。

7.如权利要求6所述的方法,其特征在于,所述相对位姿采集装置采集第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系之前,所述方法还包括:

所述上位机获取所述第一位姿测量装置和摄像机之间的第三位置姿态关系、以及所述第二位姿测量装置和合作标志靶之间的第四位置姿态关系;

相应地,所述上位机根据所述第一位置姿态关系、第二位置姿态关系及相对位置姿态关系将所述第一物体和第二物体转换至同一坐标系中,具体包括:

所述上位机根据所述第一位置姿态关系、第二位置姿态关系、第三位置姿态关系、第四位置姿态关系及相对位置姿态关系将所述第一物体和第二物体转换至同一坐标系中。

8.如权利要求7所述的方法,其特征在于,所述上位机根据所述第三图像确定所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系,具体包括:

所述上位机根据所述第三图像采用正交迭代算法确定所述第一位姿测量装置和第二位姿测量装置之间的相对位置姿态关系。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1