CFuncTrackTrain::UpdateOrientationBlend

/* CFuncTrackTrain::UpdateOrientationBlend(TrainOrientationType_t, CPathTrack*, CPathTrack*, Vector
   const&, float) */

void __thiscall
CFuncTrackTrain::UpdateOrientationBlend
          (CFuncTrackTrain *this,int param_2,int param_3,int param_4,undefined4 param_5,
          float param_6)

{
  longdouble lVar1;
  float fVar2;
  float fVar3;
  float fVar4;
  float fVar5;
  QAngle *local_80;
  float local_70;
  float local_6c;
  float local_68;
  float local_64;
  float local_60;
  float local_5c;
  float local_58;
  float local_54;
  float local_50;
  Quaternion local_4c [16];
  Quaternion local_3c [16];
  float local_2c;
  float local_28;
  float local_24;
  
  CPathTrack::GetOrientation(SUB41((QAngle *)&local_70,0));
  FixupAngles((QAngle *)&local_70);
  if (param_4 == 0) {
    local_64 = local_70;
    local_60 = local_6c;
    local_5c = local_68;
  }
  else {
    CPathTrack::GetOrientation(SUB41(&local_2c,0));
    local_64 = local_2c;
    local_60 = local_28;
    local_5c = local_24;
    FixupAngles((QAngle *)&local_64);
  }
  local_80 = (QAngle *)&local_64;
  if (((byte)this[0x148] & 1) != 0) {
    local_64 = local_70;
  }
  if ((param_3 != 0) &&
     (((local_64 != local_70 || (local_60 != local_6c)) || (local_5c != local_68)))) {
    fVar4 = *(float *)(param_4 + 0x39c) - *(float *)(param_3 + 0x39c);
    fVar2 = *(float *)(param_4 + 0x3a0) - *(float *)(param_3 + 0x3a0);
    fVar3 = *(float *)(param_4 + 0x3a4) - *(float *)(param_3 + 0x3a4);
    fVar2 = SQRT(fVar2 * fVar2 + fVar4 * fVar4 + fVar3 * fVar3);
    if (fVar2 != 0.0) {
      fVar5 = *(float *)(this + 0x39c) - *(float *)(param_3 + 0x39c);
      fVar3 = *(float *)(this + 0x3a4) - *(float *)(param_3 + 0x3a4);
      fVar4 = *(float *)(this + 0x3a0) - *(float *)(param_3 + 0x3a0);
      fVar2 = SQRT(fVar3 * fVar3 + fVar4 * fVar4 + fVar5 * fVar5) / fVar2;
      goto joined_r0x00b0d886;
    }
  }
  fVar2 = 0.0;
joined_r0x00b0d886:
  if (param_2 == 3) {
    fVar2 = fVar2 * fVar2 * 3.0 - (fVar2 + fVar2) * fVar2 * fVar2;
  }
  AngleQuaternion((QAngle *)&local_70,local_4c);
  AngleQuaternion(local_80,local_3c);
  local_58 = local_64;
  local_54 = local_60;
  local_50 = local_5c;
  lVar1 = (longdouble)QuaternionAngleDiff(local_4c,local_3c);
  if ((float)lVar1 != 0.0) {
    QuaternionSlerp(local_4c,local_3c,fVar2,(Quaternion *)&local_2c);
    QuaternionAngles((Quaternion *)&local_2c,(QAngle *)&local_58);
  }
  if (((byte)this[0x148] & 1) != 0) {
    local_58 = local_70;
  }
  DoUpdateOrientation(this,(QAngle *)(this + 0x3a8),(QAngle *)&local_58,param_6);
  return;
}