PID参数

位置环

速度环

电流环

K p

90

8

4.6

K i

0

3

0

K d

20

1.5

0