Fixed linking. Updated example algorithm, README, slam.