SLAM implementation with indoor environement geometric constraints.