六关节机器人正反解及模型opengl显示