space.c 89.1 KB
Newer Older
1
/*******************************************************************************
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
 * This file is part of SWIFT.
 * Copyright (c) 2012 Pedro Gonnet (pedro.gonnet@durham.ac.uk)
 *                    Matthieu Schaller (matthieu.schaller@durham.ac.uk)
 *               2015 Peter W. Draper (p.w.draper@durham.ac.uk)
 *               2016 John A. Regan (john.a.regan@durham.ac.uk)
 *                    Tom Theuns (tom.theuns@durham.ac.uk)
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published
 * by the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 ******************************************************************************/
Pedro Gonnet's avatar
Pedro Gonnet committed
23
24
25
26
27
28
29
30

/* Config parameters. */
#include "../config.h"

/* Some standard headers. */
#include <float.h>
#include <limits.h>
#include <math.h>
31
#include <stdlib.h>
32
#include <string.h>
Pedro Gonnet's avatar
Pedro Gonnet committed
33

34
35
/* MPI headers. */
#ifdef WITH_MPI
36
#include <mpi.h>
37
38
#endif

39
40
41
/* This object's header. */
#include "space.h"

Pedro Gonnet's avatar
Pedro Gonnet committed
42
/* Local headers. */
43
#include "atomic.h"
44
#include "const.h"
45
#include "cooling.h"
46
#include "engine.h"
47
#include "error.h"
48
49
#include "gravity.h"
#include "hydro.h"
50
#include "kernel_hydro.h"
51
#include "lock.h"
52
#include "memswap.h"
53
#include "minmax.h"
54
#include "multipole.h"
55
#include "runner.h"
56
#include "stars.h"
57
#include "threadpool.h"
58
#include "tools.h"
Pedro Gonnet's avatar
Pedro Gonnet committed
59
60
61

/* Split size. */
int space_splitsize = space_splitsize_default;
62
int space_subsize = space_subsize_default;
63
int space_maxsize = space_maxsize_default;
64
int space_maxcount = space_maxcount_default;
Pedro Gonnet's avatar
Pedro Gonnet committed
65
66
67

/* Map shift vector to sortlist. */
const int sortlistID[27] = {
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
    /* ( -1 , -1 , -1 ) */ 0,
    /* ( -1 , -1 ,  0 ) */ 1,
    /* ( -1 , -1 ,  1 ) */ 2,
    /* ( -1 ,  0 , -1 ) */ 3,
    /* ( -1 ,  0 ,  0 ) */ 4,
    /* ( -1 ,  0 ,  1 ) */ 5,
    /* ( -1 ,  1 , -1 ) */ 6,
    /* ( -1 ,  1 ,  0 ) */ 7,
    /* ( -1 ,  1 ,  1 ) */ 8,
    /* (  0 , -1 , -1 ) */ 9,
    /* (  0 , -1 ,  0 ) */ 10,
    /* (  0 , -1 ,  1 ) */ 11,
    /* (  0 ,  0 , -1 ) */ 12,
    /* (  0 ,  0 ,  0 ) */ 0,
    /* (  0 ,  0 ,  1 ) */ 12,
    /* (  0 ,  1 , -1 ) */ 11,
    /* (  0 ,  1 ,  0 ) */ 10,
    /* (  0 ,  1 ,  1 ) */ 9,
    /* (  1 , -1 , -1 ) */ 8,
    /* (  1 , -1 ,  0 ) */ 7,
    /* (  1 , -1 ,  1 ) */ 6,
    /* (  1 ,  0 , -1 ) */ 5,
    /* (  1 ,  0 ,  0 ) */ 4,
    /* (  1 ,  0 ,  1 ) */ 3,
    /* (  1 ,  1 , -1 ) */ 2,
    /* (  1 ,  1 ,  0 ) */ 1,
    /* (  1 ,  1 ,  1 ) */ 0};

96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
/**
 * @brief Interval stack necessary for parallel particle sorting.
 */
struct qstack {
  volatile ptrdiff_t i, j;
  volatile int min, max;
  volatile int ready;
};

/**
 * @brief Parallel particle-sorting stack
 */
struct parallel_sort {
  struct part *parts;
  struct gpart *gparts;
  struct xpart *xparts;
112
  struct spart *sparts;
113
114
115
116
117
118
  int *ind;
  struct qstack *stack;
  unsigned int stack_size;
  volatile unsigned int first, last, waiting;
};

119
120
121
122
123
124
125
126
127
/**
 * @brief Information required to compute the particle cell indices.
 */
struct index_data {
  struct space *s;
  struct cell *cells;
  int *ind;
};

128
129
130
131
132
133
134
135
136
137
138
/**
 * @brief Get the shift-id of the given pair of cells, swapping them
 *      if need be.
 *
 * @param s The space
 * @param ci Pointer to first #cell.
 * @param cj Pointer second #cell.
 * @param shift Vector from ci to cj.
 *
 * @return The shift ID and set shift, may or may not swap ci and cj.
 */
