SLAM update. Confidence parameter.

Option to add confidence score to each motion or landmark measurements.