Merge pull request #560 from kvark/wheel-joint

Fix check for motor constraints on angular DoF
This commit is contained in:
Sébastien Crozet
2023-12-10 12:26:09 +01:00
committed by GitHub

View File

@@ -89,7 +89,7 @@ impl JointGenericVelocityConstraint {
let start = len;
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(
params,
jacobians,
@@ -385,7 +385,7 @@ impl JointGenericVelocityGroundConstraint {
let start = len;
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(
params,
jacobians,