nichkara/rapier
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fix check for motor constraints on angular DoF

Browse Source
This commit is contained in:
Dzmitry Malyshau
2023-12-01 23:34:10 -08:00
parent e9ea2ca10b
commit e4bf6914c7
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/dynamics/solver/joint_constraint/joint_generic_velocity_constraint.rs
View File

@@ -89,7 +89,7 @@ impl JointGenericVelocityConstraint {
let start = len; let start = len;
for i in DIM..SPATIAL_DIM { for i in DIM..SPATIAL_DIM {
if (motor_axes >> DIM) & (1 << i) != 0 { if motor_axes & (1 << i) != 0 {
out[len] = builder.motor_angular_generic( out[len] = builder.motor_angular_generic(
params, params,
jacobians, jacobians,
@@ -385,7 +385,7 @@ impl JointGenericVelocityGroundConstraint {
let start = len; let start = len;
for i in DIM..SPATIAL_DIM { for i in DIM..SPATIAL_DIM {
if (motor_axes >> DIM) & (1 << i) != 0 { if motor_axes & (1 << i) != 0 {
out[len] = builder.motor_angular_generic_ground( out[len] = builder.motor_angular_generic_ground(
params, params,
jacobians, jacobians,