Hi there, you are solving inverse kinematics?
I am a robotics researcher.
I just check the file, I am also doing inverse kinematics using particle swarm optimization. The same idea that I generate circle and perform the operation.
I take values from file and save the joints angles in text file
Maybe I can help, I can show you my results in chat.
Looking forward to hearing from you.