fixing bugs

1. 解决SensorErrorState导致停止响应的错误
2. 解决火车速度的分配问题
addding new functions

1. NXT端增加了颜色传感器的缓冲区
2. PC端增加了状态切换的暂停时间
fixing bugs