139
140
141
142
int space_getsid(struct space *s, struct cell **ci, struct cell **cj,
                 double *shift) {

  /* Get the relative distance between the pairs, wrapping. */
143
144
145
  const int periodic = s->periodic;
  double dx[3];
  for (int k = 0; k < 3; k++) {
146
147
148
149
150
151
152
153
154
155
156
    dx[k] = (*cj)->loc[k] - (*ci)->loc[k];
    if (periodic && dx[k] < -s->dim[k] / 2)
      shift[k] = s->dim[k];
    else if (periodic && dx[k] > s->dim[k] / 2)
      shift[k] = -s->dim[k];
    else
      shift[k] = 0.0;
    dx[k] += shift[k];
  }

  /* Get the sorting index. */
157
  int sid = 0;
158
  for (int k = 0; k < 3; k++)
159
160
161
162
    sid = 3 * sid + ((dx[k] < 0.0) ? 0 : ((dx[k] > 0.0) ? 2 : 1));

  /* Switch the cells around? */
  if (runner_flip[sid]) {
163
    struct cell *temp = *ci;
164
165
    *ci = *cj;
    *cj = temp;
166
    for (int k = 0; k < 3; k++) shift[k] = -shift[k];
167
168
169
170
171
172
  }
  sid = sortlistID[sid];

  /* Return the sort ID. */
  return sid;
}
173

174
/**
175
 * @brief Recursively dismantle a cell tree.
176
 *
177
178
 * @param s The #space.
 * @param c The #cell to recycle.
Matthieu Schaller's avatar
Matthieu Schaller committed
179
180
 * @param rec_begin Pointer to the start of the list of cells to recycle.
 * @param rec_end Pointer to the end of the list of cells to recycle.
181
 */
182
void space_rebuild_recycle_rec(struct space *s, struct cell *c,
183
184
185
186
                               struct cell **cell_rec_begin,
                               struct cell **cell_rec_end,
                               struct multipole **multipole_rec_begin,
                               struct multipole **multipole_rec_end) {
187
  if (c->split)
188
    for (int k = 0; k < 8; k++)
189
      if (c->progeny[k] != NULL) {
190
191
192
193
194
195
196
197
198
199
200
201
202
203
        space_rebuild_recycle_rec(s, c->progeny[k], cell_rec_begin,
                                  cell_rec_end, multipole_rec_begin,
                                  multipole_rec_end);

        c->progeny[k]->next = *cell_rec_begin;
        *cell_rec_begin = c->progeny[k];
        c->progeny[k]->multipole->next = *multipole_rec_begin;
        *multipole_rec_begin = c->progeny[k]->multipole;

        if (*cell_rec_end == NULL) *cell_rec_end = *cell_rec_begin;
        if (*multipole_rec_end == NULL)
          *multipole_rec_end = *multipole_rec_begin;

        c->progeny[k]->multipole = NULL;
204
205
206
207
        c->progeny[k] = NULL;
      }
}

208
209
210
211
212
213
214
215
void space_rebuild_recycle_mapper(void *map_data, int num_elements,
                                  void *extra_data) {

  struct space *s = (struct space *)extra_data;
  struct cell *cells = (struct cell *)map_data;

  for (int k = 0; k < num_elements; k++) {
    struct cell *c = &cells[k];
216
217
218
219
220
221
222
    struct cell *cell_rec_begin = NULL, *cell_rec_end = NULL;
    struct multipole *multipole_rec_begin = NULL, *multipole_rec_end = NULL;
    space_rebuild_recycle_rec(s, c, &cell_rec_begin, &cell_rec_end,
                              &multipole_rec_begin, &multipole_rec_end);
    if (cell_rec_begin != NULL)
      space_recycle_list(s, cell_rec_begin, cell_rec_end, multipole_rec_begin,
                         multipole_rec_end);
223
224
225
226
227
228
229
230
231
232
    c->sorts = NULL;
    c->nr_tasks = 0;
    c->density = NULL;
    c->gradient = NULL;
    c->force = NULL;
    c->grav = NULL;
    c->dx_max = 0.0f;
    c->sorted = 0;
    c->count = 0;
    c->gcount = 0;
233
    c->scount = 0;
234
235
236
    c->init = NULL;
    c->extra_ghost = NULL;
    c->ghost = NULL;
237
238
    c->kick1 = NULL;
    c->kick2 = NULL;
239
    c->timestep = NULL;
240
    c->drift = NULL;
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
    c->cooling = NULL;
    c->sourceterms = NULL;
    c->super = c;
    if (c->sort != NULL) {
      free(c->sort);
      c->sort = NULL;
    }
#if WITH_MPI
    c->recv_xv = NULL;
    c->recv_rho = NULL;
    c->recv_gradient = NULL;
    c->recv_ti = NULL;

    c->send_xv = NULL;
    c->send_rho = NULL;
    c->send_gradient = NULL;
    c->send_ti = NULL;
#endif
  }
}

262
/**
263
 * @brief Re-build the top-level cell grid.
264
 *
265
 * @param s The #space.
266
 * @param verbose Print messages to stdout or not.
267
 */
