Planning: fixed an inconsistent trajectory issue by using historical speed data to estimate travel distance at each evaluate time. (#1833)