File tree Expand file tree Collapse file tree 2 files changed +3
-3
lines changed
Expand file tree Collapse file tree 2 files changed +3
-3
lines changed Original file line number Diff line number Diff line change @@ -194,12 +194,12 @@ GeomGeomCollider<T>::CalcForceBasisInWorldFrame(
194194 const auto query_result = GetGeometryQueryResult (context);
195195 if (num_friction_directions < 1 ) {
196196 // Planar contact: basis is constructed from the contact and planar normals.
197- return ComputePlanarForceBasis (query_result.signed_distance_pair .nhat_BA_W ,
197+ return ComputePlanarForceBasis (- query_result.signed_distance_pair .nhat_BA_W ,
198198 planar_normal);
199199 } else {
200200 // 3D contact: build polytope basis and rotate using contact normal.
201201 auto R_WC = drake::math::RotationMatrix<T>::MakeFromOneVector (
202- query_result.signed_distance_pair .nhat_BA_W , 0 );
202+ - query_result.signed_distance_pair .nhat_BA_W , 0 );
203203 return ComputePolytopeForceBasis (num_friction_directions) *
204204 R_WC.matrix ().transpose ();
205205 }
Original file line number Diff line number Diff line change @@ -419,7 +419,7 @@ std::vector<LCSContactDescription> LCSFactory::GetContactDescriptions() {
419419 contact_descriptions.at (i).witness_point_A ==
420420 normal_contact_descriptions.at (normal_index).witness_point_A );
421421 contact_descriptions.at (i).force_basis =
422- - contact_descriptions.at (i).force_basis +
422+ contact_descriptions.at (i).force_basis +
423423 mu_[normal_index] *
424424 normal_contact_descriptions.at (normal_index).force_basis ;
425425 }
You can’t perform that action at this time.
0 commit comments