本页介绍了Recoverlocalization的用法, 如何调用recoverlocalization()接口使机器人在地图上重新定位正确的位置。在使用这个功能之前,请注意以下几点:
本页内容
运行环境准备
软件平台
- Visual Studio 2010 SP1
- Slamware Windows SDK:Slamware Windows SDK
- RoboStudio(用于显示地图):Robostudio installer
Sample Code:
使用更高版本的Visual Studio可能会带来编译异常。
使用Visual Studio 2010(无SP1)可能会因为无法与.Net Framework兼容而报编译错误,此时增加SP1更新包即可解决问题
硬件平台
(以下任选其一)
- Slamware SDP mini
- Slamware 套装 (基于Slamware导航方案的用户机器人系统)
- Apollo/Ares/Athena等底盘系统
编译运行
- 打开samples工程,右键recover_localization, 将此工程设置成StartUp project
右键recover_localization, 打开属性选项,将Slamware SDK 的include目录和lib目录添加到工程
Slamware SDK的include和lib目录无需复制到参考例程目录,只需在Visual Studio里指定路径即可。
- 右键recover_localization, 在Debugging页面中command Arguments处输入 192.168.11.1
格式说明:recover_localization <IP address> - 点击F5运行
- 可以连上Robostudio查看地图及机器人的运动
代码描述
在实际位置偏离地图理论位置的情况下,运行该段程序,能够使机器人开始进行重定位动作。若重定位成功,在robostudio界面可以看到,机器人跳到正确位置。
地图重定位SlamwareCorePlatform sdp = SlamwareCorePlatform::connect(ip_address, 1445); std::cout <<"SDK Version: " << sdp.getSDKVersion() << std::endl; std::cout <<"SDP Version: " << sdp.getSDPVersion() << std::endl; rpos::actions::MoveAction action = sdp.getCurrentAction(); if (action) action.cancel(); //recover localization by giving an rectangle area; (0,0,0,0) represents the entire map area. action = sdp.recoverLocalization(rpos::core::RectangleF(0,0,0,0)); while(true) { switch (action.getStatus()) { case rpos::core::ActionStatusError: std::cout << "Action Failed: " << action.getReason() << std::endl; break; case rpos::core::ActionStatusRunning: std::cout <<"Current status: Running" << std::endl; break; case rpos::core::ActionStatusFinished: std::cout <<"Current status: Finished" << std::endl; break; default : std::cout <<"Status Unknown" << std::endl; break; } }