【技术实现步骤摘要】
一种移动机器人定位精度的评估方法和系统
本专利技术涉及移动机器人定位误差评估领域，特别是涉及一种移动机器人定位精度的评估方法和系统。
技术介绍
随着移动机器人技术在各行各业的广泛应用，各类激光SLAM算法也得以深入的开发。由于缺乏移动机器人在实际场景中真值位姿，导致各类激光SLAM算法的定位精度难以评价。现有方法中，主要将公共数据集的GroundTruth作为评价SLAM算法定位精度的基准。但是，这种方法存在如下缺点：一方面，包含GroundTruth的公共数据集比较少；另一方面，公共数据集的GroundTruth并不符合算法实际应用场景，所测定的定位精度也不是真实场景下的精度。因此，如何提供一种符合实际场景、评价准确且能快速得到误差值的移动机器人定位误差分析方法，是本领域技术人员亟待解决的技术问题。
技术实现思路
本专利技术的目的是提供一种符合实际场景、评价准确且能快速得到误差值的移动机器人定位精度的评估方法和系统。为实现上述目的，本专利技术提供了如下方案：一种移动机器人...
【技术保护点】
1.一种移动机器人定位精度的评估方法，其特征在于，包括：/n利用动态捕捉系统获取移动机器人的第一位姿；/n获取所述移动机器人中采用SLAM算法所确定的移动机器人的第二位姿；所述第二位姿包括第二位置坐标和航向角；/n根据所述第一位姿和所述第二位姿确定所述移动机器人的平移绝对轨迹误差；/n根据所述偏航角和所述航向角确定所述移动机器人的旋转绝对轨迹误差；/n根据所述旋转绝对轨迹误差和所述平移绝对轨迹误差生成所述移动机器人的绝对轨迹误差报告；/n根据所述绝对轨迹误差报告确定所述移动机器人的定位精度。/n
【技术特征摘要】
1.一种移动机器人定位精度的评估方法，其特征在于，包括：
利用动态捕捉系统获取移动机器人的第一位姿；
获取所述移动机器人中采用SLAM算法所确定的移动机器人的第二位姿；所述第二位姿包括第二位置坐标和航向角；
根据所述第一位姿和所述第二位姿确定所述移动机器人的平移绝对轨迹误差；
根据所述偏航角和所述航向角确定所述移动机器人的旋转绝对轨迹误差；
根据所述旋转绝对轨迹误差和所述平移绝对轨迹误差生成所述移动机器人的绝对轨迹误差报告；
根据所述绝对轨迹误差报告确定所述移动机器人的定位精度。
2.根据权利要求1所述的移动机器人定位精度的评估方法，其特征在于，所述利用动态捕捉系统获取移动机器人的第一位姿，具体包括：
利用所述动态捕捉系统中的Motive软件，根据双目视觉原理确定所述移动机器人的位姿轨迹数据为(x,y,z,Roll,Pitch,Yaw)；
根据位姿轨迹数据(x,y,z,Roll,Pitch,Yaw)确定移动机器人的第一位置坐标和偏航角；
其中，x,y,z为移动机器人在空间直角坐标系中的坐标值，Roll为绕x轴的偏航角，Pitch为绕y轴的偏航角，Yaw为绕z轴的偏航角。
3.根据权利要求2所述的移动机器人定位精度的评估方法，其特征在于，所述利用动态捕捉系统获取移动机器人的第一位姿，具体包括：
以启动所述SLAM算法时所述移动机器人所在的位置为坐标原点，利用所述动态捕捉系统中的Motive软件，根据双目视觉原理确定所述移动机器人的位姿轨迹数据为(x,y,z,Roll,Pitch,Yaw)；
保留所述位姿轨迹数据(x,y,z,Roll,Pitch,Yaw)中绕z轴的偏航角和X-Y平面内的坐标值，得到第一位姿。
4.根据权利要求1所述的移动机器人定位精度的评估方法，其特征在于，所述根据所述第一位姿和所述第二位姿确定所述移动机器人的平移绝对轨迹误差，具体包括：
根据所述第一位姿和所述第二位姿，采用公式确定所述移动机器人的平移绝对轨迹误差ATEpos；
其中，n表示位姿总数，表示X-Y平面内的第i个第二位姿，表示X-Y平面内的第i个第一位姿。
5.根据权利要求1所述的移动机器人定位精度的评估方法，其特征在于，所述根据所述偏航角和所述航向角确定所述移动机器人的旋转绝对轨迹误差，具体包括：
根据所述偏航角和所述航向角，采用公式确定所述移动机器人的旋转绝对轨迹误差ATEroi；
其中，n表示位姿总数，表示第i个第二绕z轴的偏航角，表示第i个偏航角。
6.一种移动机器人定位精度的评估系统，其特征在于，包括：
第一获...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。