Robot not moving forward #2

kvnptl · 2021-03-02T12:07:30Z

After setting everything up as suggested, turtlebot is not moving. It seems RRT node is working fine, but the robot is not receiving any commands on /cmd_vel topic.

Please take a look at below video:

Please suggest some changes to make it work.

The text was updated successfully, but these errors were encountered:

fazildgr8 · 2021-03-02T16:52:31Z

Hello Kevin, could you share all the topics present at the moment and make sure your robot's /cmd_vel topic is present. And also make sure the Official Navigation stack is installed properly. You can verify the working of the Navigation stack by placing "2D Nav Goal" somewhere within the visible map (Grey Area) in RVIZ by then the Robot should be planning a path and moving towards the goal.

kvnptl · 2021-03-02T17:04:07Z

Thanks for your response,

/cmd_vel topic is there, bit nothing is published on it.

$rostopic list
/camera/parameter_descriptions
/camera/parameter_updates
/camera/rgb/camera_info
/camera/rgb/image_raw
/camera/rgb/image_raw/compressed
/camera/rgb/image_raw/compressed/parameter_descriptions
/camera/rgb/image_raw/compressed/parameter_updates
/camera/rgb/image_raw/compressedDepth
/camera/rgb/image_raw/compressedDepth/parameter_descriptions
/camera/rgb/image_raw/compressedDepth/parameter_updates
/camera/rgb/image_raw/theora
/camera/rgb/image_raw/theora/parameter_descriptions
/camera/rgb/image_raw/theora/parameter_updates
/centroids
/centroids_array
/clicked_point
/clock
/cmd_vel
/detected_points
/filtered_points
/frontiers
/frontiers_array
/gazebo/link_states
/gazebo/model_states
/gazebo/parameter_descriptions
/gazebo/parameter_updates
/gazebo/set_link_state
/gazebo/set_model_state
/global_detector_shapes
/global_detector_shapes_array
/imu
/initialpose
/joint_states
/local_detector_shapes
/map
/map_metadata
/map_updates
/move_base/DWAPlannerROS/cost_cloud
/move_base/DWAPlannerROS/global_plan
/move_base/DWAPlannerROS/local_plan
/move_base/DWAPlannerROS/parameter_descriptions
/move_base/DWAPlannerROS/parameter_updates
/move_base/DWAPlannerROS/trajectory_cloud
/move_base/NavfnROS/plan
/move_base/cancel
/move_base/current_goal
/move_base/feedback
/move_base/global_costmap/costmap
/move_base/global_costmap/costmap_updates
/move_base/global_costmap/footprint
/move_base/global_costmap/inflation_layer/parameter_descriptions
/move_base/global_costmap/inflation_layer/parameter_updates
/move_base/global_costmap/obstacle_layer/parameter_descriptions
/move_base/global_costmap/obstacle_layer/parameter_updates
/move_base/global_costmap/parameter_descriptions
/move_base/global_costmap/parameter_updates
/move_base/global_costmap/static_layer/parameter_descriptions
/move_base/global_costmap/static_layer/parameter_updates
/move_base/goal
/move_base/local_costmap/costmap
/move_base/local_costmap/costmap_updates
/move_base/local_costmap/footprint
/move_base/local_costmap/inflation_layer/parameter_descriptions
/move_base/local_costmap/inflation_layer/parameter_updates
/move_base/local_costmap/obstacle_layer/parameter_descriptions
/move_base/local_costmap/obstacle_layer/parameter_updates
/move_base/local_costmap/parameter_descriptions
/move_base/local_costmap/parameter_updates
/move_base/parameter_descriptions
/move_base/parameter_updates
/move_base/recovery_status
/move_base/result
/move_base/status
/move_base_simple/goal
/odom
/rosout
/rosout_agg
/scan
/tf
/tf_static
/turtlebot3_slam_gmapping/entropy

Nvigation stack is working fine. I have checked '2D Nav Goal' and it worked perfectly.

fazildgr8 · 2021-03-02T17:21:43Z

Your frontier points (/frontiers or /frontiers_array) aren't being published I guess. Because these frontier points array are sent as a sequence of goals to the Navigation Stack and then the robot starts to accomplish each goal in sequence. Could you please monitor both the topics mentioned above?
Further Debugging,
In the code assigner.py, it is the node that takes care of sending the Frontier points to Navigation Stack. Line 60 to 99 performs the frontier assignment task divided into different secctions. Please monitor the Variables present within it to figure out the issue.

kvnptl · 2021-03-02T20:10:09Z

Yes, /frontiers and /filtered_points are not published. And because of that the code get stuck at line 61 while loop in assigner.py

Is it running fine at your end?

