LuaCsForBarotraumaEP/Subsurface/Items/Components/Machines/Steering.cs

using FarseerPhysics;
using Microsoft.Xna.Framework;
using Microsoft.Xna.Framework.Graphics;
using System;
using System.Collections.Generic;
using System.Globalization;
using System.Linq;
using System.Text;
using System.Xml.Linq;

namespace Subsurface.Items.Components
{
    class Steering : ItemComponent
    {
        Vector2 currVelocity;
        Vector2 targetVelocity;

        bool autoPilot;

        SteeringPath steeringPath;

        private Vector2 TargetVelocity
        {
            get { return targetVelocity;}
            set 
            {
                targetVelocity.X = MathHelper.Clamp(value.X, -100.0f, 100.0f);
                targetVelocity.Y = MathHelper.Clamp(value.Y, -100.0f, 100.0f);
            }
        }

        public Steering(Item item, XElement element)
            : base(item, element)
        {
            isActive = true;
        }

        public override void OnMapLoaded()
        {
            PathFinder pathFinder = new PathFinder(WayPoint.WayPointList, false);
            steeringPath = pathFinder.FindPath(
                ConvertUnits.ToSimUnits(Level.Loaded.StartPosition), 
                ConvertUnits.ToSimUnits(Level.Loaded.EndPosition));
        }

        public override void Update(float deltaTime, Camera cam)
        {
            base.Update(deltaTime, cam);

            if (autoPilot || true)
            {
                steeringPath.GetNode(Vector2.Zero, 5.0f);

                if (steeringPath.CurrentNode!=null)
                {
                    Vector2 targetSpeed = steeringPath.CurrentNode.Position;

                    float dist = targetSpeed.Length();
                    targetSpeed = Vector2.Normalize(targetSpeed);

                    if (dist<2000.0f)
                    {
                        targetSpeed = targetSpeed * Math.Max(dist / 2000.0f, 0.5f);
                    
                    }


                    Vector2 currSpeed = (Submarine.Loaded.Speed  == Vector2.Zero) ? Vector2.Zero : Vector2.Normalize(Submarine.Loaded.Speed);

                    //targetSpeed.X = (targetSpeed.X - currSpeed.X);
                    //targetSpeed.Y = (targetSpeed.Y - currSpeed.Y);

                    //TargetVelocity += targetSpeed;

                    TargetVelocity += (targetSpeed-currSpeed);
                }
            }

            item.SendSignal(targetVelocity.X.ToString(CultureInfo.InvariantCulture), "velocity_x_out");
            item.SendSignal((-targetVelocity.Y).ToString(CultureInfo.InvariantCulture), "velocity_y_out");
        }

        public override void DrawHUD(SpriteBatch spriteBatch, Character character)
        {
            int width = GuiFrame.Rect.Width, height = GuiFrame.Rect.Height;
            int x = GuiFrame.Rect.X;
            int y = GuiFrame.Rect.Y;

            GuiFrame.Draw(spriteBatch);

            Rectangle velRect = new Rectangle(x + 20, y + 20, width - 40, height - 40);
            GUI.DrawRectangle(spriteBatch, velRect, Color.White, false);

            GUI.DrawLine(spriteBatch,
                new Vector2(velRect.Center.X,velRect.Center.Y), 
                new Vector2(velRect.Center.X + currVelocity.X, velRect.Center.Y - currVelocity.Y), 
                Color.Gray);

            Vector2 targetVelPos = new Vector2(velRect.Center.X + targetVelocity.X, velRect.Center.Y - targetVelocity.Y);

            GUI.DrawLine(spriteBatch,
                new Vector2(velRect.Center.X, velRect.Center.Y),
                targetVelPos,
                Color.LightGray);

            GUI.DrawRectangle(spriteBatch, new Rectangle((int)targetVelPos.X - 5, (int)targetVelPos.Y - 5, 10, 10), Color.White);

            if (Vector2.Distance(PlayerInput.MousePosition, new Vector2(velRect.Center.X, velRect.Center.Y)) < 200.0f)
            {
                GUI.DrawRectangle(spriteBatch, new Rectangle((int)targetVelPos.X -10, (int)targetVelPos.Y - 10, 20, 20), Color.Red);

                if (PlayerInput.LeftButtonDown())
                {
                    targetVelocity = PlayerInput.MousePosition - new Vector2(velRect.Center.X, velRect.Center.Y);
                    targetVelocity.Y = -targetVelocity.Y;
                }
            }

            item.NewComponentEvent(this, true);
        }

        public override void ReceiveSignal(string signal, Connection connection, Item sender, float power=0.0f)
        {
            if (connection.Name == "velocity_in")
            {
                currVelocity = ToolBox.ParseToVector2(signal, false);
            }  
        }

        public override void FillNetworkData(Networking.NetworkEventType type, Lidgren.Network.NetOutgoingMessage message)
        {
            message.Write(targetVelocity.X);
            message.Write(targetVelocity.Y);
        }

        public override void ReadNetworkData(Networking.NetworkEventType type, Lidgren.Network.NetIncomingMessage message)
        {
            Vector2 newTargetVelocity = Vector2.Zero;
            try
            {
                newTargetVelocity = new Vector2(message.ReadFloat(), message.ReadFloat());
            }

            catch
            {
                return;
            }

            TargetVelocity = newTargetVelocity;
        }
    }
}