Logic for updating joint center and adding points to joint totally changed and simultaneously drastically simplified.