This repository contains outdated version of code which was as an attachment to my bachelors thesis. If you would like to use my package please refer to development repo https://github.com/Lukx19/dynamic_slam .