fazildgr8 · 2021-03-02T21:14:28Z

Yes it does run in my end as it should. I back tracked publishing script filter.py which publishes the /filtered_points which is computed from the map data received. I probably feel the correct map is not received by this node. Are you getting a status printed in the terminal such as 'waiting for the map' (Line 87) or 'waiting for the global costmap' (Line 93) . Could you try to verify this.

kvnptl · 2021-03-03T11:18:48Z

After running roslaunch ros_autonomous_slam autonomous_explorer.launch
It receives two warnings about global_costmap and local_costmap as shown below output. It also printed Waiting for the map and then the map and global costmaps are received. Stuck in while loop at line 117 in filter.py Becuase nothing published on /detected_points topic (publisher nodes /global_detector and /local_detector).

ROS_MASTER_URI=http://localhost:11311

process[robot_state_publisher-1]: started with pid [13465]
process[turtlebot3_slam_gmapping-2]: started with pid [13466]
process[rviz-3]: started with pid [13472]
process[move_base-4]: started with pid [13478]
process[global_detector-5]: started with pid [13480]
process[local_detector-6]: started with pid [13487]
process[filter-7]: started with pid [13493]
process[assigner-8]: started with pid [13496]
[ WARN] [1614767930.302246447, 28.106000000]: global_costmap: Parameter "plugins" not provided, loading pre-Hydro parameters
[ INFO] [1614767930.375624425, 28.173000000]: global_costmap: Using plugin "static_layer"
[ INFO] [1614767930.397749136, 28.194000000]: Requesting the map...
[ INFO] [1614767930.453828004, 28.245000000]: Laser is mounted upwards.
 -maxUrange 3 -maxUrange 3.49 -sigma     0.05 -kernelSize 1 -lstep 0.05 -lobsGain 3 -astep 0.05
 -srr 0.1 -srt 0.2 -str 0.1 -stt 0.2
 -linearUpdate 1 -angularUpdate 0.2 -resampleThreshold 0.5
 -xmin -10 -xmax 10 -ymin -10 -ymax 10 -delta 0.05 -particles 100
[ INFO] [1614767930.463897044, 28.255000000]: Initialization complete
update frame 0
update ld=0 ad=0
Laser Pose= -2.06358 0.50001 -3.14149
m_count 0
Registering First Scan
[ INFO] [1614767930.731678311, 28.502000000]: Resizing costmap to 384 X 384 at 0.050000 m/pix
[ INFO] [1614767930.839127653, 28.605000000]: Received a 384 X 384 map at 0.050000 m/pix
[ INFO] [1614767930.859364899, 28.620000000]: global_costmap: Using plugin "obstacle_layer"
[ INFO] [1614767930.882651890, 28.640000000]:     Subscribed to Topics: scan
[ INFO] [1614767930.932313620, 28.687000000]: global_costmap: Using plugin "inflation_layer"
[ WARN] [1614767931.059289027, 28.806000000]: local_costmap: Parameter "plugins" not provided, loading pre-Hydro parameters
[ INFO] [1614767931.090770581, 28.829000000]: local_costmap: Using plugin "obstacle_layer"
[ INFO] [1614767931.098395390, 28.836000000]:     Subscribed to Topics: scan
update frame 3
update ld=2.43988e-07 ad=2.18327e-06
Laser Pose= -2.06358 0.500011 -3.14149
m_count 1
[ INFO] [1614767931.131233657, 28.866000000]: local_costmap: Using plugin "inflation_layer"
[ INFO] [1614767931.240610224, 28.966000000]: Created local_planner dwa_local_planner/DWAPlannerROS
[ INFO] [1614767931.252127731, 28.977000000]: Sim period is set to 0.10
Average Scan Matching Score=201.843
neff= 100
Registering Scans:Done
[ INFO] [1614767931.583432394, 29.261000000]: Recovery behavior will clear layer 'obstacles'
[ INFO] [1614767931.620712095, 29.297000000]: Recovery behavior will clear layer 'obstacles'
[ INFO] [1614767931.776447356, 29.427000000]: odom received!
update frame 6
update ld=2.45e-07 ad=2.19233e-06
Laser Pose= -2.06358 0.500011 -3.14148
m_count 2
Average Scan Matching Score=202.069
neff= 100
Registering Scans:Done
update frame 9
update ld=2.44179e-07 ad=2.18499e-06
Laser Pose= -2.06358 0.500011 -3.14148
m_count 3
[INFO] [1614767932.792079, 0.000000]: Waiting for the map
Average Scan Matching Score=202.024
neff= 100
Registering Scans:Done
update frame 12
update ld=2.444e-07 ad=2.18697e-06
Laser Pose= -2.06358 0.500011 -3.14148
m_count 4
[INFO] [1614767933.218428, 30.714000]: the map and global costmaps are received
Average Scan Matching Score=203.128
neff= 100
Registering Scans:Done
update frame 15
update ld=2.44782e-07 ad=2.19038e-06
Laser Pose= -2.06358 0.500012 -3.14148
m_count 5
Average Scan Matching Score=204.059
neff= 100
Registering Scans:Done
update frame 18
.
.
.
.

