去除多余函数和测试代码
添加加速度计算