correct(?) math for updating movetos, and use endpoint of previous not current geometry