diff --git a/src/dwa.c b/src/dwa.c index b65ec79..54d1fd0 100644 --- a/src/dwa.c +++ b/src/dwa.c @@ -9,7 +9,7 @@ createDynamicWindow(Velocity velocity, Config config, DynamicWindow **dynamicWin float minW = max(-config.maxYawrate, velocity.angularVelocity - config.maxdYawrate * config.dt); float maxW = - max(config.maxYawrate, velocity.angularVelocity + config.maxdYawrate * config.dt); + min(config.maxYawrate, velocity.angularVelocity + config.maxdYawrate * config.dt); int nPossibleV = (maxV - minV) / config.velocityResolution; int nPossibleW = (maxW - minW) / config.yawrateResolution;