Hi,
generate a 3D map and navigate within a 3D environment
as you are on RaspberryPi 4B, I would recommend to revise if you really need to see the environment in 3D. If the robot is a ground robot, you should be able to approximate most environments in 2D and use Nav2. The trajectory can still be estimated in 6DoF (terrain not flat), but the occupancy grid / costmap could be projected in 2D. Note that the 2D occupancy grid can indirectly include 3D obstacles. See turtlebot + RGB-D camera obstacle detection and 2d map generation demo:
https://github.com/introlab/rtabmap_ros/tree/ros2/rtabmap_demos#turtlebot3-nav2-and-rgb-d-slamcheers,
Mathieu