Added initial commit of SLAM scripts