(same message continue)

Rviz Marker Error:

kvnptl · 2021-03-03T12:43:46Z

I just checked ObstacleFree function in global_rrt_detector.cpp is giving some erroneous output other than 1 and -1. (same for local_rrt_detector.cpp)

kvnptl · 2021-03-06T19:05:07Z

Can you please share your update on this issue?

rodrigoaantunes · 2021-07-20T03:36:52Z

Can you please share your update on this issue?

I'm with the same problem, same environment and same error. Did you found a solution?

kvnptl · 2021-07-20T04:25:47Z

@rodrigoaantunes nope, not yet

batti-nesrine · 2021-07-29T08:35:04Z

I have the same issue but the package worked fine earlier this day, now i can't get it to work [same environment and same error].
Anyone found a solution ?

Avi241 · 2021-10-26T12:42:13Z

I have also faced the same problem.
Please check when you run explorer.launch whether there is an error of sklearn no found ?
If yes just install the sklearn package and relaunch the explorer, the robot will start moving.
python -m pip install sklearn

SinanK94 · 2021-11-19T19:07:25Z

I have also the same problem. I used ROS melodic before and everything was fine, but now I am using ROS noetic and the robot is not moving anymore.

SinanK94 · 2021-12-21T19:23:10Z

The robot is moving right now, I fixed the issue. Could somebody please verify my solution?
What I only did was to change the filter.py code.

old filter.py:

while z < len(centroids):
          cond = False
          temppoint.point.x = centroids[z][0]
          temppoint.point.y = centroids[z][1]

          for i in range(0, n_robots):

              transformedPoint = tfLisn.transformPoint(
                  globalmaps[i].header.frame_id, temppoint)
              x = array([transformedPoint.point.x, transformedPoint.point.y])
              cond = (gridValue(globalmaps[i], x) > threshold) or cond
          if (cond or (informationGain(mapData, [centroids[z][0], centroids[z][1]], info_radius*0.5)) < 0.2):
              centroids = delete(centroids, (z), axis=0)
              z = z-1
          z += 1
# -------------------------------------------------------------------------
# publishing
      arraypoints.points = []
      for i in centroids:
          tempPoint.x = i[0]
          tempPoint.y = i[1]
          arraypoints.points.append(copy(tempPoint))
      filterpub.publish(arraypoints)
      pp = []
      for q in range(0, len(frontiers)):
          p.x = frontiers[q][0]
          p.y = frontiers[q][1]
          pp.append(copy(p))
      points.points = pp
      pp = []
      for q in range(0, len(centroids)):
          p.x = centroids[q][0]
          p.y = centroids[q][1]
          pp.append(copy(p))
      points_clust.points = pp
      pub.publish(points)
      pub2.publish(points_clust)
      rate.sleep()

new filter.py:

  while z < len(centroids):
            cond = False
            temppoint.point.x = centroids[z][0]
            temppoint.point.y = centroids[z][1]

            for i in range(0, n_robots):

                transformedPoint = tfLisn.transformPoint(
                    globalmaps[i].header.frame_id, temppoint)
                x = array([transformedPoint.point.x, transformedPoint.point.y])
                cond = (gridValue(globalmaps[i], x) > threshold) or cond
            if (cond or (informationGain(mapData, [centroids[z][0], centroids[z][1]], info_radius*0.5)) < 0.2):
                centroids = delete(centroids, (z), axis=0)
                z = z-1
            z += 1
# -------------------------------------------------------------------------
# publishing
              arraypoints.points = []
              for i in centroids:
                  tempPoint.x = i[0]
                  tempPoint.y = i[1]
                  arraypoints.points.append(copy(tempPoint))
              filterpub.publish(arraypoints)
              pp = []
              for q in range(0, len(frontiers)):
                  p.x = frontiers[q][0]
                  p.y = frontiers[q][1]
                  pp.append(copy(p))
              points.points = pp
              pp = []
              for q in range(0, len(centroids)):
                  p.x = centroids[q][0]
                  p.y = centroids[q][1]
                  pp.append(copy(p))
              points_clust.points = pp
              pub.publish(points)
              pub2.publish(points_clust)
              rate.sleep()

