private void CreateSubpartsConstraint(MyEntitySubpart subpart)
{
m_subpartsFixedData = new HkFixedConstraintData();
m_subpartsFixedData.SetSolvingMethod(HkSolvingMethod.MethodStabilized);
m_subpartsFixedData.SetInertiaStabilizationFactor(1);
var matAD = MatrixD.CreateWorld(Position * CubeGrid.GridSize + Vector3D.Transform(Vector3D.Transform(m_subpartsConstraintPos, WorldMatrix), CubeGrid.PositionComp.LocalMatrix), PositionComp.LocalMatrix.Forward, PositionComp.LocalMatrix.Up);
matAD.Translation = CubeGrid.Physics.WorldToCluster(matAD.Translation);
var matA = (Matrix)matAD;
var matB = subpart.PositionComp.LocalMatrix;
m_subpartsFixedData.SetInWorldSpace(ref matA, ref matB, ref matB);
//Dont dispose the fixed data or we wont have access to them
HkConstraintData constraintData = m_subpartsFixedData;
m_subpartsConstraint = new HkConstraint(CubeGrid.Physics.RigidBody, m_subpartPhysics.RigidBody, constraintData);
var info = CubeGrid.Physics.RigidBody.GetCollisionFilterInfo();
info = HkGroupFilter.CalcFilterInfo(CubeGrid.Physics.RigidBody.Layer, HkGroupFilter.GetSystemGroupFromFilterInfo(info), 1, 1);
m_subpartPhysics.RigidBody.SetCollisionFilterInfo(info);
CubeGrid.Physics.HavokWorld.RefreshCollisionFilterOnEntity(m_subpartPhysics.RigidBody);
Debug.Assert(m_subpartsConstraint.RigidBodyA != null);
m_subpartsConstraint.WantRuntime = true;
}
private void CreateSubpartsConstraint(MyEntitySubpart subpart)
{
m_subpartsFixedData = new HkFixedConstraintData();
m_subpartsFixedData.SetSolvingMethod(HkSolvingMethod.MethodStabilized);
m_subpartsFixedData.SetInertiaStabilizationFactor(1);
var matAD = MatrixD.CreateWorld(Position * CubeGrid.GridSize + Vector3D.Transform(Vector3D.Transform(m_subpartsConstraintPos, WorldMatrix), CubeGrid.PositionComp.LocalMatrix), PositionComp.LocalMatrix.Forward, PositionComp.LocalMatrix.Up);
matAD.Translation = CubeGrid.Physics.WorldToCluster(matAD.Translation);
var matA = (Matrix)matAD;
var matB = subpart.PositionComp.LocalMatrix;
m_subpartsFixedData.SetInWorldSpace(ref matA, ref matB, ref matB);
//Dont dispose the fixed data or we wont have access to them
HkConstraintData constraintData = m_subpartsFixedData;
if (Sync.IsServer) // Breakable only on server
{
constraintData = new HkBreakableConstraintData(m_subpartsFixedData)
{
Threshold = BreakOffTreshold
};
}
m_subpartsConstraint = new HkConstraint(CubeGrid.Physics.RigidBody, subpart.Physics.RigidBody, constraintData);
Debug.Assert(m_subpartsConstraint.RigidBodyA != null);
m_subpartsConstraint.WantRuntime = true;
}
private void Attach(MyEntity entity, Vector3 gearSpacePivot, Matrix otherBodySpacePivot)
{
if (CubeGrid.Physics != null && CubeGrid.Physics.Enabled)
{
var body = entity.Physics.RigidBody;
var handle = StateChanged;
if (Sync.IsServer && entity is MyCubeGrid)
{
(entity as MyCubeGrid).OnGridSplit += CubeGrid_OnGridSplit;
}
if (MyFakes.WELD_LANDING_GEARS && CanWeldTo(entity, ref otherBodySpacePivot))
{
if (m_attachedTo != null || entity == null)
{
return;
}
if (entity is MyVoxelBase)
{
if (CubeGrid.Physics.RigidBody.IsFixed == false)
{
CubeGrid.Physics.ConvertToStatic();
m_converted = true;
}
}
else
{
MyWeldingGroups.Static.CreateLink(EntityId, CubeGrid, entity);
}
//OnConstraintAdded(GridLinkTypeEnum.LandingGear, entity);
m_lockModeSync.Value = LandingGearMode.Locked;
m_attachedTo = entity;
m_attachedTo.OnPhysicsChanged += m_physicsChangedHandler;
this.OnPhysicsChanged += m_physicsChangedHandler;
if (CanAutoLock)
{
ResetAutolock();
}
OnConstraintAdded(GridLinkTypeEnum.Physical, entity);
//OnConstraintAdded(GridLinkTypeEnum.NoContactDamage, entity);
if (!m_needsToRetryLock)
{
StartSound(m_lockSound);
}
if (handle != null)
{
handle(true);
}
return;
}
//var entity = body.GetBody().Entity;
Debug.Assert(m_attachedTo == null, "Already attached");
Debug.Assert(entity != null, "Landing gear is attached to body which has no entity");
Debug.Assert(m_constraint == null);
if (m_attachedTo != null || entity == null || m_constraint != null)
{
return;
}
body.Activate();
CubeGrid.Physics.RigidBody.Activate();
m_attachedTo = entity;
m_attachedTo.OnPhysicsChanged += m_physicsChangedHandler;
this.OnPhysicsChanged += m_physicsChangedHandler;
Matrix gearLocalSpacePivot = Matrix.Identity;
gearLocalSpacePivot.Translation = gearSpacePivot;
var fixedData = new HkFixedConstraintData();
if (MyFakes.OVERRIDE_LANDING_GEAR_INERTIA)
{
fixedData.SetInertiaStabilizationFactor(MyFakes.LANDING_GEAR_INTERTIA);
}
else
{
fixedData.SetInertiaStabilizationFactor(1);
}
fixedData.SetSolvingMethod(HkSolvingMethod.MethodStabilized);
fixedData.SetInBodySpace(gearLocalSpacePivot, otherBodySpacePivot, CubeGrid.Physics, entity.Physics as MyPhysicsBody);
HkConstraintData data = fixedData;
if (MyFakes.LANDING_GEAR_BREAKABLE && BreakForce < MyObjectBuilder_LandingGear.MaxSolverImpulse)
{
var breakData = new HkBreakableConstraintData(fixedData);
fixedData.Dispose();
breakData.Threshold = BreakForce;
breakData.ReapplyVelocityOnBreak = true;
breakData.RemoveFromWorldOnBrake = true;
data = breakData;
}
if (!m_needsToRetryLock)
{
StartSound(m_lockSound);
}
m_constraint = new HkConstraint(CubeGrid.Physics.RigidBody, body, data);
CubeGrid.Physics.AddConstraint(m_constraint);
m_constraint.Enabled = true;
m_lockModeSync.Value = LandingGearMode.Locked;
if (CanAutoLock)
{
ResetAutolock();
}
OnConstraintAdded(GridLinkTypeEnum.Physical, entity);
OnConstraintAdded(GridLinkTypeEnum.NoContactDamage, entity);
if (handle != null)
{
handle(true);
}
}
}
private void Attach(HkRigidBody body, Vector3 gearSpacePivot, Matrix otherBodySpacePivot)
{
if (CubeGrid.Physics.Enabled)
{
var entity = body.GetEntity();
Debug.Assert(m_attachedTo == null, "Already attached");
Debug.Assert(entity != null, "Landing gear is attached to body which has no entity");
Debug.Assert(m_constraint == null);
if (m_attachedTo != null || entity == null || m_constraint != null)
{
return;
}
body.Activate();
CubeGrid.Physics.RigidBody.Activate();
m_attachedTo = entity;
if (entity != null)
{
entity.OnPhysicsChanged += m_physicsChangedHandler;
}
this.OnPhysicsChanged += m_physicsChangedHandler;
Matrix gearLocalSpacePivot = Matrix.Identity;
gearLocalSpacePivot.Translation = gearSpacePivot;
var fixedData = new HkFixedConstraintData();
if (MyFakes.OVERRIDE_LANDING_GEAR_INERTIA)
{
fixedData.SetInertiaStabilizationFactor(MyFakes.LANDING_GEAR_INTERTIA);
}
else
{
fixedData.SetInertiaStabilizationFactor(1);
}
fixedData.SetSolvingMethod(HkSolvingMethod.MethodStabilized);
fixedData.SetInBodySpace(ref gearLocalSpacePivot, ref otherBodySpacePivot);
HkConstraintData data = fixedData;
if (MyFakes.LANDING_GEAR_BREAKABLE && BreakForce < MaxSolverImpulse)
{
var breakData = new HkBreakableConstraintData(fixedData);
fixedData.Dispose();
breakData.Threshold = BreakForce;
breakData.ReapplyVelocityOnBreak = true;
breakData.RemoveFromWorldOnBrake = true;
data = breakData;
}
if (!m_needsToRetryLock)
{
StartSound(m_lockSound);
}
m_constraint = new HkConstraint(CubeGrid.Physics.RigidBody, body, data);
CubeGrid.Physics.AddConstraint(m_constraint);
m_constraint.Enabled = true;
LockMode = LandingGearMode.Locked;
if (CanAutoLock)
{
ResetAutolock();
}
OnConstraintAdded(GridLinkTypeEnum.Physical, entity);
OnConstraintAdded(GridLinkTypeEnum.NoContactDamage, entity);
var handle = StateChanged;
if (handle != null)
{
handle(true);
}
}
}
