1、整理打印调试；
2、缩短命令发送间隔；
1、提高采样频率和串口速率，从而让机械臂动作更平滑；