Finally the problem was that the publishing code do not get any centroid data after the while loop. Therefore the assigner could not send any move action to the mobile robot.

iory · 2022-01-13T01:39:19Z

@SinanK94

Maybe this PR #7 solve your problem.

SinanK94 · 2022-02-09T23:31:36Z

@iory thank you for your PR
This was exactly the problem

but can you tell me why the change is only necessary for this part of the code ?

iory · 2022-02-14T09:19:20Z

For noetic, python3 is the default, and for melodic, python2 is the default.
Since the behavior of division changes between python2 and python3, this change makes both of them return the same result.

MJ1307 · 2023-01-23T00:05:14Z

@kvnptl @Avi241 @SinanK94 @rodrigoaantunes Hello Everyone. I am facing the same issue can anyone please help me in finding the solution.

Avi241 · 2023-01-23T04:24:20Z

Hey @MJ1307 .
Can you provide us with more details.. what errors you are getting and also the logs..

Thanks

amaya2012 · 2023-10-13T04:04:11Z

Hey, I have the same issue, my robot is not moving. I use Ros Noetic and have tried @SinanK94 code but it's not working for me.
Here is the issue I have:

[filter-7] process has died [pid 6452, exit code 1, cmd /home/amaya/catkin_ws/src/ros_autonomous_slam/scripts/filter.py __name:=filter __log:=/home/amaya/.ros/log/3d4bcb8c-6975-11ee-b407-65d4e7192b1e/filter-7.log].
log file: /home/amaya/.ros/log/3d4bcb8c-6975-11ee-b407-65d4e7192b1e/filter-7*.log
[assigner-8] process has died [pid 6454, exit code 1, cmd /home/amaya/catkin_ws/src/ros_autonomous_slam/scripts/assigner.py __name:=assigner __log:=/home/amaya/.ros/log/3d4bcb8c-6975-11ee-b407-65d4e7192b1e/assigner-8.log].
log file: /home/amaya/.ros/log/3d4bcb8c-6975-11ee-b407-65d4e7192b1e/assigner-8*.log

To what I understand I have issue with my filter.py et assigner.py files but I don't really what to do.

Thanks

jyf201012jyf · 2024-03-27T14:35:54Z

same question:
solution:pip install -U scikit-learn

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

Robot not moving forward #2

Robot not moving forward #2

kvnptl commented Mar 2, 2021

fazildgr8 commented Mar 2, 2021 •

edited

Loading

kvnptl commented Mar 2, 2021

fazildgr8 commented Mar 2, 2021

kvnptl commented Mar 2, 2021 •

edited

Loading

fazildgr8 commented Mar 2, 2021

kvnptl commented Mar 3, 2021

kvnptl commented Mar 3, 2021

kvnptl commented Mar 6, 2021

rodrigoaantunes commented Jul 20, 2021

kvnptl commented Jul 20, 2021

batti-nesrine commented Jul 29, 2021

Avi241 commented Oct 26, 2021

SinanK94 commented Nov 19, 2021

SinanK94 commented Dec 21, 2021

iory commented Jan 13, 2022

SinanK94 commented Feb 9, 2022 •

edited

Loading

iory commented Feb 14, 2022

MJ1307 commented Jan 23, 2023

Avi241 commented Jan 23, 2023

amaya2012 commented Oct 13, 2023

jyf201012jyf commented Mar 27, 2024

Robot not moving forward #2

Robot not moving forward #2

Comments

kvnptl commented Mar 2, 2021

fazildgr8 commented Mar 2, 2021 • edited Loading

kvnptl commented Mar 2, 2021

fazildgr8 commented Mar 2, 2021

kvnptl commented Mar 2, 2021 • edited Loading

fazildgr8 commented Mar 2, 2021

kvnptl commented Mar 3, 2021

kvnptl commented Mar 3, 2021

kvnptl commented Mar 6, 2021

rodrigoaantunes commented Jul 20, 2021

kvnptl commented Jul 20, 2021

batti-nesrine commented Jul 29, 2021

Avi241 commented Oct 26, 2021

SinanK94 commented Nov 19, 2021

SinanK94 commented Dec 21, 2021

iory commented Jan 13, 2022

SinanK94 commented Feb 9, 2022 • edited Loading

iory commented Feb 14, 2022

MJ1307 commented Jan 23, 2023

Avi241 commented Jan 23, 2023

amaya2012 commented Oct 13, 2023

jyf201012jyf commented Mar 27, 2024

fazildgr8 commented Mar 2, 2021 •

edited

Loading

kvnptl commented Mar 2, 2021 •

edited

Loading

SinanK94 commented Feb 9, 2022 •

edited

Loading