CIKContext::SolveAllLocks

/* CIKContext::SolveAllLocks(Vector*, Quaternion*) */

void __thiscall CIKContext::SolveAllLocks(CIKContext *this,Vector *param_1,Quaternion *param_2)

{
  matrix3x4_t *pmVar1;
  char cVar2;
  matrix3x4_t *pmVar3;
  int iVar4;
  int iVar5;
  undefined4 local_4c;
  undefined4 local_48;
  undefined4 local_44;
  undefined4 local_40;
  int local_3c [11];
  
  do {
    pmVar3 = g_MatrixPool;
    if (g_MatrixPool == (matrix3x4_t *)0x0) {
      pmVar3 = (matrix3x4_t *)memalign(0x10,0x1800);
      if (((uint)pmVar3 & 0xf) != 0) {
        raise(5);
      }
      break;
    }
    cVar2 = ThreadInterlockedAssignIf64
                      (&g_MatrixPool,*(undefined4 *)g_MatrixPool,DAT_01047874 + -1,g_MatrixPool,
                       DAT_01047874);
  } while (cVar2 == '\0');
  local_4c = 0;
  local_48 = 0;
  local_44 = 0;
  local_40 = 0;
  if (0 < *(int *)(this + 0x101c)) {
    iVar4 = 0;
    do {
      iVar5 = iVar4 + 1;
      local_3c[1] = 0x3f800000;
      local_3c[2] = 0;
      local_3c[3] = 0;
      local_3c[0] = iVar4;
      SolveLock(this,(mstudioiklock_t *)local_3c,iVar4,param_1,param_2,pmVar3,
                (CBoneBitList *)&local_4c);
      iVar4 = iVar5;
    } while (iVar5 < *(int *)(this + 0x101c));
  }
  do {
    iVar4 = DAT_01047874;
    pmVar1 = g_MatrixPool;
    iVar5 = DAT_01047874 + 0x10001;
    *(matrix3x4_t **)pmVar3 = g_MatrixPool;
    cVar2 = ThreadInterlockedAssignIf64(&g_MatrixPool,pmVar3,iVar5,pmVar1,iVar4);
  } while (cVar2 == '\0');
  return;
}