Fix bug in nativeccd multiccd.
PiperOrigin-RevId: 740495321 Change-Id: I7eaa0da8514e27c233d49567c276d1d238808d1f
This commit is contained in:
committed by
Copybara-Service
parent
69f8349203
commit
d6943731b2
@@ -1546,7 +1546,7 @@ static mjtNum planeNormal(mjtNum res[3], const mjtNum v1[3], const mjtNum v2[3],
|
||||
// find what side of a plane a point p lies
|
||||
static int halfspace(const mjtNum a[3], const mjtNum n[3], const mjtNum p[3]) {
|
||||
mjtNum diff[3] = {p[0] - a[0], p[1] - a[1], p[2] - a[2]};
|
||||
return dot3(diff, n) > 0;
|
||||
return dot3(diff, n) >= 0.0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user