268
void space_regrid(struct space *s, int verbose) {
269

270
  const size_t nr_parts = s->nr_parts;
271
  const ticks tic = getticks();
272
  const integertime_t ti_old = (s->e != NULL) ? s->e->ti_old : 0;
273

274
  /* Run through the cells and get the current h_max. */
275
  // tic = getticks();
276
  float h_max = s->cell_min / kernel_gamma / space_stretch;
277
  if (nr_parts > 0) {
278
    if (s->cells_top != NULL) {
Tom Theuns's avatar
Tom Theuns committed
279
      for (int k = 0; k < s->nr_cells; k++) {
280
281
282
        if (s->cells_top[k].nodeID == engine_rank &&
            s->cells_top[k].h_max > h_max) {
          h_max = s->cells_top[k].h_max;
283
        }
284
285
      }
    } else {
286
      for (size_t k = 0; k < nr_parts; k++) {
Matthieu Schaller's avatar
Matthieu Schaller committed
287
        if (s->parts[k].h > h_max) h_max = s->parts[k].h;
288
      }
289
290
291
292
293
294
295
296
297
298
    }
  }

/* If we are running in parallel, make sure everybody agrees on
   how large the largest cell should be. */
#ifdef WITH_MPI
  {
    float buff;
    if (MPI_Allreduce(&h_max, &buff, 1, MPI_FLOAT, MPI_MAX, MPI_COMM_WORLD) !=
        MPI_SUCCESS)
299
      error("Failed to aggregate the rebuild flag across nodes.");
300
301
302
    h_max = buff;
  }
#endif
303
  if (verbose) message("h_max is %.3e (cell_min=%.3e).", h_max, s->cell_min);
304
305

  /* Get the new putative cell dimensions. */
306
  const int cdim[3] = {
307
308
309
310
311
312
      floor(s->dim[0] /
            fmax(h_max * kernel_gamma * space_stretch, s->cell_min)),
      floor(s->dim[1] /
            fmax(h_max * kernel_gamma * space_stretch, s->cell_min)),
      floor(s->dim[2] /
            fmax(h_max * kernel_gamma * space_stretch, s->cell_min))};
313
314
315
316
317

  /* Check if we have enough cells for periodicity. */
  if (s->periodic && (cdim[0] < 3 || cdim[1] < 3 || cdim[2] < 3))
    error(
        "Must have at least 3 cells in each spatial dimension when periodicity "
318
319
320
        "is switched on.\nThis error is often caused by any of the "
        "followings:\n"
        " - too few particles to generate a sensible grid,\n"
321
322
        " - the initial value of 'Scheduler:max_top_level_cells' is too "
        "small,\n"
323
        " - the (minimal) time-step is too large leading to particles with "
324
325
326
        "predicted smoothing lengths too large for the box size,\n"
        " - particle with velocities so large that they move by more than two "
        "box sizes per time-step.\n");
327

328
329
330
331
332
333
  /* Check if we have enough cells for gravity. */
  if (s->gravity && (cdim[0] < 8 || cdim[1] < 8 || cdim[2] < 8))
    error(
        "Must have at least 8 cells in each spatial dimension when gravity "
        "is switched on.");

334
335
336
/* In MPI-Land, changing the top-level cell size requires that the
 * global partition is recomputed and the particles redistributed.
 * Be prepared to do that. */
337
#ifdef WITH_MPI
Matthieu Schaller's avatar
Matthieu Schaller committed
338
  double oldwidth[3];
339
340
341
342
343
344
345
346
  double oldcdim[3];
  int *oldnodeIDs = NULL;
  if (cdim[0] < s->cdim[0] || cdim[1] < s->cdim[1] || cdim[2] < s->cdim[2]) {

    /* Capture state of current space. */
    oldcdim[0] = s->cdim[0];
    oldcdim[1] = s->cdim[1];
    oldcdim[2] = s->cdim[2];
347
348
349
    oldwidth[0] = s->width[0];
    oldwidth[1] = s->width[1];
    oldwidth[2] = s->width[2];
350
351
352
353
354
355
356
357
358

    if ((oldnodeIDs = (int *)malloc(sizeof(int) * s->nr_cells)) == NULL)
      error("Failed to allocate temporary nodeIDs.");

    int cid = 0;
    for (int i = 0; i < s->cdim[0]; i++) {
      for (int j = 0; j < s->cdim[1]; j++) {
        for (int k = 0; k < s->cdim[2]; k++) {
          cid = cell_getid(oldcdim, i, j, k);
359
          oldnodeIDs[cid] = s->cells_top[cid].nodeID;
360
361
362
363
364
        }
      }
    }
  }

365
366
367
368
#endif

  /* Do we need to re-build the upper-level cells? */
  // tic = getticks();
369
  if (s->cells_top == NULL || cdim[0] < s->cdim[0] || cdim[1] < s->cdim[1] ||
370
371
      cdim[2] < s->cdim[2]) {

372
373
374
375
376
377
/* Be verbose about this. */
#ifdef SWIFT_DEBUG_CHECKS
    message("re)griding space cdim=(%d %d %d)", cdim[0], cdim[1], cdim[2]);
    fflush(stdout);
#endif

378
    /* Free the old cells, if they were allocated. */
379
    if (s->cells_top != NULL) {
380
381
      threadpool_map(&s->e->threadpool, space_rebuild_recycle_mapper,
                     s->cells_top, s->nr_cells, sizeof(struct cell), 100, s);
382
      free(s->cells_top);
383
      free(s->multipoles_top);
384
385
386
387
      s->maxdepth = 0;
    }

    /* Set the new cell dimensions only if smaller. */
388
    for (int k = 0; k < 3; k++) {
389
      s->cdim[k] = cdim[k];
390
391
      s->width[k] = s->dim[k] / cdim[k];
      s->iwidth[k] = 1.0 / s->width[k];
392
    }
393
    const float dmin = min(s->width[0], min(s->width[1], s->width[2]));
394
395
396

    /* Allocate the highest level of cells. */
    s->tot_cells = s->nr_cells = cdim[0] * cdim[1] * cdim[2];
397
    if (posix_memalign((void *)&s->cells_top, cell_align,
398
                       s->nr_cells * sizeof(struct cell)) != 0)
399
      error("Failed to allocate top-level cells.");
400
    bzero(s->cells_top, s->nr_cells * sizeof(struct cell));
401

402
403
404
405
406
407
408
409
    /* Allocate the multipoles for the top-level cells. */
    if (s->gravity) {
      if (posix_memalign((void *)&s->multipoles_top, multipole_align,
                         s->nr_cells * sizeof(struct multipole)) != 0)
        error("Failed to allocate top-level multipoles.");
      bzero(s->multipoles_top, s->nr_cells * sizeof(struct multipole));
    }

410
    /* Set the cells' locks */
411
    for (int k = 0; k < s->nr_cells; k++) {
412
      if (lock_init(&s->cells_top[k].lock) != 0)
413
414
415
416
417
418
419
420
        error("Failed to init spinlock for hydro.");
      if (lock_init(&s->cells_top[k].glock) != 0)
        error("Failed to init spinlock for gravity.");
      if (lock_init(&s->cells_top[k].mlock) != 0)
        error("Failed to init spinlock for multipoles.");
      if (lock_init(&s->cells_top[k].slock) != 0)
        error("Failed to init spinlock for stars.");
    }
421
422

    /* Set the cell location and sizes. */
423
424
425
    for (int i = 0; i < cdim[0]; i++)
      for (int j = 0; j < cdim[1]; j++)
        for (int k = 0; k < cdim[2]; k++) {
426
427
          const size_t cid = cell_getid(cdim, i, j, k);
          struct cell *restrict c = &s->cells_top[cid];
428
429
430
431
432
433
          c->loc[0] = i * s->width[0];
          c->loc[1] = j * s->width[1];
          c->loc[2] = k * s->width[2];
          c->width[0] = s->width[0];
          c->width[1] = s->width[1];
          c->width[2] = s->width[2];
434
435
436
437
          c->dmin = dmin;
          c->depth = 0;
          c->count = 0;
          c->gcount = 0;
438
          c->scount = 0;
439
          c->super = c;
440
          c->ti_old = ti_old;
441
          if (s->gravity) c->multipole = &s->multipoles_top[cid];
Pedro Gonnet's avatar
Pedro Gonnet committed
442
        }
443
444

    /* Be verbose about the change. */
445
446
447
    if (verbose)
      message("set cell dimensions to [ %i %i %i ].", cdim[0], cdim[1],
              cdim[2]);
448

449
#ifdef WITH_MPI
450
451
452
453
454
    if (oldnodeIDs != NULL) {
      /* We have changed the top-level cell dimension, so need to redistribute
       * cells around the nodes. We repartition using the old space node
       * positions as a grid to resample. */
      if (s->e->nodeID == 0)
455
456
457
        message(
            "basic cell dimensions have increased - recalculating the "
            "global partition.");
458

Matthieu Schaller's avatar
Matthieu Schaller committed
459
      if (!partition_space_to_space(oldwidth, oldcdim, oldnodeIDs, s)) {
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477

        /* Failed, try another technique that requires no settings. */
        message("Failed to get a new partition, trying less optimal method");
        struct partition initial_partition;
#ifdef HAVE_METIS
        initial_partition.type = INITPART_METIS_NOWEIGHT;
#else
        initial_partition.type = INITPART_VECTORIZE;
#endif
        partition_initial_partition(&initial_partition, s->e->nodeID,
                                    s->e->nr_nodes, s);
      }

      /* Re-distribute the particles to their new nodes. */
      engine_redistribute(s->e);

      /* Make the proxies. */
      engine_makeproxies(s->e);
478

479
480
      /* Finished with these. */
      free(oldnodeIDs);
481
    }
Pedro Gonnet's avatar
Pedro Gonnet committed
482
#endif /* WITH_MPI */
483
484
485
486

    // message( "rebuilding upper-level cells took %.3f %s." ,
    // clocks_from_ticks(double)(getticks() - tic), clocks_getunit());

487
  }      /* re-build upper-level cells? */
488
  else { /* Otherwise, just clean up the cells. */
489
490

    /* Free the old cells, if they were allocated. */
491
492
    threadpool_map(&s->e->threadpool, space_rebuild_recycle_mapper,
                   s->cells_top, s->nr_cells, sizeof(struct cell), 100, s);
493
494
    s->maxdepth = 0;
  }
495
496
497
498

  if (verbose)
    message("took %.3f %s.", clocks_from_ticks(getticks() - tic),
            clocks_getunit());
499
}
500
501
502
503
504

