This document introduces the demo project of "recover_localization", how to call the recoverlocalization() API to have the robot re-position to the correct localization on the map. Before using this feature, please note the following:

1.The success rate of relocalization is related to the environment. Before re-positioning, it is recommended to use a clear environmental map with a sharp outline.

2.For the case where there is a similar environment in the map area, for example, there are offices 1 and 2 with the same environment layout on the map, if the robot is actually in the office 1, it may relocate to the office 2 during the relocalization process. . In this case, it is recommended to modify the office environment to make a distinction on the map when building the map (moving tables and chairs, adding pots, etc.).



Content


IDE Preparation 

  • Software

    • Visual Studio 2010  SP1
    • Slamware Windows SDK:Slamware Windows SDK
    • RoboStudio(for map display):Robostudio installer 
    • Sample Code: 

      Higher version of Visual Studio will cause errors. sometime you will need to upgrade SP1 package to make your VS compatable with .Net Framework.

  • Hardware

          (Either one of following)

    • Slamware SDP mini 
    • Slamware SDP
    • Slamware Kit 
    • Zeus/Apollo robot base

Download

Win32-Demo

Compiling

  1. Right click on "recover_localization" project, set as StartUp project.


  2. Right click on "recover_localization", then " Properties",configure "include" and "lib" directories to the corresponding folder path of Slamware SDK.

    Slamware SDK的include和lib目录无需复制到参考例程目录,只需在Visual Studio里指定路径即可。



  3. Right click on "recover_localization", then "properties",set "Command Arguments"  as follows:  
    Syntax :recover_localization <IP address>


  4. Click " F5" to execute.
  5. Robot motion and map could be seen on Robostudio.

Code

  • When the actual position deviates from the theoretical position of the map,  the demo project will start re-positioning operation. If the recover is successful, you can see in the robostudio that the robot re-positions to the correct position and the status will turn to the corresponding one.

    地图重定位
    		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;
    				}
    		}