First commit
Merge https://github.com/pqhieu/hcmus-rgbd-slam