用数值解法求解逆运动学问题不是最好的选择。如果您找不到分析解决方案,您应该选择该选项。顺便提一下,精心设计的机器人应该有一个清晰的反向运动学模型。
对于您的机器人,这里是逆运动学模型: https://smartech.gatech.edu/bitstream/handle/1853/50782/ur_kin_tech_report_1.pdf