123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709 |
- /*
- * Copyright (c) Contributors, http://opensimulator.org/
- * See CONTRIBUTORS.TXT for a full list of copyright holders.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * * Redistributions in binary form must reproduce the above copyrightD
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * * Neither the name of the OpenSimulator Project nor the
- * names of its contributors may be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE DEVELOPERS ``AS IS'' AND ANY
- * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
- * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
- * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
- * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- using System;
- using System.Collections.Generic;
- using System.Text;
- using OMV = OpenMetaverse;
- using OpenSim.Framework;
- using OpenSim.Region.PhysicsModules.SharedBase;
- namespace OpenSim.Region.PhysicsModule.BulletS
- {
- /*
- * Class to wrap all objects.
- * The rest of BulletSim doesn't need to keep checking for avatars or prims
- * unless the difference is significant.
- *
- * Variables in the physicsl objects are in three forms:
- * VariableName: used by the simulator and performs taint operations, etc
- * RawVariableName: direct reference to the BulletSim storage for the variable value
- * ForceVariableName: direct reference (store and fetch) to the value in the physics engine.
- * The last one should only be referenced in taint-time.
- */
- /*
- * As of 20121221, the following are the call sequences (going down) for different script physical functions:
- * llApplyImpulse llApplyRotImpulse llSetTorque llSetForce
- * SOP.ApplyImpulse SOP.ApplyAngularImpulse SOP.SetAngularImpulse SOP.SetForce
- * SOG.ApplyImpulse SOG.ApplyAngularImpulse SOG.SetAngularImpulse
- * PA.AddForce PA.AddAngularForce PA.Torque = v PA.Force = v
- * BS.ApplyCentralForce BS.ApplyTorque
- */
- // Flags used to denote which properties updates when making UpdateProperties calls to linksets, etc.
- public enum UpdatedProperties : uint
- {
- Position = 1 << 0,
- Orientation = 1 << 1,
- Velocity = 1 << 2,
- Acceleration = 1 << 3,
- RotationalVelocity = 1 << 4,
- EntPropUpdates = Position | Orientation | Velocity | Acceleration | RotationalVelocity,
- }
- public abstract class BSPhysObject : PhysicsActor
- {
- protected BSPhysObject()
- {
- }
- protected BSPhysObject(BSScene parentScene, uint localID, string name, string typeName)
- {
- IsInitialized = false;
- PhysScene = parentScene;
- LocalID = localID;
- PhysObjectName = name;
- Name = name; // PhysicsActor also has the name of the object. Someday consolidate.
- TypeName = typeName;
- // Oddity if object is destroyed and recreated very quickly it could still have the old body.
- if (!PhysBody.HasPhysicalBody)
- PhysBody = new BulletBody(localID);
- // Clean out anything that might be in the physical actor list.
- // Again, a workaround for destroying and recreating an object very quickly.
- PhysicalActors.Dispose();
- UserSetCenterOfMassDisplacement = null;
- PrimAssetState = PrimAssetCondition.Unknown;
- // Initialize variables kept in base.
- // Beware that these cause taints to be queued whch can cause race conditions on startup.
- GravModifier = 1.0f;
- Gravity = new OMV.Vector3(0f, 0f, BSParam.Gravity);
- HoverActive = false;
- // Default material type. Also sets Friction, Restitution and Density.
- SetMaterial((int)MaterialAttributes.Material.Wood);
- CollisionsLastTickStep = -1;
- SubscribedEventsMs = 0;
- // Crazy values that will never be true
- CollidingStep = BSScene.NotASimulationStep;
- CollidingGroundStep = BSScene.NotASimulationStep;
- CollisionAccumulation = BSScene.NotASimulationStep;
- ColliderIsMoving = false;
- CollisionScore = 0;
- // All axis free.
- LockedLinearAxis = LockedAxisFree;
- LockedAngularAxis = LockedAxisFree;
- }
- // Tell the object to clean up.
- public virtual void Destroy()
- {
- PhysicalActors.Enable(false);
- PhysScene.TaintedObject(LocalID, "BSPhysObject.Destroy", delegate()
- {
- PhysicalActors.Dispose();
- });
- }
- public BSScene PhysScene { get; protected set; }
- // public override uint LocalID { get; set; } // Use the LocalID definition in PhysicsActor
- public string PhysObjectName { get; protected set; }
- public string TypeName { get; protected set; }
- // Set to 'true' when the object is completely initialized.
- // This mostly prevents property updates and collisions until the object is completely here.
- public bool IsInitialized { get; protected set; }
- // Set to 'true' if an object (mesh/linkset/sculpty) is not completely constructed.
- // This test is used to prevent some updates to the object when it only partially exists.
- // There are several reasons and object might be incomplete:
- // Its underlying mesh/sculpty is an asset which must be fetched from the asset store
- // It is a linkset who is being added to or removed from
- // It is changing state (static to physical, for instance) which requires rebuilding
- // This is a computed value based on the underlying physical object construction
- abstract public bool IsIncomplete { get; }
- // Return the object mass without calculating it or having side effects
- public abstract float RawMass { get; }
- // Set the raw mass but also update physical mass properties (inertia, ...)
- // 'inWorld' true if the object has already been added to the dynamic world.
- public abstract void UpdatePhysicalMassProperties(float mass, bool inWorld);
- // The gravity being applied to the object. A function of default grav, GravityModifier and Buoyancy.
- public virtual OMV.Vector3 Gravity { get; set; }
- // The last value calculated for the prim's inertia
- public OMV.Vector3 Inertia { get; set; }
- // Reference to the physical body (btCollisionObject) of this object
- public BulletBody PhysBody = new BulletBody(0);
- // Reference to the physical shape (btCollisionShape) of this object
- public BSShape PhysShape = new BSShapeNull();
- // The physical representation of the prim might require an asset fetch.
- // The asset state is first 'Unknown' then 'Waiting' then either 'Failed' or 'Fetched'.
- public enum PrimAssetCondition
- {
- Unknown, Waiting, FailedAssetFetch, FailedMeshing, Fetched
- }
- public PrimAssetCondition PrimAssetState { get; set; }
- public virtual bool AssetFailed()
- {
- return ( (this.PrimAssetState == PrimAssetCondition.FailedAssetFetch)
- || (this.PrimAssetState == PrimAssetCondition.FailedMeshing) );
- }
- // The objects base shape information. Null if not a prim type shape.
- public PrimitiveBaseShape BaseShape { get; protected set; }
- // When the physical properties are updated, an EntityProperty holds the update values.
- // Keep the current and last EntityProperties to enable computation of differences
- // between the current update and the previous values.
- public EntityProperties CurrentEntityProperties { get; set; }
- public EntityProperties LastEntityProperties { get; set; }
- public virtual OMV.Vector3 Scale { get; set; }
- // It can be confusing for an actor to know if it should move or update an object
- // depeneding on the setting of 'selected', 'physical, ...
- // This flag is the true test -- if true, the object is being acted on in the physical world
- public abstract bool IsPhysicallyActive { get; }
- // Detailed state of the object.
- public abstract bool IsSolid { get; }
- public abstract bool IsStatic { get; }
- public abstract bool IsSelected { get; }
- public abstract bool IsVolumeDetect { get; }
- // Materialness
- public MaterialAttributes.Material Material { get; private set; }
- public override void SetMaterial(int material)
- {
- Material = (MaterialAttributes.Material)material;
- // Setting the material sets the material attributes also.
- // TODO: decide if this is necessary -- the simulator does this.
- MaterialAttributes matAttrib = BSMaterials.GetAttributes(Material, false);
- Friction = matAttrib.friction;
- Restitution = matAttrib.restitution;
- Density = matAttrib.density;
- // DetailLog("{0},{1}.SetMaterial,Mat={2},frict={3},rest={4},den={5}", LocalID, TypeName, Material, Friction, Restitution, Density);
- }
- public override float Density
- {
- get
- {
- return base.Density;
- }
- set
- {
- DetailLog("{0},BSPhysObject.Density,set,den={1}", LocalID, value);
- base.Density = value;
- }
- }
- // Stop all physical motion.
- public abstract void ZeroMotion(bool inTaintTime);
- public abstract void ZeroAngularMotion(bool inTaintTime);
- // Update the physical location and motion of the object. Called with data from Bullet.
- public abstract void UpdateProperties(EntityProperties entprop);
- // The position value as known by BulletSim. Does not effect the physics engine.
- public virtual OMV.Vector3 RawPosition { get; set; }
- // Set position in BulletSim and the physics engined to a value immediately. Must be called at taint time.
- public abstract OMV.Vector3 ForcePosition { get; set; }
- // The orientation value as known by BulletSim. Does not effect the physics engine.
- public virtual OMV.Quaternion RawOrientation { get; set; }
- // Set orientation in BulletSim and the physics engine to a value immediately. Must be called at taint time.
- public abstract OMV.Quaternion ForceOrientation { get; set; }
- // The velocity value as known by BulletSim. Does not effect the physics engine.
- public virtual OMV.Vector3 RawVelocity { get; set; }
- // Set velocity in BulletSim and the physics engined to a value immediately. Must be called at taint time.
- public abstract OMV.Vector3 ForceVelocity { get; set; }
- // The rotational velocity value as known by BulletSim. Does not effect the physics engine.
- public OMV.Vector3 RawRotationalVelocity { get; set; }
- // RawForce is a constant force applied to object (see Force { set; } )
- public OMV.Vector3 RawForce { get; set; }
- public OMV.Vector3 RawTorque { get; set; }
- public override void AddAngularForce(OMV.Vector3 force, bool pushforce)
- {
- AddAngularForce(false, force);
- }
- public abstract void AddAngularForce(bool inTaintTime, OMV.Vector3 force);
- public abstract void AddForce(bool inTaintTime, OMV.Vector3 force);
- // PhysicsActor.Velocity
- public override OMV.Vector3 Velocity
- {
- get { return RawVelocity; }
- set
- {
- // This sets the velocity now. BSCharacter will override to clear target velocity
- // before calling this.
- RawVelocity = value;
- PhysScene.TaintedObject(LocalID, TypeName + ".SetVelocity", delegate () {
- // DetailLog("{0},BSPhysObject.Velocity.set,vel={1}", LocalID, RawVelocity);
- ForceVelocity = RawVelocity;
- });
- }
- }
- // PhysicsActor.SetMomentum
- // All the physics engines use this as a way of forcing the velocity to something.
- // BSCharacter overrides this so it can set the target velocity to zero before calling this.
- public override void SetMomentum(OMV.Vector3 momentum)
- {
- this.Velocity = momentum;
- }
- public override OMV.Vector3 RotationalVelocity {
- get {
- return RawRotationalVelocity;
- }
- set {
- RawRotationalVelocity = value;
- Util.ClampV(RawRotationalVelocity, BSParam.MaxAngularVelocity);
- // m_log.DebugFormat("{0}: RotationalVelocity={1}", LogHeader, _rotationalVelocity);
- PhysScene.TaintedObject(LocalID, TypeName + ".setRotationalVelocity", delegate()
- {
- ForceRotationalVelocity = RawRotationalVelocity;
- });
- }
- }
- public OMV.Vector3 ForceRotationalVelocity {
- get {
- return RawRotationalVelocity;
- }
- set {
- RawRotationalVelocity = Util.ClampV(value, BSParam.MaxAngularVelocity);
- if (PhysBody.HasPhysicalBody)
- {
- DetailLog("{0},{1}.ForceRotationalVel,taint,rotvel={2}", LocalID, TypeName, RawRotationalVelocity);
- PhysScene.PE.SetAngularVelocity(PhysBody, RawRotationalVelocity);
- // PhysicsScene.PE.SetInterpolationAngularVelocity(PhysBody, _rotationalVelocity);
- ActivateIfPhysical(false);
- }
- }
- }
- public abstract float ForceBuoyancy { get; set; }
- public virtual bool ForceBodyShapeRebuild(bool inTaintTime) { return false; }
- public override bool PIDActive
- {
- get { return MoveToTargetActive; }
- set { MoveToTargetActive = value; }
- }
- public override OMV.Vector3 PIDTarget { set { MoveToTargetTarget = value; } }
- public override float PIDTau { set { MoveToTargetTau = value; } }
- public bool MoveToTargetActive { get; set; }
- public OMV.Vector3 MoveToTargetTarget { get; set; }
- public float MoveToTargetTau { get; set; }
- // Used for llSetHoverHeight and maybe vehicle height. Hover Height will override MoveTo target's Z
- public override bool PIDHoverActive {get {return HoverActive;} set { HoverActive = value; } }
- public override float PIDHoverHeight { set { HoverHeight = value; } }
- public override PIDHoverType PIDHoverType { set { HoverType = value; } }
- public override float PIDHoverTau { set { HoverTau = value; } }
- public bool HoverActive { get; set; }
- public float HoverHeight { get; set; }
- public PIDHoverType HoverType { get; set; }
- public float HoverTau { get; set; }
- // For RotLookAt
- public override OMV.Quaternion APIDTarget { set { return; } }
- public override bool APIDActive { set { return; } }
- public override float APIDStrength { set { return; } }
- public override float APIDDamping { set { return; } }
- // The current velocity forward
- public virtual float ForwardSpeed
- {
- get
- {
- OMV.Vector3 characterOrientedVelocity = RawVelocity * OMV.Quaternion.Inverse(OMV.Quaternion.Normalize(RawOrientation));
- return characterOrientedVelocity.X;
- }
- }
- // The forward speed we are trying to achieve (TargetVelocity)
- public virtual float TargetVelocitySpeed
- {
- get
- {
- OMV.Vector3 characterOrientedVelocity = TargetVelocity * OMV.Quaternion.Inverse(OMV.Quaternion.Normalize(RawOrientation));
- return characterOrientedVelocity.X;
- }
- }
- // The user can optionally set the center of mass. The user's setting will override any
- // computed center-of-mass (like in linksets).
- // Note this is a displacement from the root's coordinates. Zero means use the root prim as center-of-mass.
- public OMV.Vector3? UserSetCenterOfMassDisplacement { get; set; }
- public OMV.Vector3 LockedLinearAxis; // zero means locked. one means free.
- public OMV.Vector3 LockedAngularAxis; // zero means locked. one means free.
- public const float FreeAxis = 1f;
- public const float LockedAxis = 0f;
- public readonly OMV.Vector3 LockedAxisFree = new OMV.Vector3(FreeAxis, FreeAxis, FreeAxis); // All axis are free
- // If an axis is locked (flagged above) then the limits of that axis are specified here.
- // Linear axis limits are relative to the object's starting coordinates.
- // Angular limits are limited to -PI to +PI
- public OMV.Vector3 LockedLinearAxisLow;
- public OMV.Vector3 LockedLinearAxisHigh;
- public OMV.Vector3 LockedAngularAxisLow;
- public OMV.Vector3 LockedAngularAxisHigh;
- // Enable physical actions. Bullet will keep sleeping non-moving physical objects so
- // they need waking up when parameters are changed.
- // Called in taint-time!!
- public void ActivateIfPhysical(bool forceIt)
- {
- if (PhysBody.HasPhysicalBody)
- {
- if (IsPhysical)
- {
- // Physical objects might need activating
- PhysScene.PE.Activate(PhysBody, forceIt);
- }
- else
- {
- // Clear the collision cache since we've changed some properties.
- PhysScene.PE.ClearCollisionProxyCache(PhysScene.World, PhysBody);
- }
- }
- }
- // 'actors' act on the physical object to change or constrain its motion. These can range from
- // hovering to complex vehicle motion.
- // May be called at non-taint time as this just adds the actor to the action list and the real
- // work is done during the simulation step.
- // Note that, if the actor is already in the list and we are disabling same, the actor is just left
- // in the list disabled.
- public delegate BSActor CreateActor();
- public void EnableActor(bool enableActor, string actorName, CreateActor creator)
- {
- lock (PhysicalActors)
- {
- BSActor theActor;
- if (PhysicalActors.TryGetActor(actorName, out theActor))
- {
- // The actor already exists so just turn it on or off
- DetailLog("{0},BSPhysObject.EnableActor,enablingExistingActor,name={1},enable={2}", LocalID, actorName, enableActor);
- theActor.Enabled = enableActor;
- }
- else
- {
- // The actor does not exist. If it should, create it.
- if (enableActor)
- {
- DetailLog("{0},BSPhysObject.EnableActor,creatingActor,name={1}", LocalID, actorName);
- theActor = creator();
- PhysicalActors.Add(actorName, theActor);
- theActor.Enabled = true;
- }
- else
- {
- DetailLog("{0},BSPhysObject.EnableActor,notCreatingActorSinceNotEnabled,name={1}", LocalID, actorName);
- }
- }
- }
- }
- #region Collisions
- // Requested number of milliseconds between collision events. Zero means disabled.
- protected int SubscribedEventsMs { get; set; }
- // Given subscription, the time that a collision may be passed up
- protected int NextCollisionOkTime { get; set; }
- // The simulation step that last had a collision
- protected long CollidingStep { get; set; }
- // The simulation step that last had a collision with the ground
- protected long CollidingGroundStep { get; set; }
- // The simulation step that last collided with an object
- protected long CollidingObjectStep { get; set; }
- // The collision flags we think are set in Bullet
- protected CollisionFlags CurrentCollisionFlags { get; set; }
- // On a collision, check the collider and remember if the last collider was moving
- // Used to modify the standing of avatars (avatars on stationary things stand still)
- public bool ColliderIsMoving;
- // 'true' if the last collider was a volume detect object
- public bool ColliderIsVolumeDetect;
- // Used by BSCharacter to manage standing (and not slipping)
- public bool IsStationary;
- // Count of collisions for this object
- protected long CollisionAccumulation { get; set; }
- public override bool IsColliding {
- get { return (CollidingStep == PhysScene.SimulationStep); }
- set {
- if (value)
- CollidingStep = PhysScene.SimulationStep;
- else
- CollidingStep = BSScene.NotASimulationStep;
- }
- }
- // Complex objects (like linksets) need to know if there is a collision on any part of
- // their shape. 'IsColliding' has an existing definition of reporting a collision on
- // only this specific prim or component of linksets.
- // 'HasSomeCollision' is defined as reporting if there is a collision on any part of
- // the complex body that this prim is the root of.
- public virtual bool HasSomeCollision
- {
- get { return IsColliding; }
- set { IsColliding = value; }
- }
- public override bool CollidingGround {
- get { return (CollidingGroundStep == PhysScene.SimulationStep); }
- set
- {
- if (value)
- CollidingGroundStep = PhysScene.SimulationStep;
- else
- CollidingGroundStep = BSScene.NotASimulationStep;
- }
- }
- public override bool CollidingObj {
- get { return (CollidingObjectStep == PhysScene.SimulationStep); }
- set {
- if (value)
- CollidingObjectStep = PhysScene.SimulationStep;
- else
- CollidingObjectStep = BSScene.NotASimulationStep;
- }
- }
- // The collisions that have been collected for the next collision reporting (throttled by subscription)
- protected CollisionEventUpdate CollisionCollection = new CollisionEventUpdate();
- // This is the collision collection last reported to the Simulator.
- public CollisionEventUpdate CollisionsLastReported = new CollisionEventUpdate();
- // Remember the collisions recorded in the last tick for fancy collision checking
- // (like a BSCharacter walking up stairs).
- public CollisionEventUpdate CollisionsLastTick = new CollisionEventUpdate();
- private long CollisionsLastTickStep = -1;
- // The simulation step is telling this object about a collision.
- // I'm the 'collider', the thing I'm colliding with is the 'collidee'.
- // Return 'true' if a collision was processed and should be sent up.
- // Return 'false' if this object is not enabled/subscribed/appropriate for or has already seen this collision.
- // Called at taint time from within the Step() function
- public virtual bool Collide(BSPhysObject collidee, OMV.Vector3 contactPoint, OMV.Vector3 contactNormal, float pentrationDepth)
- {
- bool ret = false;
- // if 'collidee' is null, that means it is terrain
- uint collideeLocalID = (collidee == null) ? BSScene.TERRAIN_ID : collidee.LocalID;
- // All terrain goes by the TERRAIN_ID id when passed up as a collision
- if (collideeLocalID <= PhysScene.TerrainManager.HighestTerrainID) {
- collideeLocalID = BSScene.TERRAIN_ID;
- }
- // The following lines make IsColliding(), CollidingGround() and CollidingObj work
- CollidingStep = PhysScene.SimulationStep;
- if (collideeLocalID == BSScene.TERRAIN_ID)
- {
- CollidingGroundStep = PhysScene.SimulationStep;
- }
- else
- {
- CollidingObjectStep = PhysScene.SimulationStep;
- }
- CollisionAccumulation++;
- // For movement tests, if the collider is me, remember if we are colliding with an object that is moving.
- // Here the 'collider'/'collidee' thing gets messed up. In the larger context, when something is checking
- // if the thing it is colliding with is moving, for instance, it asks if the its collider is moving.
- ColliderIsMoving = collidee != null ? (collidee.RawVelocity != OMV.Vector3.Zero || collidee.RotationalVelocity != OMV.Vector3.Zero) : false;
- ColliderIsVolumeDetect = collidee != null ? (collidee.IsVolumeDetect) : false;
- // Make a collection of the collisions that happened the last simulation tick.
- // This is different than the collection created for sending up to the simulator as it is cleared every tick.
- if (CollisionsLastTickStep != PhysScene.SimulationStep)
- {
- CollisionsLastTick = new CollisionEventUpdate();
- CollisionsLastTickStep = PhysScene.SimulationStep;
- }
- CollisionsLastTick.AddCollider(collideeLocalID, new ContactPoint(contactPoint, contactNormal, pentrationDepth));
- // If someone has subscribed for collision events log the collision so it will be reported up
- if (SubscribedEvents()) {
- ContactPoint newContact = new ContactPoint(contactPoint, contactNormal, pentrationDepth);
- // Collision sound requires a velocity to know it should happen. This is a lot of computation for a little used feature.
- OMV.Vector3 relvel = OMV.Vector3.Zero;
- if (IsPhysical)
- relvel = RawVelocity;
- if (collidee != null && collidee.IsPhysical)
- relvel -= collidee.RawVelocity;
- newContact.RelativeSpeed = -OMV.Vector3.Dot(relvel, contactNormal);
- // DetailLog("{0},{1}.Collision.AddCollider,vel={2},contee.vel={3},relvel={4},relspeed={5}",
- // LocalID, TypeName, RawVelocity, (collidee == null ? OMV.Vector3.Zero : collidee.RawVelocity), relvel, newContact.RelativeSpeed);
- lock (PhysScene.CollisionLock)
- {
- CollisionCollection.AddCollider(collideeLocalID, newContact);
- }
- DetailLog("{0},{1}.Collision.AddCollider,call,with={2},point={3},normal={4},depth={5},speed={6},colliderMoving={7}",
- LocalID, TypeName, collideeLocalID, contactPoint, contactNormal, pentrationDepth,
- newContact.RelativeSpeed, ColliderIsMoving);
- ret = true;
- }
- return ret;
- }
- // Send the collected collisions into the simulator.
- // Called at taint time from within the Step() function thus no locking problems
- // with CollisionCollection and ObjectsWithNoMoreCollisions.
- // Called with BSScene.CollisionLock locked to protect the collision lists.
- // Return 'true' if there were some actual collisions passed up
- public virtual bool SendCollisions()
- {
- bool ret = true;
- // If no collisions this call but there were collisions last call, force the collision
- // event to be happen right now so quick collision_end.
- bool force = (CollisionCollection.Count == 0 && CollisionsLastReported.Count != 0);
- // throttle the collisions to the number of milliseconds specified in the subscription
- if (force || (PhysScene.SimulationNowTime >= NextCollisionOkTime))
- {
- NextCollisionOkTime = PhysScene.SimulationNowTime + SubscribedEventsMs;
- // We are called if we previously had collisions. If there are no collisions
- // this time, send up one last empty event so OpenSim can sense collision end.
- if (CollisionCollection.Count == 0)
- {
- // If I have no collisions this time, remove me from the list of objects with collisions.
- ret = false;
- }
- DetailLog("{0},{1}.SendCollisionUpdate,call,numCollisions={2}", LocalID, TypeName, CollisionCollection.Count);
- base.SendCollisionUpdate(CollisionCollection);
- // Remember the collisions from this tick for some collision specific processing.
- CollisionsLastReported = CollisionCollection;
- // The CollisionCollection instance is passed around in the simulator.
- // Make sure we don't have a handle to that one and that a new one is used for next time.
- // This fixes an interesting 'gotcha'. If we call CollisionCollection.Clear() here,
- // a race condition is created for the other users of this instance.
- CollisionCollection = new CollisionEventUpdate();
- }
- return ret;
- }
- // Subscribe for collision events.
- // Parameter is the millisecond rate the caller wishes collision events to occur.
- public override void SubscribeEvents(int ms) {
- // DetailLog("{0},{1}.SubscribeEvents,subscribing,ms={2}", LocalID, TypeName, ms);
- SubscribedEventsMs = ms;
- if (ms > 0)
- {
- // make sure first collision happens
- NextCollisionOkTime = Util.EnvironmentTickCountSubtract(SubscribedEventsMs);
- PhysScene.TaintedObject(LocalID, TypeName+".SubscribeEvents", delegate()
- {
- if (PhysBody.HasPhysicalBody)
- {
- CurrentCollisionFlags = PhysScene.PE.AddToCollisionFlags(PhysBody, CollisionFlags.BS_SUBSCRIBE_COLLISION_EVENTS);
- DetailLog("{0},{1}.SubscribeEvents,setting collision. ms={2}, collisionFlags={3:x}",
- LocalID, TypeName, SubscribedEventsMs, CurrentCollisionFlags);
- }
- });
- }
- else
- {
- // Subscribing for zero or less is the same as unsubscribing
- UnSubscribeEvents();
- }
- }
- public override void UnSubscribeEvents() {
- // DetailLog("{0},{1}.UnSubscribeEvents,unsubscribing", LocalID, TypeName);
- SubscribedEventsMs = 0;
- PhysScene.TaintedObject(LocalID, TypeName+".UnSubscribeEvents", delegate()
- {
- // Make sure there is a body there because sometimes destruction happens in an un-ideal order.
- if (PhysBody.HasPhysicalBody)
- CurrentCollisionFlags = PhysScene.PE.RemoveFromCollisionFlags(PhysBody, CollisionFlags.BS_SUBSCRIBE_COLLISION_EVENTS);
- });
- }
- // Return 'true' if the simulator wants collision events
- public override bool SubscribedEvents() {
- return (SubscribedEventsMs > 0);
- }
- // Because 'CollisionScore' is called many times while sorting, it should not be recomputed
- // each time called. So this is built to be light weight for each collision and to do
- // all the processing when the user asks for the info.
- public void ComputeCollisionScore()
- {
- // Scale the collision count by the time since the last collision.
- // The "+1" prevents dividing by zero.
- long timeAgo = PhysScene.SimulationStep - CollidingStep + 1;
- CollisionScore = CollisionAccumulation / timeAgo;
- }
- public override float CollisionScore { get; set; }
- #endregion // Collisions
- #region Per Simulation Step actions
- public BSActorCollection PhysicalActors = new BSActorCollection();
- // When an update to the physical properties happens, this event is fired to let
- // different actors to modify the update before it is passed around
- public delegate void PreUpdatePropertyAction(ref EntityProperties entprop);
- public event PreUpdatePropertyAction OnPreUpdateProperty;
- protected void TriggerPreUpdatePropertyAction(ref EntityProperties entprop)
- {
- PreUpdatePropertyAction actions = OnPreUpdateProperty;
- if (actions != null)
- actions(ref entprop);
- }
- #endregion // Per Simulation Step actions
- // High performance detailed logging routine used by the physical objects.
- protected void DetailLog(string msg, params Object[] args)
- {
- if (PhysScene.PhysicsLogging.Enabled)
- PhysScene.DetailLog(msg, args);
- }
- }
- }
|