Changed Graph SLAM implementation to match the interface of SLAM class. Basically changed two sending data methods into one.
issueID #10