Implementation of SLAM algorithm for Into to Autonomous Mobile Robotics final project