PID参数

位置环

速度环

电流环

$K_p$

100

0.5

4.6

$K_i$

0

3

0

$K_d$

2

0

0