PX4-Avoidance
PX4-Avoidance copied to clipboard
improve avoidance node to use ROS2
I am working on to use PX4-Avoidance global_planner in ROS2 environment.
Until now, I succeed with subscribing a topic(VehicleLocalPosition) in ROS2 environment.
The avoidance node should be changed to the following reasons.
- In current form, the two avoidance nodes(avoidance_node_cmd, avoidance_node_status) spinning and it stuck with executor.join() function. Thus, I made thread/related variables as global variable to make it spin in the background.
- tf2::fromMsg usage was fault. I change the order of input parameters but I failed to use "tf2::fromMsg(tf_earlier.transform.translation, tf_earlier_translation);". In tf2 documentation, there is a declaration about geometry_msgs::msg::Vector3 and tf2::Vector3 but it is not working.. So I changed it to "tf_earlier_translation.setValue(tf_earlier.transform.translation.x, tf_earlier.transform.translation.y, tf_earlier.transform.translation.z);" as directly assign Vector3 values to tf_earlier_translation. (Please give a comment about this)
The message type of mavros and px4_msgs in ROS2 is quite different so I thinks its little bit hard work to porting global_planner to ROS2 environment but I will try to solve it.
@TSC21 This might be interesting for you
@TSC21 This might be interesting for you
Absolutely and I totally support the effort of continuing pushing this forward. There's still things to get wrapped up and I was just focused on the local planner.
@ldg810 what ROS2 version are you testing this against?
@TSC21 This might be interesting for you
Absolutely and I totally support the effort of continuing pushing this forward. There's still things to get wrapped up and I was just focused on the local planner.
@ldg810 what ROS2 version are you testing this against?
Thank you for your comment.
Now, I am using ros2 dashing and using px4_sitl_rtps for px4 firmware.
I will also summarize my simulation environment to readme file.
@TSC21 This might be interesting for you
Absolutely and I totally support the effort of continuing pushing this forward. There's still things to get wrapped up and I was just focused on the local planner. @ldg810 what ROS2 version are you testing this against?
Thank you for your comment.
Now, I am using ros2 dashing and using px4_sitl_rtps for px4 firmware.
I will also summarize my simulation environment to readme file.
Are you able to use ROS2 Foxy instead? We are currently aiming for that distro as LTS for the microRTPS bridge.
@TSC21 This might be interesting for you
Absolutely and I totally support the effort of continuing pushing this forward. There's still things to get wrapped up and I was just focused on the local planner. @ldg810 what ROS2 version are you testing this against?
Thank you for your comment.
Now, I am using ros2 dashing and using px4_sitl_rtps for px4 firmware.
I will also summarize my simulation environment to readme file.
Are you able to use ROS2 Foxy instead? We are currently aiming for that distro as LTS for the microRTPS bridge.
Yes, no problem to use foxy. I made Dockerfile for my environment so changing version is not problem.
I will test the planner in foxy environment.