Хабр Курсы для всех
РЕКЛАМА
Практикум, Хекслет, SkyPro, авторские курсы — собрали всех и попросили скидки. Осталось выбрать!

Как вы отбираете точки в 3D для первоначальной инициализации?
Обычно для отбора точек используют ransac. Я такое делал и доделал лет 10 - 15 назад. https://www.youtube.com/watch?v=-6V---caG9k
Visual SLAM (Python)