gai-godot-games/pathfinding-algorithms/scenes/custom-solver/CustomNavMovement.gd

extends CharacterBody2D

const MAX_SPEED: float  = 300.0
const ACCELERATION: int = 2400
@onready var graph: NavigationGraph = $"../NavGraph"

var frozen: bool = false


func _physics_process(delta: float) -> void:
	# check if space is pressed
	if Input.is_action_just_pressed("ui_select"):
		frozen = !frozen

	var movement: Vector2 = Vector2()
	if frozen:
		return

	var pathfinding_result: PathfindingResult = graph.determine_next_position(position, get_global_mouse_position())
	graph.draw_pathfinding_result(pathfinding_result)

	movement = pathfinding_result.next_position - global_position

	if pathfinding_result.is_next_target and movement.length() < 20:
		movement = -velocity * 0.2
	else:
		movement = movement.normalized() * ACCELERATION * delta

	velocity += movement
	if velocity.length() > MAX_SPEED:
		velocity = velocity.normalized() * MAX_SPEED

	move_and_slide()