Implement non-linear position stabilization for the generic constraint.

This commit is contained in:
Crozet Sébastien
2021-02-15 11:20:09 +01:00
parent d9b6198fa0
commit de39a41faa
6 changed files with 591 additions and 205 deletions

View File

@@ -89,8 +89,8 @@ impl PrismaticJoint {
Unit::try_new(local_axis1.cross(&local_tangent1), 1.0e-3)
{
[
local_bitangent1.into_inner(),
local_bitangent1.cross(&local_axis1),
local_bitangent1.into_inner(),
]
} else {
local_axis1.orthonormal_basis()
@@ -100,8 +100,8 @@ impl PrismaticJoint {
Unit::try_new(local_axis2.cross(&local_tangent2), 2.0e-3)
{
[
local_bitangent2.into_inner(),
local_bitangent2.cross(&local_axis2),
local_bitangent2.into_inner(),
]
} else {
local_axis2.orthonormal_basis()