git-svn-id: http://libopenmetaverse.googlecode.com/svn/trunk@2105 52acb1d6-8a22-11de-b505-999d5b087335
103 lines
4.2 KiB
C#
103 lines
4.2 KiB
C#
using OpenMetaverse;
|
|
using OpenMetaverse.Packets;
|
|
using System;
|
|
using System.Collections.Generic;
|
|
using System.Text;
|
|
using System.Threading;
|
|
|
|
namespace Simian.Extensions
|
|
{
|
|
public class Movement : ISimianExtension
|
|
{
|
|
Simian Server;
|
|
Timer UpdateTimer;
|
|
const float SQRT_TWO = 1.41421356f;
|
|
|
|
public Movement(Simian server)
|
|
{
|
|
Server = server;
|
|
}
|
|
|
|
public void Start()
|
|
{
|
|
Server.UDPServer.RegisterPacketCallback(PacketType.AgentUpdate, new UDPServer.PacketCallback(AgentUpdateHandler));
|
|
if (UpdateTimer != null) UpdateTimer = null;
|
|
UpdateTimer = new Timer(new TimerCallback(UpdateTimer_Elapsed));
|
|
UpdateTimer.Change(100, 100);
|
|
}
|
|
|
|
public void Stop()
|
|
{
|
|
UpdateTimer = null;
|
|
}
|
|
|
|
void UpdateTimer_Elapsed(object sender)
|
|
{
|
|
lock (Server.Agents)
|
|
{
|
|
foreach (Agent agent in Server.Agents.Values)
|
|
{
|
|
agent.Avatar.Velocity.X = 0f;
|
|
|
|
Vector3 fwd = Vector3.Transform(Vector3.UnitX, Matrix4.CreateFromQuaternion(agent.Avatar.Rotation));
|
|
Vector3 left = Vector3.Transform(Vector3.UnitY, Matrix4.CreateFromQuaternion(agent.Avatar.Rotation));
|
|
|
|
bool heldForward = (agent.ControlFlags & AgentManager.ControlFlags.AGENT_CONTROL_AT_POS) == AgentManager.ControlFlags.AGENT_CONTROL_AT_POS;
|
|
bool heldBack = (agent.ControlFlags & AgentManager.ControlFlags.AGENT_CONTROL_AT_NEG) == AgentManager.ControlFlags.AGENT_CONTROL_AT_NEG;
|
|
bool heldLeft = (agent.ControlFlags & AgentManager.ControlFlags.AGENT_CONTROL_LEFT_POS) == AgentManager.ControlFlags.AGENT_CONTROL_LEFT_POS;
|
|
bool heldRight = (agent.ControlFlags & AgentManager.ControlFlags.AGENT_CONTROL_LEFT_NEG) == AgentManager.ControlFlags.AGENT_CONTROL_LEFT_NEG;
|
|
|
|
float speed = 0.5f;
|
|
if ((heldForward || heldBack) && (heldLeft || heldRight))
|
|
speed /= SQRT_TWO;
|
|
|
|
if (heldForward)
|
|
{
|
|
agent.Avatar.Position.X += fwd.X * speed;
|
|
agent.Avatar.Position.Y += fwd.Y * speed;
|
|
agent.Avatar.Velocity.X += fwd.X * speed;
|
|
agent.Avatar.Velocity.Y += fwd.Y * speed;
|
|
}
|
|
if (heldBack)
|
|
{
|
|
agent.Avatar.Position.X -= fwd.X * speed;
|
|
agent.Avatar.Position.Y -= fwd.Y * speed;
|
|
agent.Avatar.Velocity.X -= fwd.X * speed;
|
|
agent.Avatar.Velocity.Y -= fwd.Y * speed;
|
|
}
|
|
if (heldLeft)
|
|
{
|
|
agent.Avatar.Position.X += left.X * speed;
|
|
agent.Avatar.Position.Y += left.Y * speed;
|
|
agent.Avatar.Velocity.X += left.X * speed;
|
|
agent.Avatar.Velocity.Y += left.Y * speed;
|
|
}
|
|
if (heldRight)
|
|
{
|
|
agent.Avatar.Position.X -= left.X * speed;
|
|
agent.Avatar.Position.Y -= left.Y * speed;
|
|
agent.Avatar.Velocity.X -= left.X * speed;
|
|
agent.Avatar.Velocity.Y -= left.Y * speed;
|
|
}
|
|
|
|
if (agent.Avatar.Position.X < 0) agent.Avatar.Position.X = 0f;
|
|
else if (agent.Avatar.Position.X > 255) agent.Avatar.Position.X = 255f;
|
|
|
|
if (agent.Avatar.Position.Y < 0) agent.Avatar.Position.Y = 0f;
|
|
else if (agent.Avatar.Position.Y > 255) agent.Avatar.Position.Y = 255f;
|
|
|
|
}
|
|
}
|
|
}
|
|
|
|
void AgentUpdateHandler(Packet packet, Agent agent)
|
|
{
|
|
AgentUpdatePacket update = (AgentUpdatePacket)packet;
|
|
|
|
agent.Avatar.Rotation = update.AgentData.BodyRotation;
|
|
agent.ControlFlags = (AgentManager.ControlFlags)update.AgentData.ControlFlags;
|
|
}
|
|
|
|
}
|
|
}
|