Good chance we have to use ROS to make life easier

High Level

Lidar

  1. SLAM

Camera

Computer Vision

  1. Edge Detection (Sobel / Canny)
  2. VSLAM
    1. ORB-SLAM2 https://github.com/weixr18/Pi-SLAM

Path Planning

  1. Visual Inertial Odometry (lightweight af and can run on pi)
    1. https://docs.px4.io/main/en/computer_vision/visual_inertial_odometry.html

Server