Ich weiss nicht ob hier jemand Lust hat, deinen nicht kommentierten Code zu studieren. Wenn du das ganze Projekt postest hast du vermutlich bessere Chancen auf eine Antwort. So wie es für mich auf den ersten Augenblick aussieht ist deine Berechnung auf jeden Fall nicht physikalisch korrekt sondern irgendwie heuristisch.
Das muss man auf jeden Fall ganz anders angehen. Die Bewegungsgleichung eines Fadenpendels lautet l*a=-g*sin(w), wobei a die Winkelbeschleunigung, w der Winkel, l die Länge des Pendels und g die Fallbeschleunigung ist. Wenn für dich nur kleine Winkel |w|<5° interessant sind macht der Winkel nur eine Sinusschwingung. Ansonsten musst du die Gleichung numerisch lösen. Es gibt aber auch geschlossene Näherungslösungen. Siehe Wikipedia oder Google.
Das wird dir zwar nicht viel bringen aber hier habe ich noch ein ähnliches Projekt mit einem Doppelpendel:
www.delphi-forum.de/...ndel+V101_42187.html