Um es mal so auszudrücken. Erwarte nicht in einem Forum, dass jemand für dich die Dreckarbeit bzw. die Fleißarbeit abnimmt und sei es nur die Fleißarbeit die darin steckt eine Programmiersprache besser zu lernen.
Vor allem solltest du zumindest dazu schreiben welches System du verwendest, was dort wie abläuft.

Nach kurz drauf schauen auf deinen code: Berechne zuerst alle Positionen, speicher sie dir und setz sie dann auf einen Rutsch.