c314b37029
todo: add NetEntityEventManagers to server & client, some logic to prevent sending events that don't need to be sent (e.g. duplicate event state updates)
568 lines
19 KiB
C#
568 lines
19 KiB
C#
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;
|
|
using Voronoi2;
|
|
|
|
namespace Barotrauma.Items.Components
|
|
{
|
|
class Steering : Powered
|
|
{
|
|
private const float AutopilotRayCastInterval = 0.5f;
|
|
|
|
private Vector2 currVelocity;
|
|
private Vector2 targetVelocity;
|
|
|
|
private GUITickBox autopilotTickBox, maintainPosTickBox;
|
|
private GUITickBox levelEndTickBox, levelStartTickBox;
|
|
|
|
private bool autoPilot;
|
|
|
|
private Vector2? posToMaintain;
|
|
|
|
private SteeringPath steeringPath;
|
|
|
|
private PathFinder pathFinder;
|
|
|
|
private float networkUpdateTimer;
|
|
private bool valueChanged;
|
|
|
|
private float autopilotRayCastTimer;
|
|
|
|
private Vector2 avoidStrength;
|
|
|
|
private float neutralBallastLevel;
|
|
|
|
public Vector2? TargetPosition;
|
|
|
|
public bool AutoPilot
|
|
{
|
|
get { return autoPilot; }
|
|
set
|
|
{
|
|
if (value == autoPilot) return;
|
|
|
|
autoPilot = value;
|
|
autopilotTickBox.Selected = value;
|
|
|
|
maintainPosTickBox.Enabled = autoPilot;
|
|
levelEndTickBox.Enabled = autoPilot;
|
|
levelStartTickBox.Enabled = autoPilot;
|
|
|
|
if (autoPilot)
|
|
{
|
|
if (pathFinder == null) pathFinder = new PathFinder(WayPoint.WayPointList, false);
|
|
ToggleMaintainPosition(maintainPosTickBox);
|
|
}
|
|
else
|
|
{
|
|
maintainPosTickBox.Selected = false;
|
|
levelEndTickBox.Selected = false;
|
|
levelStartTickBox.Selected = false;
|
|
|
|
posToMaintain = null;
|
|
}
|
|
}
|
|
}
|
|
|
|
public bool MaintainPos
|
|
{
|
|
get { return maintainPosTickBox.Selected; }
|
|
set { maintainPosTickBox.Selected = value; }
|
|
}
|
|
|
|
|
|
[Editable, HasDefaultValue(0.5f, true)]
|
|
public float NeutralBallastLevel
|
|
{
|
|
get { return neutralBallastLevel; }
|
|
set
|
|
{
|
|
neutralBallastLevel = MathHelper.Clamp(value, 0.0f, 1.0f);
|
|
}
|
|
}
|
|
|
|
public Vector2 TargetVelocity
|
|
{
|
|
get { return targetVelocity;}
|
|
set
|
|
{
|
|
if (!MathUtils.IsValid(value)) return;
|
|
targetVelocity.X = MathHelper.Clamp(value.X, -100.0f, 100.0f);
|
|
targetVelocity.Y = MathHelper.Clamp(value.Y, -100.0f, 100.0f);
|
|
}
|
|
}
|
|
|
|
public SteeringPath SteeringPath
|
|
{
|
|
get { return steeringPath; }
|
|
}
|
|
|
|
public Steering(Item item, XElement element)
|
|
: base(item, element)
|
|
{
|
|
IsActive = true;
|
|
|
|
autopilotTickBox = new GUITickBox(new Rectangle(0,25,20,20), "Autopilot", Alignment.TopLeft, GuiFrame);
|
|
autopilotTickBox.OnSelected = (GUITickBox box) =>
|
|
{
|
|
AutoPilot = box.Selected;
|
|
valueChanged = true;
|
|
|
|
return true;
|
|
};
|
|
|
|
maintainPosTickBox = new GUITickBox(new Rectangle(5, 50, 15, 15), "Maintain position", Alignment.TopLeft, GUI.SmallFont, GuiFrame);
|
|
maintainPosTickBox.Enabled = false;
|
|
maintainPosTickBox.OnSelected = ToggleMaintainPosition;
|
|
|
|
levelStartTickBox = new GUITickBox(
|
|
new Rectangle(5, 70, 15, 15),
|
|
GameMain.GameSession == null ? "" : ToolBox.LimitString(GameMain.GameSession.StartLocation.Name, 20),
|
|
Alignment.TopLeft, GUI.SmallFont, GuiFrame);
|
|
levelStartTickBox.Enabled = false;
|
|
levelStartTickBox.OnSelected = SelectDestination;
|
|
|
|
levelEndTickBox = new GUITickBox(
|
|
new Rectangle(5, 90, 15, 15),
|
|
GameMain.GameSession == null ? "" : ToolBox.LimitString(GameMain.GameSession.EndLocation.Name, 20),
|
|
Alignment.TopLeft, GUI.SmallFont, GuiFrame);
|
|
levelEndTickBox.Enabled = false;
|
|
levelEndTickBox.OnSelected = SelectDestination;
|
|
|
|
}
|
|
|
|
public override void Update(float deltaTime, Camera cam)
|
|
{
|
|
if (valueChanged)
|
|
{
|
|
networkUpdateTimer -= deltaTime;
|
|
if (networkUpdateTimer <= 0.0f)
|
|
{
|
|
networkUpdateTimer = 0.5f;
|
|
valueChanged = false;
|
|
}
|
|
}
|
|
|
|
if (voltage < minVoltage && powerConsumption > 0.0f) return;
|
|
|
|
if (autoPilot)
|
|
{
|
|
UpdateAutoPilot(deltaTime);
|
|
}
|
|
|
|
item.SendSignal(0, targetVelocity.X.ToString(CultureInfo.InvariantCulture), "velocity_x_out");
|
|
|
|
float targetLevel = -targetVelocity.Y;
|
|
|
|
targetLevel += (neutralBallastLevel - 0.5f) * 100.0f;
|
|
|
|
item.SendSignal(0, targetLevel.ToString(CultureInfo.InvariantCulture), "velocity_y_out");
|
|
|
|
|
|
voltage -= deltaTime;
|
|
}
|
|
|
|
public override void DrawHUD(SpriteBatch spriteBatch, Character character)
|
|
{
|
|
//if (voltage < minVoltage) return;
|
|
|
|
int width = GuiFrame.Rect.Width, height = GuiFrame.Rect.Height;
|
|
int x = GuiFrame.Rect.X;
|
|
int y = GuiFrame.Rect.Y;
|
|
|
|
GuiFrame.Draw(spriteBatch);
|
|
|
|
if (voltage < minVoltage && powerConsumption > 0.0f) return;
|
|
|
|
Rectangle velRect = new Rectangle(x + 20, y + 20, width - 40, height - 40);
|
|
//GUI.DrawRectangle(spriteBatch, velRect, Color.White, false);
|
|
|
|
if (item.Submarine != null && Level.Loaded != null)
|
|
{
|
|
Vector2 realWorldVelocity = ConvertUnits.ToDisplayUnits(item.Submarine.Velocity * Physics.DisplayToRealWorldRatio) * 3.6f;
|
|
float realWorldDepth = Math.Abs(item.Submarine.Position.Y - Level.Loaded.Size.Y) * Physics.DisplayToRealWorldRatio;
|
|
GUI.DrawString(spriteBatch, new Vector2(x + 20, y + height - 65),
|
|
"Velocity: " + (int)realWorldVelocity.X + " km/h", Color.LightGreen, null, 0, GUI.SmallFont);
|
|
GUI.DrawString(spriteBatch, new Vector2(x + 20, y + height - 50),
|
|
"Descent velocity: " + -(int)realWorldVelocity.Y + " km/h", Color.LightGreen, null, 0, GUI.SmallFont);
|
|
|
|
GUI.DrawString(spriteBatch, new Vector2(x + 20, y + height - 30),
|
|
"Depth: " + (int)realWorldDepth + " m", Color.LightGreen, null, 0, GUI.SmallFont);
|
|
}
|
|
|
|
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.LeftButtonHeld())
|
|
{
|
|
TargetVelocity = PlayerInput.MousePosition - new Vector2(velRect.Center.X, velRect.Center.Y);
|
|
targetVelocity.Y = -targetVelocity.Y;
|
|
|
|
valueChanged = true;
|
|
}
|
|
}
|
|
}
|
|
|
|
public override void UpdateHUD(Character character)
|
|
{
|
|
GuiFrame.Update(1.0f / 60.0f);
|
|
}
|
|
|
|
private void UpdateAutoPilot(float deltaTime)
|
|
{
|
|
if (posToMaintain != null)
|
|
{
|
|
SteerTowardsPosition((Vector2)posToMaintain);
|
|
return;
|
|
}
|
|
|
|
autopilotRayCastTimer -= deltaTime;
|
|
|
|
steeringPath.CheckProgress(ConvertUnits.ToSimUnits(item.Submarine.WorldPosition), 10.0f);
|
|
|
|
if (autopilotRayCastTimer <= 0.0f && steeringPath.NextNode != null)
|
|
{
|
|
Vector2 diff = Vector2.Normalize(ConvertUnits.ToSimUnits(steeringPath.NextNode.Position - item.Submarine.WorldPosition));
|
|
|
|
bool nextVisible = true;
|
|
for (int x = -1; x < 2; x += 2)
|
|
{
|
|
for (int y = -1; y < 2; y += 2)
|
|
{
|
|
Vector2 cornerPos =
|
|
new Vector2(item.Submarine.Borders.Width * x, item.Submarine.Borders.Height * y) / 2.0f;
|
|
|
|
cornerPos = ConvertUnits.ToSimUnits(cornerPos * 1.2f + item.Submarine.WorldPosition);
|
|
|
|
float dist = Vector2.Distance(cornerPos, steeringPath.NextNode.SimPosition);
|
|
|
|
if (Submarine.PickBody(cornerPos, cornerPos + diff * dist, null, Physics.CollisionLevel) == null) continue;
|
|
|
|
nextVisible = false;
|
|
x = 2;
|
|
y = 2;
|
|
}
|
|
}
|
|
|
|
if (nextVisible) steeringPath.SkipToNextNode();
|
|
|
|
autopilotRayCastTimer = AutopilotRayCastInterval;
|
|
}
|
|
|
|
if (steeringPath.CurrentNode != null)
|
|
{
|
|
SteerTowardsPosition(steeringPath.CurrentNode.WorldPosition);
|
|
}
|
|
|
|
float avoidRadius = Math.Max(item.Submarine.Borders.Width, item.Submarine.Borders.Height) * 2.0f;
|
|
avoidRadius = Math.Max(avoidRadius, 2000.0f);
|
|
|
|
Vector2 newAvoidStrength = Vector2.Zero;
|
|
|
|
//steer away from nearby walls
|
|
var closeCells = Level.Loaded.GetCells(item.Submarine.WorldPosition, 4);
|
|
foreach (VoronoiCell cell in closeCells)
|
|
{
|
|
foreach (GraphEdge edge in cell.edges)
|
|
{
|
|
var intersection = MathUtils.GetLineIntersection(edge.point1, edge.point2, item.Submarine.WorldPosition, cell.Center);
|
|
if (intersection != null)
|
|
{
|
|
Vector2 diff = item.Submarine.WorldPosition - (Vector2)intersection;
|
|
|
|
//far enough -> ignore
|
|
if (diff.Length() > avoidRadius) continue;
|
|
|
|
float dot = item.Submarine.Velocity == Vector2.Zero ?
|
|
0.0f : Vector2.Dot(item.Submarine.Velocity, -Vector2.Normalize(diff));
|
|
|
|
//not heading towards the wall -> ignore
|
|
if (dot < 0.5) continue;
|
|
|
|
Vector2 change = (Vector2.Normalize(diff) * Math.Max((avoidRadius - diff.Length()), 0.0f)) / avoidRadius;
|
|
|
|
newAvoidStrength += change * dot;
|
|
}
|
|
}
|
|
}
|
|
|
|
avoidStrength = Vector2.Lerp(avoidStrength, newAvoidStrength, deltaTime * 10.0f);
|
|
|
|
targetVelocity += avoidStrength * 100.0f;
|
|
|
|
//steer away from other subs
|
|
foreach (Submarine sub in Submarine.Loaded)
|
|
{
|
|
if (sub == item.Submarine) continue;
|
|
if (item.Submarine.DockedTo.Contains(sub)) continue;
|
|
|
|
float thisSize = Math.Max(item.Submarine.Borders.Width, item.Submarine.Borders.Height);
|
|
float otherSize = Math.Max(sub.Borders.Width, sub.Borders.Height);
|
|
|
|
Vector2 diff = item.Submarine.WorldPosition - sub.WorldPosition;
|
|
|
|
float dist = diff == Vector2.Zero ? 0.0f : diff.Length();
|
|
|
|
//far enough -> ignore
|
|
if (dist > thisSize + otherSize) continue;
|
|
|
|
diff = Vector2.Normalize(diff);
|
|
|
|
float dot = item.Submarine.Velocity == Vector2.Zero ?
|
|
0.0f : Vector2.Dot(Vector2.Normalize(item.Submarine.Velocity), -Vector2.Normalize(diff));
|
|
|
|
//heading away -> ignore
|
|
if (dot < 0.0f) continue;
|
|
|
|
targetVelocity += diff * 200.0f;
|
|
}
|
|
|
|
//clamp velocity magnitude to 100.0f
|
|
float velMagnitude = targetVelocity.Length();
|
|
if (velMagnitude > 100.0f)
|
|
{
|
|
targetVelocity *= 100.0f / velMagnitude;
|
|
}
|
|
|
|
}
|
|
|
|
private void UpdatePath()
|
|
{
|
|
Vector2 target;
|
|
if (TargetPosition != null)
|
|
{
|
|
target = (Vector2)TargetPosition;
|
|
}
|
|
else
|
|
{
|
|
if (levelEndTickBox.Selected)
|
|
{
|
|
target = ConvertUnits.ToSimUnits(Level.Loaded.EndPosition);
|
|
}
|
|
else
|
|
{
|
|
target = ConvertUnits.ToSimUnits(Level.Loaded.StartPosition);
|
|
}
|
|
}
|
|
|
|
steeringPath = pathFinder.FindPath(ConvertUnits.ToSimUnits(item.WorldPosition), target);
|
|
}
|
|
|
|
private void SteerTowardsPosition(Vector2 worldPosition)
|
|
{
|
|
float prediction = 10.0f;
|
|
|
|
Vector2 futurePosition = ConvertUnits.ToDisplayUnits(item.Submarine.Velocity) * prediction;
|
|
Vector2 targetSpeed = ((worldPosition - item.Submarine.WorldPosition) - futurePosition);
|
|
|
|
if (targetSpeed.Length()>500.0f)
|
|
{
|
|
targetSpeed = Vector2.Normalize(targetSpeed);
|
|
TargetVelocity = targetSpeed * 100.0f;
|
|
}
|
|
else
|
|
{
|
|
TargetVelocity = targetSpeed / 5.0f;
|
|
}
|
|
}
|
|
|
|
private bool ToggleMaintainPosition(GUITickBox tickBox)
|
|
{
|
|
valueChanged = true;
|
|
|
|
levelStartTickBox.Selected = false;
|
|
levelEndTickBox.Selected = false;
|
|
|
|
if (item.Submarine == null)
|
|
{
|
|
posToMaintain = null;
|
|
}
|
|
else
|
|
{
|
|
posToMaintain = item.Submarine.WorldPosition;
|
|
}
|
|
|
|
tickBox.Selected = true;
|
|
|
|
return true;
|
|
}
|
|
|
|
private bool SelectDestination(GUITickBox tickBox)
|
|
{
|
|
valueChanged = true;
|
|
|
|
if (tickBox == levelStartTickBox)
|
|
{
|
|
levelEndTickBox.Selected = false;
|
|
}
|
|
else
|
|
{
|
|
levelStartTickBox.Selected = false;
|
|
}
|
|
|
|
maintainPosTickBox.Selected = false;
|
|
posToMaintain = null;
|
|
|
|
UpdatePath();
|
|
|
|
tickBox.Selected = true;
|
|
|
|
return true;
|
|
}
|
|
|
|
public override void ReceiveSignal(int stepsTaken, string signal, Connection connection, Item sender, float power=0.0f)
|
|
{
|
|
if (connection.Name == "velocity_in")
|
|
{
|
|
currVelocity = ToolBox.ParseToVector2(signal, false);
|
|
}
|
|
else
|
|
{
|
|
base.ReceiveSignal(stepsTaken, signal, connection, sender, power);
|
|
}
|
|
}
|
|
|
|
public override void ClientWrite(Lidgren.Network.NetBuffer msg)
|
|
{
|
|
msg.Write(autoPilot);
|
|
|
|
if (!autoPilot)
|
|
{
|
|
//no need to write steering info if autopilot is controlling
|
|
msg.Write(targetVelocity.X);
|
|
msg.Write(targetVelocity.Y);
|
|
}
|
|
else
|
|
{
|
|
msg.Write(posToMaintain != null);
|
|
if (posToMaintain != null)
|
|
{
|
|
msg.Write(((Vector2)posToMaintain).X);
|
|
msg.Write(((Vector2)posToMaintain).Y);
|
|
}
|
|
else
|
|
{
|
|
msg.Write(levelStartTickBox.Selected);
|
|
}
|
|
}
|
|
}
|
|
|
|
public override void ServerRead(Lidgren.Network.NetIncomingMessage msg, Barotrauma.Networking.Client c)
|
|
{
|
|
AutoPilot = msg.ReadBoolean();
|
|
|
|
if (!AutoPilot)
|
|
{
|
|
targetVelocity = new Vector2(msg.ReadFloat(), msg.ReadFloat());
|
|
}
|
|
else
|
|
{
|
|
bool maintainPos = msg.ReadBoolean();
|
|
if (posToMaintain == null && maintainPos)
|
|
{
|
|
posToMaintain = item.Submarine.WorldPosition;
|
|
maintainPosTickBox.Selected = true;
|
|
}
|
|
else
|
|
{
|
|
posToMaintain = null;
|
|
maintainPosTickBox.Selected = false;
|
|
bool maintainPoss = msg.ReadBoolean();
|
|
if (maintainPoss)
|
|
{
|
|
Vector2 newPosToMaintain = new Vector2(
|
|
msg.ReadFloat(),
|
|
msg.ReadFloat());
|
|
}
|
|
else
|
|
{
|
|
bool headingToStart = msg.ReadBoolean();
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
public override void ServerWrite(Lidgren.Network.NetBuffer msg, Barotrauma.Networking.Client c)
|
|
{
|
|
msg.Write(autoPilot);
|
|
|
|
if (!autoPilot)
|
|
{
|
|
//no need to write steering info if autopilot is controlling
|
|
msg.Write(targetVelocity.X);
|
|
msg.Write(targetVelocity.Y);
|
|
}
|
|
else
|
|
{
|
|
msg.Write(posToMaintain != null);
|
|
if (posToMaintain != null)
|
|
{
|
|
msg.Write(((Vector2)posToMaintain).X);
|
|
msg.Write(((Vector2)posToMaintain).Y);
|
|
}
|
|
}
|
|
}
|
|
|
|
public override void ClientRead(Lidgren.Network.NetIncomingMessage msg, float sendingTime)
|
|
{
|
|
AutoPilot = msg.ReadBoolean();
|
|
|
|
if (!AutoPilot)
|
|
{
|
|
targetVelocity = new Vector2(msg.ReadFloat(), msg.ReadFloat());
|
|
}
|
|
else
|
|
{
|
|
bool maintainPos = msg.ReadBoolean();
|
|
if (maintainPos)
|
|
{
|
|
posToMaintain = new Vector2(msg.ReadSingle(), msg.ReadSingle());
|
|
maintainPosTickBox.Selected = true;
|
|
}
|
|
else
|
|
{
|
|
posToMaintain = null;
|
|
maintainPosTickBox.Selected = false;
|
|
}
|
|
}
|
|
maintainPosTickBox.Selected = posToMaintain != null;
|
|
//posToMaintain = newPosToMaintain;
|
|
|
|
if (posToMaintain == null && autoPilot)
|
|
{
|
|
levelStartTickBox.Selected = false;//headingToStart;
|
|
levelEndTickBox.Selected = true;//!headingToStart;
|
|
|
|
UpdatePath();
|
|
}
|
|
else
|
|
{
|
|
levelStartTickBox.Selected = false;
|
|
levelEndTickBox.Selected = false;
|
|
}
|
|
|
|
}
|
|
}
|
|
}
|