Add calculations for self localization.