Implemented boosting, might want to add linear interpolation for speed vector later on