39 lines
1.2 KiB
C#
39 lines
1.2 KiB
C#
using Code.Base;
|
|
|
|
namespace Code.Lab2
|
|
{
|
|
public class Arrive : AgentBehaviour
|
|
{
|
|
public float targetRadius;
|
|
public float slowRadius;
|
|
public float timeToTarget = 0.1f;
|
|
|
|
public override Steering GetSteering()
|
|
{
|
|
var steering = new Steering();
|
|
var direction = target.transform.position - transform.position;
|
|
var distance = direction.magnitude;
|
|
float targetSpeed;
|
|
|
|
if (distance < targetRadius)
|
|
return steering;
|
|
if (distance > slowRadius)
|
|
targetSpeed = Agent.maxSpeed;
|
|
else
|
|
targetSpeed = Agent.maxSpeed * distance / slowRadius;
|
|
|
|
var desiredVelocity = direction;
|
|
desiredVelocity.Normalize();
|
|
desiredVelocity *= targetSpeed;
|
|
steering.Linear = desiredVelocity - Agent.velocity;
|
|
steering.Linear /= timeToTarget;
|
|
|
|
if (!(steering.Linear.magnitude > Agent.maxAcceleration)) return steering;
|
|
|
|
steering.Linear.Normalize();
|
|
steering.Linear *= Agent.maxAcceleration;
|
|
|
|
return steering;
|
|
}
|
|
}
|
|
} |