extends TestCase func _tilted() -> SimGround: # h = 0.5 * x, a plane rising along +x. var values: PackedFloat32Array = PackedFloat32Array() for z: int in 4: for x: int in 4: values.append(0.5 * x * 2.0) return SimGround.from_heights(values, 4, 2.0) func test_flat_ground() -> void: var ground: SimGround = SimGround.flat(3.0) assert_eq(ground.terrain_height(10.0, 900.0), 3.0) assert_true(ground.terrain_normal(10.0, 10.0).is_equal_approx(Vector3.UP)) assert_true(ground.walkable_terrain(10.0, 10.0)) func test_interpolation_and_edges() -> void: var ground: SimGround = _tilted() assert_near(ground.terrain_height(1.0, 1.0), 0.5, 0.0001) assert_near(ground.terrain_height(3.0, 5.0), 1.5, 0.0001) # Outside the grid, the edge sample is used. assert_near(ground.terrain_height(-5.0, 2.0), 0.0, 0.0001) assert_near(ground.terrain_height(100.0, 2.0), 3.0, 0.0001) func test_normal_and_walkability() -> void: var ground: SimGround = _tilted() var normal: Vector3 = ground.terrain_normal(3.0, 3.0) assert_near(rad_to_deg(normal.angle_to(Vector3.UP)), rad_to_deg(atan(0.5)), 0.01) assert_true(normal.x < 0.0, "the normal leans away from the rise") assert_true(ground.walkable_terrain(3.0, 3.0)) func test_support_from_solids() -> void: var ground: SimGround = SimGround.flat() ground.add_solid(AABB(Vector3(0.0, 0.0, 0.0), Vector3(2.0, 1.0, 2.0))) ground.add_solid(AABB(Vector3(0.0, 5.0, 0.0), Vector3(2.0, 1.0, 2.0))) assert_eq(ground.support_height(1.0, 1.0, 1.2), 1.0) assert_eq(ground.support_height(1.0, 1.0, 10.0), 6.0) assert_eq(ground.support_height(1.0, 1.0, 0.5), 0.0) assert_eq(ground.support_height(3.0, 1.0, 10.0), 0.0) assert_true(ground.support_is_solid(1.0, 1.0, 1.2)) assert_false(ground.support_is_solid(3.0, 1.0, 1.2)) func test_negative_size_solids_are_normalised() -> void: var ground: SimGround = SimGround.flat() ground.add_solid(AABB(Vector3(2.0, 1.0, 2.0), Vector3(-2.0, -1.0, -2.0))) assert_eq(ground.support_height(1.0, 1.0, 5.0), 1.0) func test_raycast_against_a_box() -> void: var ground: SimGround = SimGround.flat(-100.0) ground.add_solid(AABB(Vector3(4.0, -1.0, -1.0), Vector3(2.0, 2.0, 2.0))) assert_near(ground.raycast(Vector3.ZERO, Vector3(10.0, 0.0, 0.0)), 0.4, 0.0001) assert_eq(ground.raycast(Vector3.ZERO, Vector3(3.0, 0.0, 0.0)), 1.0) assert_eq(ground.raycast(Vector3(0.0, 5.0, 0.0), Vector3(10.0, 5.0, 0.0)), 1.0) assert_eq(ground.raycast(Vector3(5.0, 0.0, 0.0), Vector3(10.0, 0.0, 0.0)), 0.0, "starting inside") func test_raycast_against_terrain() -> void: var ground: SimGround = SimGround.flat(0.0) var hit: float = ground.raycast(Vector3(0.0, 2.0, 0.0), Vector3(0.0, -2.0, 0.0)) assert_near(hit, 0.5, 0.001) assert_eq(ground.raycast(Vector3(0.0, 2.0, 0.0), Vector3(5.0, 1.0, 0.0)), 1.0) assert_eq(ground.raycast(Vector3(0.0, -1.0, 0.0), Vector3(0.0, 3.0, 0.0)), 0.0, "starting below") # A ray grazing up a slope finds where it enters. var tilted: SimGround = _tilted() var slope_hit: float = tilted.raycast(Vector3(0.0, 2.0, 2.0), Vector3(6.0, 2.0, 2.0)) assert_near(slope_hit * 6.0, 4.0, 0.01) func test_body_blocked_respects_step_and_height() -> void: var ground: SimGround = SimGround.flat() ground.add_solid(AABB(Vector3(0.0, 0.0, 0.0), Vector3(2.0, 0.4, 2.0))) ground.add_solid(AABB(Vector3(10.0, 2.0, 0.0), Vector3(2.0, 1.0, 2.0))) assert_false(ground.body_blocked(Vector3(1.0, 0.0, 1.0), 0.4, 1.8, 0.45), "low step") assert_true(ground.body_blocked(Vector3(1.0, 0.0, 1.0), 0.4, 1.8, 0.0)) assert_true(ground.body_blocked(Vector3(2.3, 0.0, 1.0), 0.4, 1.8, 0.0), "radius overlaps") assert_false(ground.body_blocked(Vector3(2.5, 0.0, 1.0), 0.4, 1.8, 0.0)) assert_false(ground.body_blocked(Vector3(11.0, 0.0, 1.0), 0.4, 1.8, 0.0), "fits under") assert_true(ground.body_blocked(Vector3(11.0, 0.0, 1.0), 0.4, 2.5, 0.0))