Movement.cs

Siirry tämän tiedoston dokumentaatioon.

#region MIT License
/*
 * Copyright (c) 2009 University of Jyväskylä, Department of Mathematical
 * Information Technology.
 * 
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 * 
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 * 
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
#endregion

/*
 * Authors: Tero Jäntti, Tomi Karppinen, Janne Nikkanen.
 */

using System;
using Physics2DDotNet.Shapes;
using AdvanceMath;
using Physics2DDotNet;
namespace Jypeli
{
    public partial class PhysicsObject
    {
        private double _maxAngularV = double.PositiveInfinity;
        private double _maxLinearV = double.PositiveInfinity;

        [Save]
        public Vector Velocity
        {
            get
            {
                Vector2D v = Body.State.Velocity.Linear;
                return new Vector( v.X, v.Y );
            }
            set { Body.State.Velocity.Linear = new Vector2D( value.X, value.Y ); }
        }

        [Save]
        public double AngularVelocity
        {
            get { return Body.State.Velocity.Angular; }
            set { Body.State.Velocity.Angular = value; }
        }

        [Save]
        public double MaxVelocity
        {
            get { return _maxLinearV; }
            set { _maxLinearV = value; IsUpdated = true; }
        }

        [Save]
        public double MaxAngularVelocity
        {
            get { return _maxAngularV; }
            set { _maxAngularV = value; IsUpdated = true; }
        }

        [Save]
        public Vector Acceleration
        {
            get
            {
                Vector2D v = Body.State.Acceleration.Linear;
                return new Vector( v.X, v.Y );
            }
            set { Body.State.Acceleration.Linear = new Vector2D( value.X, value.Y ); }
        }

        [Save]
        public double AngularAcceleration
        {
            get { return Body.State.Acceleration.Angular; }
            set { Body.State.Acceleration.Angular = value; }
        }

        [Save]
        internal Vector ForceAccumulator
        {
            get { return new Vector( Body.State.ForceAccumulator.Linear.X, Body.State.ForceAccumulator.Linear.Y ); }
            set { Body.State.ForceAccumulator.Linear = new Vector2D( value.X, value.Y ); }
        }

        [Save]
        internal double AngularForceAccumulator
        {
            get { return Body.State.ForceAccumulator.Angular; }
            set { Body.State.ForceAccumulator.Angular = value; }
        }

        public virtual void Push( Vector force )
        {
            Body.ApplyForce( new Vector2D( force.X, force.Y ) );
        }

        public virtual void Push( Vector force, TimeSpan time )
        {
            IsUpdated = true;
            Body.ApplyForce( new Vector2D( force.X, force.Y ) );
            ActiveForces.Add( new Force( force, time ) );
        }

        public virtual void Hit( Vector impulse )
        {
            Body.ApplyImpulse( new Vector2D( impulse.X, impulse.Y ) );
        }

        public virtual void ApplyTorque( double torque )
        {
            Body.ApplyTorque( torque );
        }

        public override void Stop()
        {
            Body.ClearForces();
            Body.State.Acceleration = ALVector2D.Zero;
            Body.State.Velocity = ALVector2D.Zero;
            Body.State.ForceAccumulator = ALVector2D.Zero;
            base.Stop();
        }

        public void StopHorizontal()
        {
            StopAxial( Vector.UnitX );
        }

        public void StopVertical()
        {
            StopAxial( Vector.UnitY );
        }

        public void StopAxial( Vector axis )
        {
            StopMoveTo();

            // TODO: Distinguish between horizontal and vertical oscillations
            ClearOscillations();

            Acceleration = Acceleration.Project( axis.LeftNormal );
            Velocity = Velocity.Project( axis.LeftNormal );

            Vector oldForce = new Vector( Body.State.ForceAccumulator.Linear.X, Body.State.ForceAccumulator.Linear.Y );
            Vector newForce = oldForce.Project( axis.LeftNormal );
            double aForce = Body.State.ForceAccumulator.Angular;
            Body.State.ForceAccumulator = new ALVector2D( aForce, newForce.X, newForce.Y );
        }

        public void StopAngular()
        {
            Body.State.Acceleration.Angular = 0;
            Body.State.Velocity.Angular = 0;
            Body.State.ForceAccumulator.Angular = 0;
        }

        public override void Move( Vector movement )
        {
            Vector dv = movement - this.Velocity;
            Hit( Mass * dv );
        }

        protected override void MoveToTarget()
        {
            if ( !moveTarget.HasValue )
            {
                Stop();
                moveTimer.Stop();
                return;
            }

            Vector d = moveTarget.Value - AbsolutePosition;
            double vt = moveSpeed * moveTimer.Interval;

            if ( d.Magnitude < vt )
            {
                Vector targetLoc = moveTarget.Value;
                Stop();
                moveTimer.Stop();
                moveTarget = null;

                if ( arrivedAction != null )
                    arrivedAction();
            }
            else
            {
                Vector dv = Vector.FromLengthAndAngle( moveSpeed, d.Angle ) - this.Velocity;
                Hit( Mass * dv );
            }
        }

        protected virtual void PrepareThrowable( PhysicsObject obj, Angle angle, double force, double distanceDelta, double axialDelta )
        {
            double d = ( this.Width + obj.Width ) / 2 + distanceDelta;
            Angle a = this.AbsoluteAngle + angle;
            obj.Position = this.AbsolutePosition + a.GetVector() * d + (a + Angle.RightAngle).GetVector() * axialDelta;
            obj.Hit( Vector.FromLengthAndAngle( force, a ) );
        }

        public void Throw( PhysicsObject obj, Angle angle, double force, double distOffset = 0, int layer = 0, double axialOffset = 0 )
        {
            PrepareThrowable( obj, angle, force, distOffset, axialOffset );
            Game.Add( obj, layer );
        }
    }
}