PID参数
位置环
速度环
电流环
K
p
100
0.5
4.6
K
i
0
3
0
K
d
2
0
0