/**
 * @brief Re-build the cells as well as the tasks.
 *
 * @param s The #space in which to update the cells.
505
 * @param verbose Print messages to stdout or not
506
507
 *
 */
508
void space_rebuild(struct space *s, int verbose) {
509

Matthieu Schaller's avatar
Matthieu Schaller committed
510
  const ticks tic = getticks();
511

512
513
/* Be verbose about this. */
#ifdef SWIFT_DEBUG_CHECKS
Matthieu Schaller's avatar
Matthieu Schaller committed
514
  if (s->e->nodeID == 0 || verbose) message("re)building space");
515
516
  fflush(stdout);
#endif
517
518

  /* Re-grid if necessary, or just re-set the cell data. */
519
  space_regrid(s, verbose);
520

Pedro Gonnet's avatar
Pedro Gonnet committed
521
522
  size_t nr_parts = s->nr_parts;
  size_t nr_gparts = s->nr_gparts;
523
  size_t nr_sparts = s->nr_sparts;
524
  struct cell *restrict cells_top = s->cells_top;
525
  const integertime_t ti_old = (s->e != NULL) ? s->e->ti_old : 0;
526

Pedro Gonnet's avatar
Pedro Gonnet committed
527
528
529
  /* Run through the particles and get their cell index. Allocates
     an index that is larger than the number of particles to avoid
     re-allocating after shuffling. */
530
  const size_t ind_size = s->size_parts + 100;
531
532
  int *ind;
  if ((ind = (int *)malloc(sizeof(int) * ind_size)) == NULL)
533
    error("Failed to allocate temporary particle indices.");
534
  if (s->size_parts > 0) space_parts_get_cell_index(s, ind, cells_top, verbose);
535

536
  /* Run through the gravity particles and get their cell index. */
537
  const size_t gind_size = s->size_gparts + 100;
538
539
540
  int *gind;
  if ((gind = (int *)malloc(sizeof(int) * gind_size)) == NULL)
    error("Failed to allocate temporary g-particle indices.");
Pedro Gonnet's avatar
Pedro Gonnet committed
541
542
  if (s->size_gparts > 0)
    space_gparts_get_cell_index(s, gind, cells_top, verbose);
543

544
545
546
547
548
549
550
551
  /* Run through the star particles and get their cell index. */
  const size_t sind_size = s->size_sparts + 100;
  int *sind;
  if ((sind = (int *)malloc(sizeof(int) * sind_size)) == NULL)
    error("Failed to allocate temporary s-particle indices.");
  if (s->size_sparts > 0)
    space_sparts_get_cell_index(s, sind, cells_top, verbose);

552
#ifdef WITH_MPI
553
  const int local_nodeID = s->e->nodeID;
554

555
  /* Move non-local parts to the end of the list. */
556
  for (size_t k = 0; k < nr_parts;) {
557
    if (cells_top[ind[k]].nodeID != local_nodeID) {
558
      nr_parts -= 1;
559
      /* Swap the particle */
Matthieu Schaller's avatar
Bug fix    
Matthieu Schaller committed
560
      const struct part tp = s->parts[k];
561
562
      s->parts[k] = s->parts[nr_parts];
      s->parts[nr_parts] = tp;
563
      /* Swap the link with the gpart */
564
      if (s->parts[k].gpart != NULL) {
565
        s->parts[k].gpart->id_or_neg_offset = -k;
566
567
      }
      if (s->parts[nr_parts].gpart != NULL) {
568
        s->parts[nr_parts].gpart->id_or_neg_offset = -nr_parts;
569
      }
570
      /* Swap the xpart */
Matthieu Schaller's avatar
Bug fix    
Matthieu Schaller committed
571
      const struct xpart txp = s->xparts[k];
572
573
      s->xparts[k] = s->xparts[nr_parts];
      s->xparts[nr_parts] = txp;
574
      /* Swap the index */
Matthieu Schaller's avatar
Bug fix    
Matthieu Schaller committed
575
      const int t = ind[k];
576
577
      ind[k] = ind[nr_parts];
      ind[nr_parts] = t;
Matthieu Schaller's avatar
Matthieu Schaller committed
578
    } else {
579
580
581
582
      /* Increment when not exchanging otherwise we need to retest "k".*/
      k++;
    }
  }
583

584
#ifdef SWIFT_DEBUG_CHECKS
Peter W. Draper's avatar
Peter W. Draper committed
585
  /* Check that all parts are in the correct places. */
586
  for (size_t k = 0; k < nr_parts; k++) {
587
    if (cells_top[ind[k]].nodeID != local_nodeID) {
588
589
590
591
      error("Failed to move all non-local parts to send list");
    }
  }
  for (size_t k = nr_parts; k < s->nr_parts; k++) {
592
    if (cells_top[ind[k]].nodeID == local_nodeID) {
593
      error("Failed to remove local parts from send list");
594
    }
595
596
  }
#endif
597

598
599
600
601
602
603
604
605
606
607
608
609
  /* Move non-local sparts to the end of the list. */
  for (size_t k = 0; k < nr_sparts;) {
    if (cells_top[sind[k]].nodeID != local_nodeID) {
      nr_sparts -= 1;
      /* Swap the particle */
      const struct spart tp = s->sparts[k];
      s->sparts[k] = s->sparts[nr_sparts];
      s->sparts[nr_sparts] = tp;
      /* Swap the link with the gpart */
      if (s->sparts[k].gpart != NULL) {
        s->sparts[k].gpart->id_or_neg_offset = -k;
      }
610
611
      if (s->sparts[nr_sparts].gpart != NULL) {
        s->sparts[nr_sparts].gpart->id_or_neg_offset = -nr_sparts;
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
      }
      /* Swap the index */
      const int t = sind[k];
      sind[k] = sind[nr_sparts];
      sind[nr_sparts] = t;
    } else {
      /* Increment when not exchanging otherwise we need to retest "k".*/
      k++;
    }
  }

#ifdef SWIFT_DEBUG_CHECKS
  /* Check that all sparts are in the correct place (untested). */
  for (size_t k = 0; k < nr_sparts; k++) {
    if (cells_top[sind[k]].nodeID != local_nodeID) {
      error("Failed to move all non-local sparts to send list");
    }
  }
  for (size_t k = nr_sparts; k < s->nr_sparts; k++) {
    if (cells_top[sind[k]].nodeID == local_nodeID) {
      error("Failed to remove local sparts from send list");
    }
  }
#endif

637
  /* Move non-local gparts to the end of the list. */
638
  for (size_t k = 0; k < nr_gparts;) {
639
    if (cells_top[gind[k]].nodeID != local_nodeID) {
640
      nr_gparts -= 1;
641
      /* Swap the particle */
Matthieu Schaller's avatar
Bug fix    
Matthieu Schaller committed
642
      const struct gpart tp = s->gparts[k];
643
644
      s->gparts[k] = s->gparts[nr_gparts];
      s->gparts[nr_gparts] = tp;
645
646
      /* Swap the link with part/spart */
      if (s->gparts[k].type == swift_type_gas) {
647
        s->parts[-s->gparts[k].id_or_neg_offset].gpart = &s->gparts[k];
648
649
      } else if (s->gparts[k].type == swift_type_star) {
        s->sparts[-s->gparts[k].id_or_neg_offset].gpart = &s->gparts[k];
650
      }
651
      if (s->gparts[nr_gparts].type == swift_type_gas) {
652
653
        s->parts[-s->gparts[nr_gparts].id_or_neg_offset].gpart =
            &s->gparts[nr_gparts];
654
655
656
      } else if (s->gparts[nr_gparts].type == swift_type_star) {
        s->sparts[-s->gparts[nr_gparts].id_or_neg_offset].gpart =
            &s->gparts[nr_gparts];
657
      }
658
      /* Swap the index */
Matthieu Schaller's avatar
Bug fix    
Matthieu Schaller committed
659
660
661
      const int t = gind[k];
      gind[k] = gind[nr_gparts];
      gind[nr_gparts] = t;
Matthieu Schaller's avatar
Matthieu Schaller committed
662
    } else {
663
664
665
666
      /* Increment when not exchanging otherwise we need to retest "k".*/
      k++;
    }
  }
667

668
#ifdef SWIFT_DEBUG_CHECKS
669
670
  /* Check that all gparts are in the correct place (untested). */
  for (size_t k = 0; k < nr_gparts; k++) {
671
    if (cells_top[gind[k]].nodeID != local_nodeID) {
672
673
674
675
      error("Failed to move all non-local gparts to send list");
    }
  }
  for (size_t k = nr_gparts; k < s->nr_gparts; k++) {
676
    if (cells_top[gind[k]].nodeID == local_nodeID) {
677
      error("Failed to remove local gparts from send list");
678
    }
679
680
  }
#endif
681

682
683
  /* Exchange the strays, note that this potentially re-allocates
     the parts arrays. */
684
  size_t nr_parts_exchanged = s->nr_parts - nr_parts;
685
  size_t nr_gparts_exchanged = s->nr_gparts - nr_gparts;
686
  size_t nr_sparts_exchanged = s->nr_sparts - nr_sparts;
Pedro Gonnet's avatar
Pedro Gonnet committed
687
  engine_exchange_strays(s->e, nr_parts, &ind[nr_parts], &nr_parts_exchanged,
688
689
                         nr_gparts, &gind[nr_gparts], &nr_gparts_exchanged,
                         nr_sparts, &sind[nr_sparts], &nr_sparts_exchanged);
Pedro Gonnet's avatar
Pedro Gonnet committed
690
691

  /* Set the new particle counts. */
692
  s->nr_parts = nr_parts + nr_parts_exchanged;
693
  s->nr_gparts = nr_gparts + nr_gparts_exchanged;
694
  s->nr_sparts = nr_sparts + nr_sparts_exchanged;
695

696
  /* Re-allocate the index array for the parts if needed.. */
697
  if (s->nr_parts + 1 > ind_size) {
698
    int *ind_new;
699
    if ((ind_new = (int *)malloc(sizeof(int) * (s->nr_parts + 1))) == NULL)
700
      error("Failed to allocate temporary particle indices.");
701
    memcpy(ind_new, ind, sizeof(int) * nr_parts);
702
703
    free(ind);
    ind = ind_new;
704
705
  }

706
  /* Re-allocate the index array for the sparts if needed.. */
707
  if (s->nr_sparts + 1 > sind_size) {
708
709
    int *sind_new;
    if ((sind_new = (int *)malloc(sizeof(int) * (s->nr_sparts + 1))) == NULL)
710
      error("Failed to allocate temporary s-particle indices.");
711
712
713
714
715
    memcpy(sind_new, sind, sizeof(int) * nr_sparts);
    free(sind);
    sind = sind_new;
  }

716
717
718
  const int cdim[3] = {s->cdim[0], s->cdim[1], s->cdim[2]};
  const double ih[3] = {s->iwidth[0], s->iwidth[1], s->iwidth[2]};

719
  /* Assign each received part to its cell. */
Pedro Gonnet's avatar
Pedro Gonnet committed
720
  for (size_t k = nr_parts; k < s->nr_parts; k++) {
Matthieu Schaller's avatar
Matthieu Schaller committed
721
    const struct part *const p = &s->parts[k];
722
    ind[k] =
723
        cell_getid(cdim, p->x[0] * ih[0], p->x[1] * ih[1], p->x[2] * ih[2]);
724
#ifdef SWIFT_DEBUG_CHECKS
725
    if (cells_top[ind[k]].nodeID != local_nodeID)
726
      error("Received part that does not belong to me (nodeID=%i).",
727
            cells_top[ind[k]].nodeID);
728
#endif
729
  }
730
  nr_parts = s->nr_parts;
731

732
  /* Assign each received spart to its cell. */
733
734
735
736
737
738
  for (size_t k = nr_sparts; k < s->nr_sparts; k++) {
    const struct spart *const sp = &s->sparts[k];
    sind[k] =
        cell_getid(cdim, sp->x[0] * ih[0], sp->x[1] * ih[1], sp->x[2] * ih[2]);
#ifdef SWIFT_DEBUG_CHECKS
    if (cells_top[sind[k]].nodeID != local_nodeID)
739
      error("Received s-part that does not belong to me (nodeID=%i).",
740
741
742
743
744
            cells_top[sind[k]].nodeID);
#endif
  }
  nr_sparts = s->nr_sparts;

745
#endif /* WITH_MPI */
746
747

  /* Sort the parts according to their cells. */
748
749
  if (nr_parts > 0)
    space_parts_sort(s, ind, nr_parts, 0, s->nr_cells - 1, verbose);
750

751
752
753
#ifdef SWIFT_DEBUG_CHECKS
  /* Verify that the part have been sorted correctly. */
  for (size_t k = 0; k < nr_parts; k++) {
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
    const struct part *p = &s->parts[k];

    /* New cell index */
    const int new_ind =
        cell_getid(s->cdim, p->x[0] * s->iwidth[0], p->x[1] * s->iwidth[1],
                   p->x[2] * s->iwidth[2]);

    /* New cell of this part */
    const struct cell *c = &s->cells_top[new_ind];

    if (ind[k] != new_ind)
      error("part's new cell index not matching sorted index.");

    if (p->x[0] < c->loc[0] || p->x[0] > c->loc[0] + c->width[0] ||
        p->x[1] < c->loc[1] || p->x[1] > c->loc[1] + c->width[1] ||
        p->x[2] < c->loc[2] || p->x[2] > c->loc[2] + c->width[2])
770
771
772
773
      error("part not sorted into the right top-level cell!");
  }
#endif

774
775
776
777
  /* Sort the sparts according to their cells. */
  if (nr_sparts > 0)
    space_sparts_sort(s, sind, nr_sparts, 0, s->nr_cells - 1, verbose);

778
779
780
#ifdef SWIFT_DEBUG_CHECKS
  /* Verify that the spart have been sorted correctly. */
  for (size_t k = 0; k < nr_sparts; k++) {
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
    const struct spart *sp = &s->sparts[k];

    /* New cell index */
    const int new_sind =
        cell_getid(s->cdim, sp->x[0] * s->iwidth[0], sp->x[1] * s->iwidth[1],
                   sp->x[2] * s->iwidth[2]);

    /* New cell of this spart */
    const struct cell *c = &s->cells_top[new_sind];

    if (sind[k] != new_sind)
      error("spart's new cell index not matching sorted index.");

    if (sp->x[0] < c->loc[0] || sp->x[0] > c->loc[0] + c->width[0] ||
        sp->x[1] < c->loc[1] || sp->x[1] > c->loc[1] + c->width[1] ||
        sp->x[2] < c->loc[2] || sp->x[2] > c->loc[2] + c->width[2])
797
798
799
800
      error("spart not sorted into the right top-level cell!");
  }
#endif

801
802
803
804
805
  /* Re-link the gparts to their (s-)particles. */
  if (nr_parts > 0 && nr_gparts > 0)
    part_relink_gparts_to_parts(s->parts, nr_parts, 0);
  if (nr_sparts > 0 && nr_gparts > 0)
    part_relink_gparts_to_sparts(s->sparts, nr_sparts, 0);
806

807
808
809
810
811
812
813
814
815
816
  /* Extract the cell counts from the sorted indices. */
  size_t last_index = 0;
  ind[nr_parts] = s->nr_cells;  // sentinel.
  for (size_t k = 0; k < nr_parts; k++) {
    if (ind[k] < ind[k + 1]) {
      cells_top[ind[k]].count = k - last_index + 1;
      last_index = k + 1;
    }
  }

817
818
  /* Extract the cell counts from the sorted indices. */
  size_t last_sindex = 0;
819
  sind[nr_sparts] = s->nr_cells;  // sentinel.
820
821
822
823
824
825
826
  for (size_t k = 0; k < nr_sparts; k++) {
    if (sind[k] < sind[k + 1]) {
      cells_top[sind[k]].scount = k - last_sindex + 1;
      last_sindex = k + 1;
    }
  }

827
  /* We no longer need the indices as of here. */
828
  free(ind);
829
  free(sind);
830

831
832
#ifdef WITH_MPI

833
  /* Re-allocate the index array for the gparts if needed.. */
834
  if (s->nr_gparts + 1 > gind_size) {
835
    int *gind_new;
836
    if ((gind_new = (int *)malloc(sizeof(int) * (s->nr_gparts + 1))) == NULL)
837
      error("Failed to allocate temporary g-particle indices.");
838
    memcpy(gind_new, gind, sizeof(int) * nr_gparts);
839
840
841
842
    free(gind);
    gind = gind_new;
  }

843
  /* Assign each received gpart to its cell. */
844
  for (size_t k = nr_gparts; k < s->nr_gparts; k++) {
Matthieu Schaller's avatar
Matthieu Schaller committed
845
    const struct gpart *const p = &s->gparts[k];
846
847
    gind[k] =
        cell_getid(cdim, p->x[0] * ih[0], p->x[1] * ih[1], p->x[2] * ih[2]);
848
849

#ifdef SWIFT_DEBUG_CHECKS
850
    if (cells_top[gind[k]].nodeID != s->e->nodeID)
851
      error("Received g-part that does not belong to me (nodeID=%i).",
852
            cells_top[gind[k]].nodeID);
853
#endif
854
855
856
  }
  nr_gparts = s->nr_gparts;

857
#endif /* WITH_MPI */
858

859
  /* Sort the gparts according to their cells. */
860
861
  if (nr_gparts > 0)
    space_gparts_sort(s, gind, nr_gparts, 0, s->nr_cells - 1, verbose);
862

863
864
865
#ifdef SWIFT_DEBUG_CHECKS
  /* Verify that the gpart have been sorted correctly. */
  for (size_t k = 0; k < nr_gparts; k++) {
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
    const struct gpart *gp = &s->gparts[k];

    /* New cell index */
    const int new_gind =
        cell_getid(s->cdim, gp->x[0] * s->iwidth[0], gp->x[1] * s->iwidth[1],
                   gp->x[2] * s->iwidth[2]);

    /* New cell of this gpart */
    const struct cell *c = &s->cells_top[new_gind];

    if (gind[k] != new_gind)
      error("gpart's new cell index not matching sorted index.");

    if (gp->x[0] < c->loc[0] || gp->x[0] > c->loc[0] + c->width[0] ||
        gp->x[1] < c->loc[1] || gp->x[1] > c->loc[1] + c->width[1] ||
        gp->x[2] < c->loc[2] || gp->x[2] > c->loc[2] + c->width[2])
882
883
884
885
      error("gpart not sorted into the right top-level cell!");
  }
#endif

886
  /* Re-link the parts. */
887
  if (nr_parts > 0 && nr_gparts > 0)
888
889
890
891
892
    part_relink_parts_to_gparts(s->gparts, nr_gparts, s->parts);

  /* Re-link the sparts. */
  if (nr_sparts > 0 && nr_gparts > 0)
    part_relink_sparts_to_gparts(s->gparts, nr_gparts, s->sparts);
893

894
895
  /* Extract the cell counts from the sorted indices. */
  size_t last_gindex = 0;
896
  gind[nr_gparts] = s->nr_cells;
897
898
  for (size_t k = 0; k < nr_gparts; k++) {
    if (gind[k] < gind[k + 1]) {
899
      cells_top[gind[k]].gcount = k - last_gindex + 1;
900
901
902
903
      last_gindex = k + 1;
    }
  }

904
  /* We no longer need the indices as of here. */
905
  free(gind);
906

907
#ifdef SWIFT_DEBUG_CHECKS
908
  /* Verify that the links are correct */
909
  part_verify_links(s->parts, s->gparts, s->sparts, nr_parts, nr_gparts,
910
                    nr_sparts, verbose);
911
#endif
912

913
914
  /* Hook the cells up to the parts. */
  // tic = getticks();
915
916
917
  struct part *finger = s->parts;
  struct xpart *xfinger = s->xparts;
  struct gpart *gfinger = s->gparts;
918
  struct spart *sfinger = s->sparts;
919
  for (int k = 0; k < s->nr_cells; k++) {
920
    struct cell *restrict c = &cells_top[k];
921
    c->ti_old = ti_old;
922
923
924
    c->parts = finger;
    c->xparts = xfinger;
    c->gparts = gfinger;
925
    c->sparts = sfinger;
926
927
928
    finger = &finger[c->count];
    xfinger = &xfinger[c->count];
    gfinger = &gfinger[c->gcount];
929
    sfinger = &sfinger[c->scount];
930
  }
931
  // message( "hooking up cells took %.3f %s." ,
Matthieu Schaller's avatar
Matthieu Schaller committed
932
  // clocks_from_ticks(getticks() - tic), clocks_getunit());
933
934
935

  /* At this point, we have the upper-level cells, old or new. Now make
     sure that the parts in each cell are ok. */
936
  space_split(s, cells_top, s->nr_cells, verbose);
937

938
939
940
941
942
943
#ifdef SWIFT_DEBUG_CHECKS
  /* Check that the multipole construction went OK */
  for (int k = 0; k < s->nr_cells; k++)
    cell_check_multipole(&s->cells_top[k], NULL);
#endif

944
945
946
947
948
949
950
951
  if (verbose)
    message("took %.3f %s.", clocks_from_ticks(getticks() - tic),
            clocks_getunit());
}

/**
 * @brief Split particles between cells of a hierarchy
 *
952
953
 * This is done in parallel using threads in the #threadpool.
 *
954
 * @param s The #space.
955
956
 * @param cells The cell hierarchy.
 * @param nr_cells The number of cells.
957
958
 * @param verbose Are we talkative ?
 */
959
960
void space_split(struct space *s, struct cell *cells, int nr_cells,
                 int verbose) {
961

Matthieu Schaller's avatar
Matthieu Schaller committed
962
  const ticks tic = getticks();
963

964
  threadpool_map(&s->e->threadpool, space_split_mapper, cells, nr_cells,
965
                 sizeof(struct cell), 1, s);
966

967
968
969
  if (verbose)
    message("took %.3f %s.", clocks_from_ticks(getticks() - tic),
            clocks_getunit());
970
}
971

972
973
974
975
976
977
978
979
/**
 * @brief Runs through the top-level cells and checks whether tasks associated
 * with them can be split. If not, try to sanitize the cells.
 *
 * @param s The #space to act upon.
 */
void space_sanitize(struct space *s) {

980
981
  s->sanitized = 1;

Matthieu Schaller's avatar