编写了用于测试运动参数的track函数

track函数会执行若干电机运动，同时以50hz读取AGC和XY陀螺，存储在ram中等待指令再通过串口输出