crazyflie_ros2_experimental

This is my Bitcraze Summer project of 2022! Purpose: To use ROS2 to implement SLAM and navigation with the Crazyflie and Multiranger, on both the real drone and simulation.

This is very much in progress but I'm excited to work on this and very confident that this will work at the end. Also this is a good opertunity for me to show an ROS2 implementation of a new platform from scratch, so why not start with the Crazyflie :)

Goal

Pretty much this:

... but with a map generated while doing it, and using navigate with it. And... being able to do this on a real Crazyflie too! How hard can it be? :D

But no seriously, I hope to at least get the SLAM mapping toolbox to work by the end of the summer 2022, and from there it is an ongoing project that can pretty much go on. If we got something working and stable, it could be part of an official Crazyflie_ROS2 package that we release in the future. Also it would be great to show these with existing packages like SLAM_toolbox or NAV2.

For now this project is on my personal github repo for now and once there is something solid working it will be probably transfered to the Bitcraze Github organization.

Explanation per package

• crazyflie_ros2: The Crazyflie package that has contact with the Crazyflie directly and publishes the transforms
• crazyflie_ros2_description: The package that handles the RVIZ screen and also includes meshes if necessary
• crazyflie_ros2_simulation: A webots simulator world and ROS node controller (based on the experimental bitcraze simulation repo)
• crazyflie_ros2_slam: Using an existing SLAM toolbox to create a map
• ... more to come (check planning)

How to run

Still very experimental and not ready yet!

Real Crazyflie with Slam toolbox (no control)

You will need an STEM ranging bundle for this...

ros2 launch crazyflie_ros2_slam slam_toolbox_mapping_launch.py 

Simulated Crazyflie (no SLAM yet)

ros2 launch crfazyflie_ros2_simulation robot_launch.py

Planning

• Make a publish ROS2 node for crazyflie (with cflib) to publish pose and transform
• Make crazyflie description package with RVIZ visualization file and crazyfie robot mesh
• Make crazyflie_ros2_slam node starting with the slam_toolbox's parameters
• Connect crazyflie_ros node to the crazyflie_ros2_node and generate an map with Rviz (needs tuning in simulation first
• Make crazyflie_ros2_simulation package with Webots
• Turn the multiranger pointcloud example into a rosnode equivalent (crazyflie_ros2_simple_map)
• Connect webots simulation to the SLAM toolbox
• In Simulation tune the SLAM toolbox to work for 4 laser rangers (if possible)
• If tunable, try out on real crazyflie + multiranger
• Make a NAV2 package that can do something with the map
• Implement wall following?
• If available, use python bindings of the Crazyflie's onboard EKF
• Try out new multi-zone multiranger deck

Issues to solve

• crazyflie_ros needs to publish odometry messages properly
• replace manual crazyflie robot after webot's release

Some handy things for me to remember:

For installing cflib as an external dependency

sudo mkdir -p /usr/local/share/ros && sudo cp cflib-python.yaml /usr/local/share/ros

echo "yaml file:///usr/local/share/ros/cflib-python.yaml" | sudo tee -a /etc/ros/rosdep/sources.list.d/20-default.list
rosdep update

rosdep install --from-paths src --ignore-src -r -y 

WSL use https://github.com/dorssel/usbipd-win/wiki/WSL-support

Run TF tree viewer

ros2 run rqt_tf_tree rqt_tf_tree --force-discover

Problem gui wsl microsoft/wslg#554

LIBGL_ALWAYS_SOFTWARE=true

 ros2 launch slam_toolbox online_async_launch.py