bull legs not clipped, arena not scaled

This commit is contained in:
2026-05-25 19:39:02 +03:00
parent 80a35a4553
commit 30136a9b90
5 changed files with 117 additions and 278 deletions
+2 -259
View File
@@ -1,54 +1,17 @@
extends Node
## Procedural leg stepping, body wobble, and tail simulation.
## Body wobble and tail simulation. Legs stay in rest pose (no IK, no ragdoll).
## Created at runtime by player.gd; call setup() before the first _process tick.
# ── Leg State Machine ─────────────────────────────────────────────────────────
enum LegState { GALLOP, LAUNCH, RAGDOLL, TUCK, LAND }
# Leg IK config — rest offsets are in bull_v10 local space
const LEG_CFG: Dictionary = {
"FL": { "root": &"front_leg_1_L", "tip": &"front_leg_2_L_end",
"rest": Vector3(-0.30, -0.25, -0.50) },
"FR": { "root": &"front_leg_1_R", "tip": &"front_leg_2_R_end",
"rest": Vector3( 0.30, -0.25, -0.50) },
"BL": { "root": &"rear_leg_1_L", "tip": &"rear_leg_3_L_end",
"rest": Vector3(-0.30, -0.25, 0.60) },
"BR": { "root": &"rear_leg_1_R", "tip": &"rear_leg_3_R_end",
"rest": Vector3( 0.30, -0.25, 0.60) },
}
# Gallop gait phase offset per leg (0.01.0 cycle).
const LEG_PHASES: Dictionary = { "BL": 0.0, "FL": 0.2, "BR": 0.5, "FR": 0.7 }
# Per-leg ragdoll phase offsets for variety
const RAGDOLL_PHASE: Dictionary = { "FL": 0.0, "FR": 1.3, "BL": 2.6, "BR": 3.9 }
var _player: CharacterBody3D
var _bull: Node3D
var _skeleton: Skeleton3D
# Per-leg state
var _ik: Dictionary = {} # id -> SkeletonIK3D
var _foot: Dictionary = {} # id -> current foot (world)
var _step_from: Dictionary = {} # id -> Vector3
var _step_to: Dictionary = {} # id -> Vector3
var _step_t: Dictionary = {} # id -> float (1.0 = planted)
# Body wobble
var _prev_vel: Vector3 = Vector3.ZERO
var _tilt_x: float = 0.0
var _tilt_z: float = 0.0
var _aerial_pitch: float = 0.0
# Leg state machine
var _leg_state: LegState = LegState.GALLOP
var _state_time: float = 0.0 # time spent in current state
var _was_on_floor: bool = true
var _launch_feet: Dictionary = {} # frozen foot positions at launch
# Gait
var _gait_phase: float = 0.0
# Tail — Verlet chain simulation
const TAIL_BONES: Array = [
&"tail_1", &"tail_2", &"tail_3", &"tail_4",
@@ -70,31 +33,13 @@ func setup(player: CharacterBody3D, bull: Node3D) -> void:
push_error("BullLegs: Skeleton3D not found under bull_v10")
return
# Disable any physical bone simulator — we don't need it
# Disable any physical bone simulator
var phys_sim := _find_physical_bones(_skeleton)
if phys_sim:
phys_sim.active = false
_setup_tail()
for id: String in LEG_CFG:
var cfg: Dictionary = LEG_CFG[id]
var ik := SkeletonIK3D.new()
ik.root_bone = cfg["root"]
ik.tip_bone = cfg["tip"]
ik.interpolation = 1.0
ik.min_distance = 0.01
_skeleton.add_child(ik)
ik.start()
_ik[id] = ik
var world_rest: Vector3 = _bull.to_global(cfg["rest"])
_foot[id] = world_rest
_step_from[id] = world_rest
_step_to[id] = world_rest
_step_t[id] = 1.0
func _setup_tail() -> void:
for bone_name: StringName in TAIL_BONES:
@@ -108,34 +53,27 @@ func _setup_tail() -> void:
push_error("BullLegs: not enough tail bones found")
return
# Initialise world positions first
for idx: int in _tail_idx:
var world: Vector3 = _skeleton.to_global(_skeleton.get_bone_global_rest(idx).origin)
_tail_world.append(world)
_tail_prev.append(world)
# Detect degenerate rest pose (FBX bones all at same position)
var max_sep: float = 0.0
for i in range(_tail_world.size() - 1):
max_sep = maxf(max_sep, _tail_world[i].distance_to(_tail_world[i + 1]))
if max_sep < 0.01:
push_warning("BullLegs: tail bones have zero separation in rest pose, distributing along spine")
var root: Vector3 = _tail_world[0]
# Backward-downward direction in world space from the skeleton
var back: Vector3 = (_skeleton.global_transform.basis.z + Vector3.DOWN * 0.3).normalized()
for i in range(_tail_world.size()):
_tail_world[i] = root + back * (i * 0.09)
_tail_prev[i] = _tail_world[i]
# Segment lengths in world space — used by the Verlet length constraint
const MIN_SEG: float = 0.06
for i in range(_tail_world.size() - 1):
var seg_len: float = _tail_world[i].distance_to(_tail_world[i + 1])
_tail_lengths.append(maxf(seg_len, MIN_SEG))
# Rest directions in SKELETON-LOCAL space — must match point_dir_skel in _apply_tail
# so that Quaternion(rest_dir, point_dir_skel) operates in a consistent frame.
# _tail_world holds world positions; to_local converts them to skeleton space.
for i in range(_tail_world.size() - 1):
var p1_skel: Vector3 = _skeleton.to_local(_tail_world[i])
var p2_skel: Vector3 = _skeleton.to_local(_tail_world[i + 1])
@@ -148,9 +86,6 @@ func _process(delta: float) -> void:
if not _skeleton:
return
_wobble_body(delta)
_update_leg_state(delta)
_step_feet(delta)
_apply_ik()
_update_tail(delta)
_apply_tail()
@@ -180,190 +115,6 @@ func _wobble_body(delta: float) -> void:
_bull.rotation.z = _tilt_z
# ── Leg State Machine ─────────────────────────────────────────────────────────
func _update_leg_state(delta: float) -> void:
var on_floor: bool = _player.is_on_floor()
_state_time += delta
match _leg_state:
LegState.GALLOP:
if not on_floor and _was_on_floor:
# Just left the ground — enter LAUNCH
_leg_state = LegState.LAUNCH
_state_time = 0.0
# Freeze current foot positions
for id: String in _foot:
_launch_feet[id] = _foot[id]
LegState.LAUNCH:
if on_floor:
_leg_state = LegState.GALLOP
_state_time = 0.0
elif _state_time > DP.f("launch_hold_time"):
_leg_state = LegState.RAGDOLL
_state_time = 0.0
LegState.RAGDOLL:
if on_floor:
_leg_state = LegState.GALLOP
_state_time = 0.0
elif _player.velocity.y < DP.f("tuck_apex_threshold"):
# Approaching or past apex — start tucking
_leg_state = LegState.TUCK
_state_time = 0.0
LegState.TUCK:
if on_floor:
_leg_state = LegState.GALLOP
_state_time = 0.0
else:
# Check for ground proximity — transition to LAND
var space := _player.get_world_3d().direct_space_state
var start := _player.global_position
var end_pt := start + Vector3.DOWN * DP.f("jump_land_threshold")
var params := PhysicsRayQueryParameters3D.create(start, end_pt)
params.exclude = [_player.get_rid()]
var hit := space.intersect_ray(params)
if hit:
_leg_state = LegState.LAND
_state_time = 0.0
LegState.LAND:
if on_floor:
_leg_state = LegState.GALLOP
_state_time = 0.0
_was_on_floor = on_floor
# ── Feet Stepping ─────────────────────────────────────────────────────────────
func _step_feet(delta: float) -> void:
match _leg_state:
LegState.GALLOP:
_step_gallop(delta)
LegState.LAUNCH:
_step_launch(delta)
LegState.RAGDOLL:
_step_ragdoll(delta)
LegState.TUCK:
_step_tuck(delta)
LegState.LAND:
_step_land(delta)
func _step_gallop(delta: float) -> void:
var threshold: float = DP.f("leg_step_threshold")
var duration: float = DP.f("leg_step_duration")
var height: float = DP.f("leg_step_height")
var overshoot: float = DP.f("leg_step_overshoot")
var flat_spd: float = Vector2(_player.velocity.x, _player.velocity.z).length()
var prev_phase: float = _gait_phase
_gait_phase = fmod(_gait_phase + flat_spd * DP.f("gait_freq") * delta, 1.0)
# Advance in-progress steps
for id: String in _step_t:
if _step_t[id] >= 1.0:
continue
_step_t[id] = minf(_step_t[id] + delta / duration, 1.0)
var t: float = _step_t[id]
var e: float = t * t * (3.0 - 2.0 * t)
var arc: float = height * sin(t * PI)
_foot[id] = _step_from[id].lerp(_step_to[id], e) + Vector3(0.0, arc, 0.0)
# Trigger steps when gait phase crosses each leg's offset
for id: String in LEG_PHASES:
if _step_t[id] < 1.0:
continue
if not _phase_crossed(prev_phase, _gait_phase, LEG_PHASES[id]):
continue
var ideal: Vector3 = _ideal_foot(id)
if _foot[id].distance_to(ideal) < threshold:
continue
_step_from[id] = _foot[id]
_step_to[id] = ideal + _player.velocity * duration * overshoot
_step_t[id] = 0.0
func _step_launch(_delta: float) -> void:
# Hold feet at their frozen launch positions
for id: String in _foot:
if _launch_feet.has(id):
_foot[id] = _launch_feet[id]
func _step_ragdoll(_delta: float) -> void:
# Procedural floppy dangle — NOT real physics ragdoll
var time: float = _state_time
var amp: float = DP.f("ragdoll_wobble_amp")
# Amplitude grows over time (legs spread more the longer airborne)
var grow: float = clampf(time * 0.8, 0.0, 1.5)
for id: String in _foot:
var rest: Vector3 = LEG_CFG[id]["rest"]
var phase: float = RAGDOLL_PHASE[id]
var dangle_offset := Vector3(
sin(time * 3.0 + phase) * amp * grow, # side sway
-0.4 - sin(time * 2.0 + phase) * 0.1 * grow, # gravity pull down
cos(time * 2.5 + phase) * amp * grow # forward/back wobble
)
_foot[id] = _bull.to_global(rest + dangle_offset)
func _step_tuck(delta: float) -> void:
# Smoothly pull legs into tucked position under the body
var speed: float = DP.f("jump_tuck_speed")
for id: String in _foot:
var tucked: Vector3 = _get_tucked_foot(id)
_foot[id] = _foot[id].lerp(tucked, clampf(delta * speed, 0.0, 1.0))
func _step_land(delta: float) -> void:
# Extend legs from tucked pose toward ideal ground positions, resume gallop cycle
var speed: float = DP.f("jump_tuck_speed") * 1.5 # slightly faster extend
for id: String in _foot:
var ideal: Vector3 = _ideal_foot(id)
_foot[id] = _foot[id].lerp(ideal, clampf(delta * speed, 0.0, 1.0))
# ── Helpers ───────────────────────────────────────────────────────────────────
func _phase_crossed(prev: float, curr: float, target: float) -> bool:
if curr >= prev:
return target >= prev and target < curr
else:
return target >= prev or target < curr
func _ideal_foot(id: String) -> Vector3:
var world_rest: Vector3 = _bull.to_global(LEG_CFG[id]["rest"])
# Raycast for ground
var space := _player.get_world_3d().direct_space_state
var params := PhysicsRayQueryParameters3D.create(
world_rest + Vector3(0.0, 0.6, 0.0),
world_rest + Vector3(0.0, -1.4, 0.0),
)
params.exclude = [_player.get_rid()]
var hit := space.intersect_ray(params)
return hit["position"] if hit else world_rest
func _get_tucked_foot(id: String) -> Vector3:
var rest: Vector3 = LEG_CFG[id]["rest"]
var tucked_local := rest + Vector3(0.0, DP.f("jump_tuck_up"), DP.f("jump_tuck_fwd"))
return _bull.to_global(tucked_local)
func _apply_ik() -> void:
var skel_inv: Transform3D = _skeleton.global_transform.affine_inverse()
for id: String in _ik:
var ik: SkeletonIK3D = _ik[id]
ik.target = Transform3D(Basis.IDENTITY, skel_inv * _foot[id])
# ── Tail ──────────────────────────────────────────────────────────────────────
func _update_tail(delta: float) -> void:
@@ -373,26 +124,21 @@ func _update_tail(delta: float) -> void:
var gravity := Vector3(0.0, -DP.f("tail_gravity"), 0.0)
var damping := 1.0 - clampf(DP.f("tail_damping"), 0.0, 0.99)
# Re-anchor root joint
var anchor: Vector3 = _skeleton.to_global(_skeleton.get_bone_global_rest(_tail_idx[0]).origin)
_tail_world[0] = anchor
_tail_prev[0] = anchor
# Idle wag force
var flat_speed: float = Vector2(_player.velocity.x, _player.velocity.z).length()
var wag_strength: float = lerpf(DP.f("tail_wag_idle"), 0.0, clampf(flat_speed / 3.0, 0.0, 1.0))
var time: float = Time.get_ticks_msec() / 1000.0
# Verlet integrate
for i in range(1, _tail_world.size()):
var vel: Vector3 = (_tail_world[i] - _tail_prev[i]) * damping
_tail_prev[i] = _tail_world[i]
# Add wag force (sinusoidal side-to-side)
var wag := _bull.global_transform.basis.x \
* sin(time * DP.f("tail_wag_freq") + i * 0.5) * wag_strength
_tail_world[i] = _tail_world[i] + vel + gravity * (delta * delta) + wag * delta
# Length constraint
for i in range(1, _tail_world.size()):
var dir: Vector3 = _tail_world[i] - _tail_world[i - 1]
var len: float = dir.length()
@@ -402,12 +148,9 @@ func _update_tail(delta: float) -> void:
else:
_tail_world[i] = _tail_world[i - 1] + Vector3(0.0, -target_len, 0.0)
# Body collision pass — prevent tail from clipping through torso
# Use bull's local space; body is approximated as a capsule along Z axis
var body_radius: float = DP.f("tail_body_radius")
for i in range(1, _tail_world.size()):
var p := _bull.to_local(_tail_world[i])
# Capsule centered at roughly (0, 0, 0.1) in bull local space, half-length 0.4 along Z
var closest := Vector3(0.0, 0.0, clampf(p.z, -0.3, 0.5))
var diff := p - closest
var dist := diff.length()