removed obsolete set(…)
fixed typo in math of getOriginalPosition