def test_ConstructionInfo_to_RigidBody(self): """ Verify that the initial motion state is transferred correctly to the RigidBody. """ mass = 10 pos = Vec3(1, 2, 3) rot = Quaternion(0, 1, 0, 0) t = Transform(rot, pos) ms = DefaultMotionState(t) cs = EmptyShape() inert = Vec3(1, 2, 4) # Compile the Rigid Body parameters. ci = RigidBodyConstructionInfo(mass, ms, cs, Vec3(2, 4, 6)) assert ci.localInertia == Vec3(2, 4, 6) ci.localInertia = inert assert ci.localInertia == inert # Construct the rigid body and delete the construction info. body = RigidBody(ci) del ci # Verify that the object is at the correct position and has the correct # mass and inertia. t = body.getMotionState().getWorldTransform() assert t.getOrigin() == pos assert t.getRotation() == rot assert body.getInvMass() == 1 / mass assert body.getInvInertiaDiagLocal() == Vec3(1, 0.5, 0.25)