Das, was du da hast, ist im Prinzip ein spezieller Fall der Vektorrechnung, die ich oben beschrieben habe. Für den Anfang kannst du damit ruhig weiter arbeiten. Langfristig wirst du aber vermutlich feststellen, dass es einfacher ist, die ganze Berechnung nur einmal, nämlich im Rahmen der Vektorfunktionen, zu programmieren, anstatt sie für verschiedene Situationen anpassen zu müssen. Aber bis dahin, viel Spaß