六轴机械臂控制

关节 1 (基座旋转)
关节 2 (肩部俯仰)
关节 3 (肘部俯仰)
关节 4 (腕部旋转)
关节 5 (腕部俯仰)
关节 6 (末端旋转)
末端位置:
X: 0.00, Y: 200.00, Z: 0.00