SLAM Algorithm on the MILOJE Robot