catec / amcl3d

Adaptive Monte Carlo Localization (AMCL) in 3D.
Apache License 2.0
195 stars 51 forks source link

Unable to get amcl3d_node working #4

Open impaidk opened 3 years ago

impaidk commented 3 years ago

I'm trying to get the pose of my UAV using amcl3d and also simultaneously trying to get the pose info using p3d gazebo plugin.

When I try to echo about the topic /amcl3d_node/range is get the following error. The error is same for other amcl3d topics as well.

rostopic echo /amcl3d_node/range
WARNING: no messages received and simulated time is active.
Is /clock being published?

Then I tried to get info about the amcl3d_node, I get the following error.

rosnode info /amcl3d_node
--------------------------------------------------------------------------------
Node [/amcl3d_node]
Publications: None

Subscriptions: None

Services: None

contacting node http://DELL:34421/ ...
ERROR: Communication with node[http://DELL:34421/] failed!

Our launch file looks like this

<?xml version="1.0" encoding="UTF-8"?>
<launch>

  <arg name="world" default="empty"/> 
  <arg name="paused" default="false"/>
  <arg name="use_sim_time" default="true"/>
  <arg name="gui" default="true"/>
  <arg name="headless" default="false"/>
  <arg name="debug" default="false"/>
  <param name="use_sim_time" value="true"/>

  <include file="$(find gazebo_ros)/launch/empty_world.launch">
    <arg name="world_name" value="$(find drone_gazebo)/worlds/drone_wall"/>
    <arg name="paused" value="$(arg paused)"/>
    <arg name="use_sim_time" value="$(arg use_sim_time)"/>
    <arg name="gui" value="$(arg gui)"/>
    <arg name="headless" value="$(arg headless)"/>
    <arg name="debug" value="$(arg debug)"/>
  </include>

  <include file="$(find hector_quadrotor_gazebo)/launch/spawn_quadrotor.launch">
    <arg name="model" value="$(find hector_quadrotor_description)/urdf/quadrotor_hokuyo_utm30lx.gazebo.xacro"/>

      <arg name="x" default="0.0"/>
      <arg name="y" default="0.0"/>
      <arg name="z" default="0.3"/>
  </include>

  <!-- Visualization -->
  <node pkg="rviz" type="rviz" name="rviz" args="-d $(find amcl3d)/rviz/amcl3d.rviz"/>

  <include file="$(find amcl3d)/launch/amcl3d.launch">
    <arg name="map_name_path"   value="$(find amcl3d)/tests/data/mapfile_wrong.bt"/>
    <arg name="init_x"          value="0"/>
    <arg name="init_y"          value="0"/>
    <arg name="init_z"          value="0"/>
    <arg name="init_a"          value="-0.043"/>
    <arg name="num_particles"   value="600"/>
    <arg name="alpha"           value="0.5"/>
    <arg name="take_off_height" value="1.3"/>
  </include>
</launch>

We checked all the paths and there is no problem with that.

ROS version: Melodic amcl3d: installed from source hector_quadrotor: installed from source