Stereo Vision Multi Agent Pathfinding

Stereo depth (SGBM) and multi-agent 3D pathfinding