stv0g
/
collision-probability
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

fixed invalid distance calculation for collision_circle

This commit is contained in:
Steffen Vogel 2016-06-06 14:30:05 +02:00
parent a5c7025d0c
commit 6893eb93ca
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
collision_probabilty.cpp
View File

@ -127,7 +127,7 @@ bool collision_circle(const Vector3d &vehicle, const Vector3d &obstacle)
Vector3d delta = vehicle - obstacle;
return delta.norm() < minDistance; /* Collision occured if distance (r) is smaller than 1 */
return delta.head(2).norm() < minDistance; /* Collision occured if distance (r) is smaller than 1 */
}
double collision_probability(CollisionFunction cfunc, MultivariateNormalDistribution &vehicle, MultivariateNormalDistribution &obstacle)