Stowage/godot
2
0
Fork 0
mirror of https://github.com/godotengine/godot.git synced 2025-12-07 22:00:10 +00:00
Code Issues Projects Releases Packages Wiki Activity

Remove is_penetrated check from IK as role overlap/excessive behavior

Browse source
This commit is contained in:
Silc Lizard (Tokage) Renew 2025-11-29 00:37:01 +09:00
parent 7ed0b61676
commit 390e64ff9c
2 changed files with 0 additions and 29 deletions
Download patch file Download diff file Expand all files Collapse all files

4
scene/3d/iterate_ik_3d.cpp
View file

@ -522,10 +522,6 @@ void IterateIK3D::_process_joints(double p_delta, Skeleton3D *p_skeleton, Iterat
double distance_to_target_sq = INFINITY;
int iteration_count = 0;
if (p_setting->is_penetrated(p_destination)) {
return;
}
// To prevent oscillation, if it has been processed at least once and target was reached, abort iterating.
if (p_setting->simulated) {
distance_to_target_sq = p_setting->chain[p_setting->chain.size() - 1].distance_squared_to(p_destination);

25
scene/3d/iterate_ik_3d.h
View file

@ -149,31 +149,6 @@ public:
bool simulated = false;
bool is_penetrated(const Vector3 &p_destination) {
bool ret = false;
Vector3 chain_dir = (chain[chain.size() - 1] - chain[0]).normalized();
bool is_straight = true;
for (uint32_t i = 1; i < chain.size() - 1; i++) {
Vector3 dir = (chain[i] - chain[0]).normalized();
if (!dir.is_equal_approx(chain_dir)) {
is_straight = false;
break;
}
}
if (is_straight) {
Vector3 to_target = (p_destination - chain[0]);
double proj = to_target.dot(chain_dir);
double total_length = 0;
for (uint32_t i = 0; i < solver_info_list.size(); i++) {
if (solver_info_list[i]) {
total_length += solver_info_list[i]->length;
}
}
ret = proj >= 0 && proj <= total_length && (to_target.normalized().is_equal_approx(chain_dir));
}
return ret;
}
// Make rotation as bone pose from chain coordinates.
// p_extra is delta angle limitation.
void cache_current_joint_rotations(Skeleton3D *p_skeleton, double p_angular_delta_limit = Math::PI) {