64 int32_t other_actor_type = (uint8_t)(other_actor->
actor_type);
66 switch (other_actor_type)
73 entity_navigation_work_list_staging_buffer_ptr =
112 int32_t collision_response_sign_bits;
121 return collision_response_sign_bits + 1;
129 return collision_response_sign_bits + 1;
142 int32_t other_motion_y = other_actor->
sub_pos.
y;
143 int32_t actor_motion_y = actor->
sub_pos.
y;
147 int32_t actor_motion_z = actor->
sub_pos.
z;
149 delta_vec.
y = actor_motion_y - other_motion_y;
150 delta_vec.
z = actor_motion_z - other_actor->
sub_pos.
z;
165 return collision_response_sign_bits + 1;
175 return collision_response_sign_bits + 1;
178 if (!surface_suppresses_attachment)
195 int32_t relative_motion_y = delta_vec.
y;
199 int32_t relative_motion_z = delta_vec.
z;
203 int16_t contact_normal_x = normal_storage.normal.x;
204 int16_t contact_normal_y = normal_storage.normal.y;
210 int32_t packed_contact_normal_z_padding = *(uint32_t *)((
char *)&normal_storage + 4);
213 controller->
reserved_1e = (uint16_t)((uint32_t)packed_contact_normal_z_padding >> 16);
281 return collision_depth;
382 int32_t tilt_yz_product;
388 int16_t w = ground_tilt_quaternion->
w;
393 int32_t y = (int32_t)ground_tilt_quaternion->
y;
394 int32_t x = (int32_t)ground_tilt_quaternion->
x;
395 int32_t tilt_y_squared = y * y;
396 int32_t z = (int32_t)ground_tilt_quaternion->
z;
398 tilt_yz_product = z * y;
400 int32_t tilt_xy_product = y * x;
401 int32_t tilt_w_component = (int32_t)w;
402 int32_t tilt_x_squared = x * x;
403 int32_t tilt_xz_product = z * x;
404 int32_t tilt_wx_product = tilt_w_component * x;
405 int32_t tilt_wz_product = tilt_w_component * z;
406 int32_t tilt_wy_product = tilt_w_component * y;
428 rotated_normal.
y = (int16_t)((
435 to_vec = &rotated_normal;
482 memcpy((uint8_t *)ground_tilt_quaternion + 8, ground_tilt_quaternion,
483 sizeof *ground_tilt_quaternion);
508 int32_t integration_baseline_x = integrated_position->
x;
509 int32_t integration_baseline_y = integrated_position->
y;
510 int32_t integration_baseline_z = integrated_position->
z;
531 int32_t position_before_motion_y = integrating_actor->
position.
y;
533 frame_displacement = &integrating_actor->
sub_pos;
537 integrated_position->
x += integrating_actor->
sub_pos.
x;
538 integrating_actor->
position.
y = position_before_motion_y + integrating_actor->
sub_pos.
y;
543 frame_displacement = &integrating_actor->
sub_pos;
545 int64_t displacement_x_product_wide = (int64_t)(int32_t)((int32_t)scale_factor) * (int32_t)(integrating_actor->
sub_pos.
x);
546 int32_t scaled_motion_y = integrating_actor->
sub_pos.
y;
550 int64_t displacement_y_product_wide = (int64_t)(int32_t)((int32_t)integrating_actor->
scale_factor) * (int32_t)(scaled_motion_y);
551 int32_t z_motion_scale = (int32_t)integrating_actor->
scale_factor;
555 int64_t displacement_z_product_wide = (int64_t)(int32_t)(z_motion_scale) * (int32_t)(integrating_actor->
sub_pos.
z);
557 char vertical_motion_flags = (char)integrating_actor->
behavior_flags;
559 out_world_pos.
z = displacement_z;
562 out_world_pos.
y = integrating_actor->
sub_pos.
y;
564 int32_t position_before_scaled_y = integrating_actor->
position.
y;
566 integrated_position->
x += out_world_pos.
x;
567 integrating_actor->
position.
y = position_before_scaled_y + out_world_pos.
y;
568 integrating_actor->
position.
z += displacement_z;
572 int32_t previous_motion_flags = ground_query_flags;
583 ((child_for_ground_query = integrating_actor->
child_actor) &&
600 int16_t flags_after_ground_query;
603 flags_after_ground_query = (int16_t)integrating_actor->
behavior_flags;
605 bool update_ground_contact =
true;
610 .
x = integrated_position->
x - integration_baseline_x,
611 .y = integrating_actor->
position.
y - integration_baseline_y,
612 .z = integrating_actor->
position.
z - integration_baseline_z};
614 int64_t displacement_x_squared_wide = (int64_t)(int32_t)(out_world_pos.
x) * (int32_t)(out_world_pos.
x);
615 int64_t displacement_z_squared_wide = (int64_t)(int32_t)(out_world_pos.
z) * (int32_t)(out_world_pos.
z);
617 int64_t displacement_y_squared_wide = (int64_t)(int32_t)(out_world_pos.
y) * (int32_t)(out_world_pos.
y);
619 if (out_world_pos.
y <= 0 || ((int32_t)((uint64_t)displacement_y_squared_wide >>
PHYSICS_FIXED_FRACTION_BITS)) < horizontal_displacement_squared)
622 int32_t saved_position_y = integrating_actor->
position.
y;
624 integrating_actor->
position.
y = integration_baseline_y + out_world_pos.
y;
626 int32_t ground_resolution_flags = integrating_actor->
behavior_flags;
635 integrating_actor->
position.
y = saved_position_y;
639 saved_contact_node = resolved_ground_node;
645 contact_node = saved_contact_node;
649 update_ground_contact = integrated_position->
x != integration_baseline_x ||
653 if (!update_ground_contact)
693 update_ground_contact =
true;
698 if (update_ground_contact)
706 contact_polygon, integrated_position, &out_world_pos);
708 int32_t collision_height_offset;
711 collision_height_offset = 0;
715 int32_t ground_surface_y = collision_height_offset + out_world_pos.
y;
716 int32_t ground_response_flags = integrating_actor->
behavior_flags;
717 int32_t y = ground_surface_y;
729 int32_t ground_response;
738 integrating_actor->position.y = ground_surface_y;
740 if (ground_response >= 0)
743 contact_polygon->face_plane;
754 world_contact_normal_q12.
x = (int16_t)(((int32_t)
755 contact_node->transform_matrix.m02 *
756 (int32_t)contact_plane->
normal.
z +
758 contact_node->transform_matrix.m00 *
759 (int32_t)contact_plane->
normal.
x +
761 contact_node->transform_matrix.m01 *
762 (int32_t)contact_plane->
normal.
y) >>
765 int32_t m22 = (int32_t)contact_node->transform_matrix.m22;
767 world_contact_normal_q12.
y = (int16_t)((
768 (int32_t)contact_plane->
normal.
y * (int32_t)contact_node->transform_matrix.m11 + (int32_t)contact_plane->
normal.
x * (int32_t)contact_node->transform_matrix.m10 + (int32_t)contact_plane->
normal.
z * (int32_t)contact_node->transform_matrix.m12) >>
770 world_contact_normal_q12.
z = (int16_t)((
771 m22 * (int32_t)contact_plane->
normal.
z + (int32_t)contact_node->transform_matrix.m20 * (int32_t)contact_plane->
normal.
x + (int32_t)contact_node->transform_matrix.m21 * (int32_t)contact_plane->
normal.
y) >>
773 landing_normal_q12 = &world_contact_normal_q12;
777 landing_normal_q12->
x, landing_normal_q12->
y, landing_normal_q12->
z,
778 integrating_actor->velocity.x, integrating_actor->velocity.y, integrating_actor->velocity.z);
781 if (normal_velocity >= 0)
782 landing_actor = actor;
786 int64_t normal_velocity_x_product_wide = (int64_t)(int32_t)(normal_velocity) * (int32_t)((int32_t)landing_normal_q12->
x);
787 int64_t normal_velocity_y_product_wide = (int64_t)(int32_t)(normal_velocity) * (int32_t)((int32_t)landing_normal_q12->
y);
788 int64_t normal_velocity_z_product_wide = (int64_t)(int32_t)(normal_velocity) * (int32_t)((int32_t)landing_normal_q12->
z);
790 integrating_actor->velocity.x -=
792 landing_actor = actor;
798 landing_actor->
velocity.
z = tangential_velocity_z;
801 integrating_actor = actor;
802 contact_node = saved_contact_node;
806 integrating_actor->behavior_flags =
809 if (&contact_node->transform_matrix !=
810 &integrating_actor->contact_basis)
812 integrating_actor->contact_basis.m00 =
813 contact_node->transform_matrix.m00;
814 integrating_actor->contact_basis.m01 =
815 contact_node->transform_matrix.m10;
816 integrating_actor->contact_basis.m02 =
817 contact_node->transform_matrix.m20;
818 integrating_actor->contact_basis.m10 =
819 contact_node->transform_matrix.m01;
820 integrating_actor->contact_basis.m11 =
821 contact_node->transform_matrix.m11;
822 integrating_actor->contact_basis.m12 =
823 contact_node->transform_matrix.m21;
824 integrating_actor->contact_basis.m20 =
825 contact_node->transform_matrix.m02;
826 integrating_actor->contact_basis.m21 =
827 contact_node->transform_matrix.m12;
828 integrating_actor->contact_basis.m22 =
829 contact_node->transform_matrix.m22;
833 int16_t transposed_basis_component = integrating_actor->contact_basis.m01;
835 integrating_actor->contact_basis.m01 =
836 contact_node->transform_matrix.m10;
837 integrating_actor->contact_basis.m10 = transposed_basis_component;
838 transposed_basis_component = integrating_actor->contact_basis.m02;
839 integrating_actor->contact_basis.m02 =
840 contact_node->transform_matrix.m20;
841 integrating_actor->contact_basis.m20 = transposed_basis_component;
842 transposed_basis_component = integrating_actor->contact_basis.m12;
843 integrating_actor->contact_basis.m12 =
844 contact_node->transform_matrix.m21;
845 integrating_actor->contact_basis.m21 = transposed_basis_component;
856 struct Math_Vec3I16 *ground_normal_q12 = local_face_normal_q12;
860 world_contact_normal_q12.
x = (int16_t)((
865 world_contact_normal_q12.
y = (int16_t)((
870 world_contact_normal_q12.
z = (int16_t)((
875 ground_normal_q12 = &world_contact_normal_q12;
879 ground_normal_q12->
x, ground_normal_q12->
y, ground_normal_q12->
z,
886 ground_surface_y =
y;
887 integrating_actor = actor;
888 contact_node = saved_contact_node;
891 integrating_actor->
position.
y = ground_surface_y;
895 integration_baseline_x = frame_displacement->
x + integrated_position->
x;
896 integration_baseline_y = integrating_actor->
sub_pos.
y + integrating_actor->
position.
y;
897 integration_baseline_z = integrating_actor->
sub_pos.
z + integrating_actor->
position.
z;
913 int32_t facing_target = (int32_t)integrating_actor->
facing_target;
914 int32_t current_yaw = (int32_t)facing_current;
915 int32_t facing_delta_or_yaw = current_yaw - facing_target;
917 if (current_yaw == facing_target)
920 integrating_actor->
facing_target = (uint16_t)facing_delta_or_yaw;
923 uint16_t blended_facing = integrating_actor->
facing_blend;
926 blended_facing += facing_current;
929 integrating_actor->
velocity.
x = frame_displacement->
x;
930 integrating_actor->
velocity.
y = frame_displacement->
y;
931 integrating_actor->
velocity.
z = frame_displacement->
z;
944 child_for_y_displacement->
sub_pos.
y = out_world_pos.
y - child_for_y_displacement->
position.
y;
948 child_for_z_displacement->
sub_pos.
z = out_world_pos.
z - child_for_z_displacement->
position.
z;
950 orientation_child = integrating_actor->
child_actor;
964 int32_t frame_displacement_x = integrated_position->
x - integration_baseline_x;
965 int32_t final_position_z = integrating_actor->
position.
z;
967 integrating_actor->
sub_pos.
y = integrating_actor->
position.
y - integration_baseline_y;
968 frame_displacement->
x = frame_displacement_x;
969 integrating_actor->
sub_pos.
z = final_position_z - integration_baseline_z;
978 int32_t barycentric_update_flags = integrating_actor->
behavior_flags;
985 int32_t motion_before_parent_y = integrating_actor->
sub_pos.
y;
1258 if (reaction_animation_ticks)
1263 if (reaction_animation_ticks == 1)
1266 int32_t health_delta = 0;
1274 if (damage_contact_actor)
1278 uint16_t contact_damage_amount = damage_contact_actor->
chain_timer;
1279 uint16_t contact_chain_state = damage_contact_actor->
chain_state;
1281 health_delta = -(contact_damage_amount);
1291 int32_t contacts_remaining = 4;
1294 bool has_more_contacts;
1311 int32_t base_impulse_speed = (int32_t)(int16_t)packed_speed_range;
1313 damage += (int32_t)(int16_t)(packed_speed_range >> 0x10);
1315 int32_t weighted_impulse_speed = base_impulse_speed;
1317 if (base_impulse_speed)
1322 weighted_impulse_speed =
1325 int64_t impulse_x_squared_wide = (int64_t)impulse_direction->
x * impulse_direction->
x;
1326 int64_t impulse_y_squared_wide = (int64_t)impulse_direction->
y * impulse_direction->
y;
1327 int64_t impulse_z_squared_wide = (int64_t)impulse_direction->
z * impulse_direction->
z;
1328 int32_t impulse_direction_length =
Math_SqrtFP12(((int32_t)((int64_t)((uint64_t)impulse_z_squared_wide + (uint64_t)impulse_x_squared_wide + (uint64_t)impulse_y_squared_wide) >>
PHYSICS_FIXED_FRACTION_BITS)));
1333 if (impulse_direction_length)
1335 int32_t impulse_speed_q16 = weighted_impulse_speed << 4;
1336 int32_t impulse_scale_q12 = ((int64_t)impulse_speed_q16 *
PHYSICS_FIXED_ONE) / impulse_direction_length;
1337 int64_t impulse_x_product_wide = (int64_t)impulse_scale_q12 * impulse_direction->
x;
1341 int64_t impulse_y_product_wide = (int64_t)impulse_scale_q12 * impulse_direction->
y;
1345 int64_t impulse_z_product_wide = (int64_t)impulse_scale_q12 * impulse_direction->
z;
1361 damage_actor = actor;
1367 hazard_contact = &hazard_contact_cursor[1];
1368 has_more_contacts = contacts_remaining != 1;
1369 hazard_contact_cursor = hazard_contact;
1371 contacts_remaining -= 1;
1372 }
while (has_more_contacts);
1375 return health_delta;
1382 return health_delta;