added some speed planning tests