Files
libremetaverse/Programs/examples/TestClient/Commands/Movement/FollowCommand.cs
Cinder Roxley 6ee065573e Easy returns
2024-07-01 12:17:07 -05:00

138 lines
4.6 KiB
C#

using System;
using System.Linq;
using OpenMetaverse.Packets;
namespace OpenMetaverse.TestClient
{
public class FollowCommand: Command
{
const float DISTANCE_BUFFER = 3.0f;
uint targetLocalID = 0;
public FollowCommand(TestClient testClient)
{
Name = "follow";
Description = "Follow another avatar. Usage: follow [FirstName LastName]/off.";
Category = CommandCategory.Movement;
testClient.Network.RegisterCallback(PacketType.AlertMessage, AlertMessageHandler);
}
public override string Execute(string[] args, UUID fromAgentID)
{
// Construct the target name from the passed arguments
string target = args.Aggregate(string.Empty, (current, t) => current + t + " ");
target = target.TrimEnd();
if (target.Length == 0 || target == "off")
{
Active = false;
targetLocalID = 0;
Client.Self.AutoPilotCancel();
return "Following is off";
}
else
{
return Follow(target)
? $"Following {target}."
: $"Unable to follow {target}. Client may not be able to see the target avatar.";
}
}
bool Follow(string name)
{
lock (Client.Network.Simulators)
{
foreach (var sim in Client.Network.Simulators)
{
Avatar target = sim.ObjectsAvatars.Find(
avatar => avatar.Name == name
);
if (target != null)
{
targetLocalID = target.LocalID;
Active = true;
return true;
}
}
}
if (Active)
{
Client.Self.AutoPilotCancel();
Active = false;
}
return false;
}
public override void Think()
{
if (Active)
{
// Find the target position
lock (Client.Network.Simulators)
{
foreach (var t in Client.Network.Simulators)
{
Avatar targetAv;
if (t.ObjectsAvatars.TryGetValue(targetLocalID, out targetAv))
{
float distance = 0.0f;
if (t == Client.Network.CurrentSim)
{
distance = Vector3.Distance(targetAv.Position, Client.Self.SimPosition);
}
else
{
// FIXME: Calculate global distances
}
if (distance > DISTANCE_BUFFER)
{
uint regionX, regionY;
Utils.LongToUInts(t.Handle, out regionX, out regionY);
double xTarget = (double)targetAv.Position.X + (double)regionX;
double yTarget = (double)targetAv.Position.Y + (double)regionY;
double zTarget = targetAv.Position.Z - 2f;
Logger.DebugLog(
$"[Autopilot] {distance} meters away from the target, starting autopilot to <{xTarget},{yTarget},{zTarget}>", Client);
Client.Self.AutoPilot(xTarget, yTarget, zTarget);
}
else
{
// We are in range of the target and moving, stop moving
Client.Self.AutoPilotCancel();
}
}
}
}
}
base.Think();
}
private void AlertMessageHandler(object sender, PacketReceivedEventArgs e)
{
Packet packet = e.Packet;
AlertMessagePacket alert = (AlertMessagePacket)packet;
if (alert.AlertInfo.Length > 0)
{
string id = Utils.BytesToString(alert.AlertInfo[0].Message);
if (id == "AutopilotCanceled")
{
Logger.Log("FollowCommand: " + Utils.BytesToString(alert.AlertData.Message),
Helpers.LogLevel.Info, Client);
}
}
}
}
}