From aa61fe65e3ff0289ecab57b4053a3410cf6d4a87 Mon Sep 17 00:00:00 2001 From: Crozet Sébastien Date: Mon, 4 Jan 2021 15:14:25 +0100 Subject: Add support of 64-bits reals. --- .../revolute_position_constraint.rs | 34 +++++++++++----------- 1 file changed, 17 insertions(+), 17 deletions(-) (limited to 'src/dynamics/solver/joint_constraint/revolute_position_constraint.rs') diff --git a/src/dynamics/solver/joint_constraint/revolute_position_constraint.rs b/src/dynamics/solver/joint_constraint/revolute_position_constraint.rs index 876ce31..e46e0e4 100644 --- a/src/dynamics/solver/joint_constraint/revolute_position_constraint.rs +++ b/src/dynamics/solver/joint_constraint/revolute_position_constraint.rs @@ -1,5 +1,5 @@ use crate::dynamics::{IntegrationParameters, RevoluteJoint, RigidBody}; -use crate::math::{AngularInertia, Isometry, Point, Rotation, Vector}; +use crate::math::{AngularInertia, Isometry, Point, Real, Rotation, Vector}; use crate::utils::WAngularInertia; use na::Unit; @@ -8,20 +8,20 @@ pub(crate) struct RevolutePositionConstraint { position1: usize, position2: usize, - im1: f32, - im2: f32, + im1: Real, + im2: Real, - ii1: AngularInertia, - ii2: AngularInertia, + ii1: AngularInertia, + ii2: AngularInertia, - lin_inv_lhs: f32, - ang_inv_lhs: AngularInertia, + lin_inv_lhs: Real, + ang_inv_lhs: AngularInertia, - local_anchor1: Point, - local_anchor2: Point, + local_anchor1: Point, + local_anchor2: Point, - local_axis1: Unit>, - local_axis2: Unit>, + local_axis1: Unit>, + local_axis2: Unit>, } impl RevolutePositionConstraint { @@ -49,7 +49,7 @@ impl RevolutePositionConstraint { } } - pub fn solve(&self, params: &IntegrationParameters, positions: &mut [Isometry]) { + pub fn solve(&self, params: &IntegrationParameters, positions: &mut [Isometry]) { let mut position1 = positions[self.position1 as usize]; let mut position2 = positions[self.position2 as usize]; @@ -83,10 +83,10 @@ impl RevolutePositionConstraint { #[derive(Debug)] pub(crate) struct RevolutePositionGroundConstraint { position2: usize, - anchor1: Point, - local_anchor2: Point, - axis1: Unit>, - local_axis2: Unit>, + anchor1: Point, + local_anchor2: Point, + axis1: Unit>, + local_axis2: Unit>, } impl RevolutePositionGroundConstraint { @@ -122,7 +122,7 @@ impl RevolutePositionGroundConstraint { } } - pub fn solve(&self, params: &IntegrationParameters, positions: &mut [Isometry]) { + pub fn solve(&self, params: &IntegrationParameters, positions: &mut [Isometry]) { let mut position2 = positions[self.position2 as usize]; let axis2 = position2 * self.local_axis2; -- cgit