I'm sorry that you clicked in this repository because This is NOT a SLAM research but only part of my homework of Numeric Methods course, so this is NOT gonna be a fast implementation. :) But if you ...