karl
93f59ec131
This is in preparation for being able to more finely control the NPC, both from the specific NPC implementation and the PathNavigator (which was renamed accordingly)
101 lines
2.9 KiB
GDScript
101 lines
2.9 KiB
GDScript
extends Path
|
|
|
|
var _current_nav_path: PoolVector3Array
|
|
|
|
var _current_nav_index
|
|
var _current_path_index
|
|
|
|
var _arrived_distance_threshold = 0.1
|
|
|
|
export(float) var speed = 8
|
|
export(NodePath) var body_nodepath
|
|
|
|
var navigation: Navigation
|
|
var body: NPC
|
|
|
|
|
|
# React to the NodeGroupNotifier of the Navigation
|
|
func set_navigator_node(navigation_node: Navigation):
|
|
navigation = navigation_node as Navigation
|
|
|
|
# Our path could change significantly with the Navigation node, so restart
|
|
_restart_navigation()
|
|
|
|
|
|
func _ready():
|
|
_restart_navigation()
|
|
|
|
|
|
# Reset the body to the starting position and start the navigation freshly
|
|
func _restart_navigation():
|
|
_current_nav_index = 0
|
|
_current_path_index = 1
|
|
|
|
body = get_node(body_nodepath) as KinematicBody
|
|
|
|
# Initialize the position
|
|
body.transform.origin = curve.get_point_position(0)
|
|
|
|
# Get the first goal
|
|
_get_new_navigation()
|
|
|
|
|
|
func _process(delta):
|
|
var current_goal = _get_current_goal()
|
|
|
|
# Move towards the current goal
|
|
var direction: Vector3 = (current_goal - _get_body_position())
|
|
var direction_normalized: Vector3 = direction.normalized()
|
|
|
|
body.move_and_slide(direction_normalized * speed)
|
|
|
|
# Look towards that goal as well
|
|
# Avoid look_at if we're already (almost) there, since that'd be an invalid look direction
|
|
# that can be identical to the up vector (which causes problems)
|
|
if direction.length() > 0.5:
|
|
body.look_at(_get_body_position() + direction_normalized, Vector3.UP)
|
|
|
|
|
|
# Returns the point we should currently be moving towards
|
|
func _get_current_goal():
|
|
# If we haven't arrived at the current goal, then that's still the goal
|
|
if _current_nav_path[_current_nav_index].distance_to(_get_body_position()) > _arrived_distance_threshold:
|
|
return _current_nav_path[_current_nav_index]
|
|
|
|
if _current_nav_index < _current_nav_path.size() - 1:
|
|
# We still have points left in the current navigation -> use the next one
|
|
Logger.trace("Using next point of current navigation")
|
|
_current_nav_index += 1
|
|
else:
|
|
# We're done following the current navigation to the next path point
|
|
if _current_path_index < curve.get_point_count() - 1:
|
|
# We still have points left in the path -> use the next one and generate the navigation to it
|
|
Logger.trace("Generating navigation to the next path point")
|
|
_current_path_index += 1
|
|
else:
|
|
# We're done following the path -> Go back to the start
|
|
Logger.trace("Returning to the start of the path")
|
|
_current_nav_index = 0
|
|
_current_path_index = 0
|
|
|
|
_get_new_navigation()
|
|
|
|
return _current_nav_path[_current_nav_index]
|
|
|
|
|
|
# Reset the navigation and build a new one for the current path index
|
|
func _get_new_navigation():
|
|
_current_nav_index = 0
|
|
|
|
var goal = curve.get_point_position(_current_path_index)
|
|
|
|
if navigation:
|
|
_current_nav_path = navigation.get_simple_path(_get_body_position(), goal)
|
|
else:
|
|
_current_nav_path = PoolVector3Array([goal])
|
|
|
|
|
|
# Return the current position of the body we're controlling
|
|
func _get_body_position():
|
|
return body.transform.origin
|