Added TrainStatus

fix bugs
fix velocity calculation