Initialized KnownPos and Dist to 0