diff --git a/src/lookahead.c b/src/lookahead.c index ea16c07..8af3688 100644 --- a/src/lookahead.c +++ b/src/lookahead.c @@ -85,7 +85,7 @@ void sim_update(trial* t){ radar_dgl(t,tm->ts); /*calculate misspredict*/ - fprintf(stderr, "Miss predict: dx=%f, dy=%f, ddir=%f (%f %f), steps=%u\n", + fprintf(stderr, "Miss predict: dx=%f, dy=%f, ddir=%f, steps=%u\n", t->sim.tm.vehicle.x - t->vehicle.x, t->sim.tm.vehicle.y - t->vehicle.y, fixangle(t->sim.tm.vehicle.dir - t->vehicle.dir), @@ -138,7 +138,7 @@ int dgl(trial* t, vehicle* after, vehicle* before, timestamp h, timestamp deltat tmp.x += dt*diff.x; tmp.y += dt*diff.y; // tmp.speed += (tmp.speed > 0) ? 1000*dt*diff.speed : 0; - tmp.speed = fmax(0, tmp.speed + dt*diff.speed); + tmp.speed = fmax(0, tmp.speed + dt*diff.speed/1000); tmp.w += dt*diff.w; tmp.dir += dt*diff.dir;