step_state.gd

extends Node

var state_set: bool = false

# State for the goal areas of the objects placed in this step
var goals_for_manip_objects: Array[Vector3] = []

# State for the goal interactions of the objects placed in this step
# TODO Need to come up with the structure of this state

func _origin_within_bounds(test: Vector3, goal: Vector3) -> bool:
	for i in range(3):
		if test.x < goal.x - 0.5 or test.x > goal.x + 0.5:
			return false
		if test.y < goal.y - 0.5 or test.y > goal.y + 0.5:
			return false
		if test.z < goal.z - 0.5 or test.z > goal.z + 0.5:
			return false
	return true


func manip_object_goals_achieved(manip_objects: Array[Block]) -> bool:
	if manip_objects.size() != goals_for_manip_objects.size():
		return false
	
	for object in manip_objects:
		var matched_transform: bool = false
		for goal_origin in goals_for_manip_objects:
			if _origin_within_bounds(object.transform.origin, goal_origin):
				matched_transform = true
		if not matched_transform:
			return false
	
	return true