SLAM module added

A functioning SLAM module added. Needs documentation and additional
methods will be added later. Included is a testing module for SLAM.
This SLAM is based on the SLAM introduced in Udacity AI course, but uses
Numpy arrays and is accessed differently.