Calculation of localization error using tf.

Gazebo link_state service couldn't retrieve the state at a given time in
the past. TF allows this because it buffers past tfs and interpolates
the robot position.