ILocomotion::AdjustPosture

/* ILocomotion::AdjustPosture(Vector const&) */

void __thiscall ILocomotion::AdjustPosture(ILocomotion *this,Vector *param_1)

{
  char cVar1;
  int *piVar2;
  float *pfVar3;
  int *piVar4;
  IHandleEntity *pIVar5;
  float *pfVar6;
  undefined4 uVar7;
  longdouble lVar8;
  longdouble lVar9;
  float fVar10;
  float fVar11;
  float fVar12;
  float fVar13;
  float fVar14;
  float fVar15;
  float fVar16;
  float fVar17;
  float fVar18;
  float local_f0;
  float local_ec;
  float local_e8;
  undefined **local_e4 [4];
  int *local_d4;
  undefined4 local_d0;
  float local_cc;
  float local_c8;
  float local_c4;
  float local_bc;
  float local_b8;
  float local_b4;
  float local_ac;
  float local_a8;
  float local_a4;
  float local_9c;
  float local_98;
  float local_94;
  undefined4 local_8c;
  undefined1 local_88;
  undefined1 local_87;
  float local_70;
  float local_6c;
  float local_68;
  float local_44;
  char local_39;
  
  piVar2 = (int *)(**(code **)(*(int *)this + 0xb0))(this);
  piVar2 = (int *)(**(code **)(*piVar2 + 0xc4))(piVar2);
  cVar1 = (**(code **)(*piVar2 + 0x100))(piVar2,0);
  if (cVar1 == '\0') {
    cVar1 = (**(code **)(*piVar2 + 0x100))(piVar2,1);
    if (cVar1 == '\0') {
      return;
    }
  }
  lVar8 = (longdouble)(**(code **)(*(int *)this + 0x130))(this);
  pfVar3 = (float *)(**(code **)(*piVar2 + 0x128))(piVar2);
  fVar15 = *pfVar3;
  fVar11 = pfVar3[1];
  fVar17 = (float)lVar8 + pfVar3[2];
  lVar8 = (longdouble)(**(code **)(*piVar2 + 0x118))(piVar2);
  fVar10 = (float)lVar8 * 0.5;
  lVar8 = (longdouble)(**(code **)(*piVar2 + 0x120))(piVar2);
  piVar4 = (int *)(**(code **)(*(int *)this + 0xb0))(this);
  pIVar5 = (IHandleEntity *)(**(code **)(*piVar4 + 0xb4))(piVar4);
  CTraceFilterSimple::CTraceFilterSimple
            ((CTraceFilterSimple *)local_e4,pIVar5,0,IgnoreActorsTraceFilterFunction);
  local_e4[0] = &PTR_ShouldHitEntity_00ca96c8;
  local_d0 = 0;
  local_d4 = piVar4;
  pfVar3 = (float *)(**(code **)(*(int *)this + 0x100))(this);
  pfVar6 = (float *)(**(code **)(*(int *)this + 300))(this);
  local_f0 = *(float *)param_1 - *pfVar6;
  local_ec = *(float *)(param_1 + 4) - pfVar6[1];
  local_e8 = *(float *)(param_1 + 8) - pfVar6[2];
  lVar9 = (longdouble)VectorNormalize((Vector *)&local_f0);
  fVar12 = (float)lVar9;
  local_68 = pfVar3[1] * -local_ec - *pfVar3 * local_f0;
  local_70 = local_f0 * pfVar3[2];
  local_6c = -(-local_ec * pfVar3[2]);
  VectorNormalize((Vector *)&local_70);
  fVar14 = local_70 * fVar12 + *pfVar6;
  fVar16 = local_6c * fVar12 + pfVar6[1];
  fVar18 = fVar12 * local_68 + pfVar6[2];
  uVar7 = (**(code **)(*piVar2 + 0x130))(piVar2);
  local_bc = fVar14 - *pfVar6;
  local_b8 = fVar16 - pfVar6[1];
  local_b4 = fVar18 - pfVar6[2];
  local_8c = 0;
  local_94 = ((float)lVar8 - fVar17) * 0.5;
  local_87 = local_b8 * local_b8 + local_bc * local_bc + local_b4 * local_b4 != 0.0;
  fVar13 = (fVar10 - fVar11) * 0.5;
  fVar12 = (fVar10 - fVar15) * 0.5;
  fVar11 = (fVar10 + fVar11) * 0.5;
  fVar10 = (fVar15 + fVar10) * 0.5;
  fVar15 = fVar13 * fVar13 + fVar12 * fVar12;
  local_88 = local_94 * local_94 + fVar15 < 1e-06;
  local_a4 = ((float)lVar8 + fVar17) * 0.5;
  local_cc = *pfVar6 + fVar10;
  local_c8 = pfVar6[1] + fVar11;
  local_c4 = pfVar6[2] + local_a4;
  local_a4 = -local_a4;
  local_ac = -fVar10;
  local_a8 = -fVar11;
  local_9c = fVar12;
  local_98 = fVar13;
  (**(code **)(*enginetrace + 0x14))(enginetrace,&local_cc,uVar7,local_e4,(Vector *)&local_70);
  if ((local_44 < 1.0) || (local_39 != '\0')) {
    cVar1 = (**(code **)(*piVar2 + 0x100))(piVar2,1);
    if (cVar1 == '\0') {
      lVar8 = (longdouble)(**(code **)(*piVar2 + 0x124))(piVar2);
      uVar7 = (**(code **)(*piVar2 + 0x130))(piVar2);
      local_bc = fVar14 - *pfVar6;
      local_b8 = fVar16 - pfVar6[1];
      local_b4 = fVar18 - pfVar6[2];
      local_8c = 0;
      local_87 = local_b8 * local_b8 + local_bc * local_bc + local_b4 * local_b4 != 0.0;
      local_94 = ((float)lVar8 - fVar17) * 0.5;
      local_88 = local_94 * local_94 + fVar15 < 1e-06;
      local_a4 = ((float)lVar8 + fVar17) * 0.5;
      local_cc = fVar10 + *pfVar6;
      local_c8 = fVar11 + pfVar6[1];
      local_c4 = pfVar6[2] + local_a4;
      local_a4 = -local_a4;
      local_ac = -fVar10;
      local_a8 = -fVar11;
      local_9c = fVar12;
      local_98 = fVar13;
      (**(code **)(*enginetrace + 0x14))(enginetrace,&local_cc,uVar7,local_e4,(Vector *)&local_70);
      if ((1.0 <= local_44) && (local_39 == '\0')) {
        (**(code **)(*piVar2 + 0xec))(piVar2,1);
      }
    }
  }
  else {
    cVar1 = (**(code **)(*piVar2 + 0x100))(piVar2,1);
    if (cVar1 != '\0') {
      (**(code **)(*piVar2 + 0xec))(piVar2,0);
    }
  }
  return;
}