adis16470.launch 1.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243
  1. <launch>
  2. <arg name="with_filter" default="true"/>
  3. <arg name="with_rviz" default="false"/>
  4. <arg name="with_plot" default="false"/>
  5. <arg name="device" default="/dev/ttyACM0"/>
  6. <arg name="frame_id" default="imu"/>
  7. <arg name="burst_read" default="false"/>
  8. <arg name="rate" default="100"/>
  9. <arg name="publish_tf" default="true"/>
  10. <param if="$(arg with_rviz)" name="robot_description" command="$(find xacro)/xacro --inorder '$(find adi_driver)/urdf/adis16470_breakout.urdf'" />
  11. <node name="imu" pkg="adi_driver" type="adis16470_node">
  12. <param name="device" value="$(arg device)"/>
  13. <param name="frame_id" value="$(arg frame_id)"/>
  14. <param name="burst_mode" value="$(arg burst_read)"/>
  15. <param name="rate" value="$(arg rate)"/>
  16. <remap from="/imu/data_raw" to="/imu_raw"/>
  17. </node>
  18. <group if="$(arg with_filter)">
  19. <node name="relay_imu" pkg="topic_tools" type="relay" args="/imu_raw /imu/data_raw" />
  20. <node name="imu_filter" pkg="imu_filter_madgwick" type="imu_filter_node">
  21. <param name="use_mag" value="false"/>
  22. <param name="publish_tf" value="$(arg publish_tf)"/>
  23. <remap from="/imu/data" to="/imu_filtered"/>
  24. </node>
  25. </group>
  26. <node if="$(arg with_rviz)"
  27. name="rviz" pkg="rviz" type="rviz" args="-d $(find adi_driver)/launch/imu.rviz"/>
  28. <group ns="plot" if="$(arg with_plot)">
  29. <node name="gyro" pkg="rqt_plot" type="rqt_plot"
  30. args="/imu_raw/angular_velocity/x:y:z"/>
  31. <node name="accl" pkg="rqt_plot" type="rqt_plot"
  32. args="/imu_raw/linear_acceleration/x:y:z"/>
  33. </group>
  34. <!-- Connect sensors before tests -->
  35. <test test-name="test_adis16470" pkg="adi_driver" type="test_adis16470.py"/>
  36. </launch>