mirror of
https://github.com/Relintai/godot-steering-ai-framework.git
synced 2024-11-14 04:57:19 +01:00
48 lines
1.3 KiB
GDScript
48 lines
1.3 KiB
GDScript
class_name GSTFollowPath
|
|
extends GSTArrive
|
|
# Produces a linear acceleration that moves the agent along the specified path.
|
|
|
|
|
|
var path: GSTPath
|
|
var path_offset := 0.0
|
|
|
|
var path_param := {segment_index = 0, distance = 0}
|
|
|
|
var arrive_enabled := true
|
|
var prediction_time := 0.0
|
|
|
|
|
|
func _init(
|
|
agent: GSTSteeringAgent,
|
|
path: GSTPath,
|
|
path_offset := 0.0,
|
|
prediction_time := 0.0).(agent, null) -> void:
|
|
self.path = path
|
|
self.path_offset = path_offset
|
|
self.prediction_time = prediction_time
|
|
|
|
|
|
func _calculate_steering(acceleration: GSTTargetAcceleration) -> GSTTargetAcceleration:
|
|
var location := (
|
|
agent.position if prediction_time == 0
|
|
else agent.position + (agent.linear_velocity * prediction_time))
|
|
|
|
var distance := path.calculate_distance(location, path_param)
|
|
var target_distance := distance + path_offset
|
|
|
|
var target_position := path.calculate_target_position(path_param, target_distance)
|
|
|
|
if arrive_enabled and path.open:
|
|
if path_offset >= 0:
|
|
if target_distance > path.length - deceleration_radius:
|
|
return _arrive(acceleration, target_position)
|
|
else:
|
|
if target_distance < deceleration_radius:
|
|
return _arrive(acceleration, target_position)
|
|
|
|
acceleration.linear = (target_position - agent.position).normalized()
|
|
acceleration.linear *= agent.linear_acceleration_max
|
|
acceleration.angular = 0
|
|
|
|
return acceleration
|