C:/Users/Andreas Schiffler/Desktop/SVN/NewGamePhysics/NewGamePhysics/GraphicalElements/DoubleRegularPendulum.cs



namespace NewGamePhysics.GraphicalElements
{
    using System;
    using System.Collections.Generic;
    using System.Text;

    using Microsoft.Xna.Framework;
    using Microsoft.Xna.Framework.Content;
    using Microsoft.Xna.Framework.Graphics;
    using Microsoft.Xna.Framework.Input;

    using NewGamePhysics.StateManager;
    using NewGamePhysics.Mathematics;
    using NewGamePhysics.Physics;
    using NewGamePhysics.GraphicalElements;
    using NewGamePhysics.PhysicalElements;
    using NewGamePhysics.Utilities;

    public class DoubleRegularPendulum : GraphicalElementBase
    {
        DoubleRegularPendulumSimulation pendulum;

        Vector2 screenOrigin;

        double screenScale;

        private static Texture2D rivetTexture;

        public DoubleRegularPendulum(
            ScreenManager screenManager,
            Vector2 simulationOrigin,
            double l1,
            double m1,
            double l2,
            double m2,
            double g,
            RotationalFrictionType f, 
            Vector2 screenOrigin,
            double screenScale)
            : base(screenManager)
        {
            // Create pendulum simulation
            this.pendulum = new DoubleRegularPendulumSimulation(simulationOrigin, l1, m1, l2, m2, g, f);
            this.screenOrigin = screenOrigin;
            this.screenScale = screenScale;

            // Prepare texture
            if (this.ScreenManager.Textures.ContainsKey("rivet"))
            {
                rivetTexture = this.ScreenManager.Textures["rivet"];
            }
        }

        public DoubleRegularPendulumSimulation Pendulum
        {
            get { return this.pendulum; }
        }

        public void Draw(GameTime gameTime)
        {
            // Draw Pendulum
            Vector2[] pendulumPoints = this.pendulum.GetPosition(this.screenOrigin, this.screenScale);
            this.PrimitiveBatch.Begin(PrimitiveType.LineList);
            this.PrimitiveBatch.AddVertex(pendulumPoints[0], Color.White);
            this.PrimitiveBatch.AddVertex(pendulumPoints[1], Color.White);
            this.PrimitiveBatch.AddVertex(pendulumPoints[1], Color.White);
            this.PrimitiveBatch.AddVertex(pendulumPoints[2], Color.White);
            this.PrimitiveBatch.End();

            // Check if we have the texture
            if (null != rivetTexture)
            {
                // Rivets
                Rectangle dest = new Rectangle(0, 0, 8, 8);
                this.SpriteBatch.Begin(SpriteBlendMode.AlphaBlend);
                dest.X = Convert.ToInt32(Math.Round(pendulumPoints[0].X)) - 4;
                dest.Y = Convert.ToInt32(Math.Round(pendulumPoints[0].Y)) - 4;
                this.SpriteBatch.Draw(rivetTexture, dest, Color.White);
                dest.X = Convert.ToInt32(Math.Round(pendulumPoints[1].X)) - 8;
                dest.Y = Convert.ToInt32(Math.Round(pendulumPoints[1].Y)) - 8;
                dest.Width = 16;
                dest.Height = 16;
                this.SpriteBatch.Draw(rivetTexture, dest, Color.White);
                dest.X = Convert.ToInt32(Math.Round(pendulumPoints[2].X)) - 8;
                dest.Y = Convert.ToInt32(Math.Round(pendulumPoints[2].Y)) - 8;
                this.SpriteBatch.Draw(rivetTexture, dest, Color.White);
                this.SpriteBatch.End();
            }
        }
    }
}

---