karl
9c583ed694
The PathNavigatorForKinematicBody node can take a KinematicBody as a child and move it along its path. It doesn't strictly follow the path though, but also avoids obstacles according to the Navigation (with its Navmesh). How the Navigation node is fetched will be changed using Groups later, the current structure is temporary. A PathTestWorld has been added for testing this behavior, as well as a basic Meldewesen.
76 lines
2.1 KiB
GDScript
76 lines
2.1 KiB
GDScript
extends Path
|
|
|
|
var _current_nav_path: PoolVector3Array
|
|
|
|
var _current_nav_index = 0
|
|
var _current_path_index = 1
|
|
|
|
var _arrived_distance_threshold = 0.1
|
|
|
|
export(float) var speed = 8
|
|
export(NodePath) var navigation_nodepath
|
|
export(NodePath) var body_nodepath
|
|
|
|
var navigation: Navigation
|
|
var body: KinematicBody
|
|
|
|
|
|
func _ready():
|
|
navigation = get_node(navigation_nodepath) as Navigation
|
|
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 = (current_goal - _get_body_position()).normalized()
|
|
|
|
body.move_and_slide(direction * speed)
|
|
|
|
# Look towards that goal as well
|
|
body.look_at(_get_body_position() + direction, 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
|
|
_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
|
|
_current_path_index += 1
|
|
else:
|
|
# We're done following the path -> Go back to the start
|
|
_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)
|
|
_current_nav_path = navigation.get_simple_path(_get_body_position(), goal)
|
|
|
|
|
|
# Return the current position of the body we're controlling
|
|
func _get_body_position():
|
|
return body.transform.origin
|