Implement SLAM or other algorithm for obstacle avoidance and localization

[crose72]

Currently we are able to detect and track targets. These algorithms don't account for obstacles in the flight path of the drone. A visual or lidar SLAM method (or combination) is needed to locate obstacles in the flight path of the drone so that the drone can adjust it's flight path. ORB SLAM3 is the current method that seems like a good option. Figure out how to implement it and determine how well it works.