From: Tsardoulias M. <ets...@au...> - 2009-01-23 15:24:07
|
Hi I I'm trying to implement a FastSLAM algorithm but I have some problems with the x,y coordinates and the speeds. I have a "for" command that runs 10 times, each time for 1 second. I also used the command pp.SetSpeed(-0.1, 0); So I guess that the robot should move backwards for 1 meter by the end of the "for". I also print the x coordinate as well as the x speed during the "for" with the following command: std::cout<<pp.GetXPos()<<" "<<pp.GetXSpeed()<<std::endl; I get these: 0 0 -1.8496 0 -1.8496 0 -1.8496 0 -1.8496 0 -1.8496 0 -1.8496 0 -1.8587 0.0431042 -1.8587 0.0431042 -1.8782 0.101228 So the output shows that the robot moved 0.03 meters (!) and in the 7 first seconds it's speed was 0! Although the robot seems to move normally in the simulator (USARSim). What is going on?? Manos |