PID参数

位置环

速度环

电流环

$K_p$

90

12

4.6

$K_i$

0

6

0

$K_d$

20

1.5

0