Pendel

Hallo,
ich habe ein Problem bei einem Programm, welches den Verlauf (Ort, Geschwindigkeit) eines Fadenpendels simulieren soll und dies dann in Diagrammen anzeigt.
Die Überlegung war, dass man dabei die Ausgangsgeschwindigkeit/-beschleunigung, sowie die Pendellänge und Auslenkwinkel selber bestimmen kann.

Als Ausgang hab ich die Gleichung φ(t)=φ^*sin⁡(ωt+φ(0)) genommen.
Mit φ^= Maximale Auslenkung, φ(0)= Startauslenkwinkel und ω=Winkelgeschwindigkeit, (t-Zeit).
Die Winkelgeschwindigkeit berechnet sich aus ω=sqrt(g/l) (l=Pendellänge).
Nun hab ich die Berechung in eine While-Schleife gepackt und hab mit der Case-Struktur die Bedingung erstellt, dass wenn das Fadenpendel den niedrigsten Punkt erreicht, die Erdbeschleunigung entgegen wirkt und solange der Punkt noch nicht erreicht ist, ganz normal die eingestellte Beschleunigung auf das Pendel wirkt. Zusätzlich hab ich noch eine erforderlich Dämpfung mit eingebracht.
Zum Schluss sollen dann einfach die errechneten Werte wieder als Ausgang dienen.

Ich hab jetzt viel ausprobiert und umgestellt, trotzdem wird nicht wirklich das ausgegeben, was ich will bzw. was es soll.
Bin mir auch nicht ganz sicher, ob es an den Berechnungen liegt oder irgendwo nur ein Logikfehler ist.
Vieleicht findet ihr das Problem, an dem es liegen könnte, bzw. habt einen Tipp für mich
Wenn ihr das Programm selber durchlaufen lassen wollt:
Für den Auslenkwinkel muss das Bogenmaß genommen werden φ<1 und für die Dämpfung ein Wert zwischen 0 und -1. Der Rest ist eigentlich relativ egal.

Falls irgendetwas unklar sein sollte, wie ich mir an irgendeiner Stelle etwas gedacht hatte, müsst ihr bitte nochmal nachfragen.
Vorab schonmal vielen Dank für eure Hilfe.