Singularitätsproblem beim inversen kinematischen Löser

Ich habe tagelang mit diesem Problem zu kämpfen. Ich hoffe wirklich, dass mir jemand einen Hinweis geben kann, wo das Problem liegt. Der Roboter besteht aus 5 Achsen. Die erste Achse dreht sich um die z-Achse und die anderen 4 Achsen drehen sich um die y-Achse. Und der Solver funktioniert im...