diff --git a/src/narrowphase/narrowphase.cpp b/src/narrowphase/narrowphase.cpp index 4102e0314dcf430d091f932a3de9636d4ed53ca7..adcda2fc4329bf92e91a5c917ca6bcb85abef93d 100644 --- a/src/narrowphase/narrowphase.cpp +++ b/src/narrowphase/narrowphase.cpp @@ -150,7 +150,7 @@ bool sphereSphereIntersect(const Sphere& s1, const Transform3f& tf1, } if(contact_points) - *contact_points = tf1.transform(Vec3f()) + diff * 0.5; + *contact_points = tf1.transform(Vec3f()) - diff * s1.radius / (s1.radius + s2.radius); return true; }