Added GraphSLAM experimentation stuff.
issueID #11