core.hpp 134 KB
Newer Older
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
// Copyright (c) 2020 INRA Distributed under the Boost Software License,
// Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at
// http://www.boost.org/LICENSE_1_0.txt)

#ifndef ORG_VLEPROJECT_IRRITATOR_2020
#define ORG_VLEPROJECT_IRRITATOR_2020

#include <algorithm>
#include <limits>
#include <string_view>

#include <cassert>
#include <cmath>
#include <cstdint>
#include <cstring>
K-H-Ismail's avatar
K-H-Ismail committed
16

Gauthier Quesnel's avatar
Gauthier Quesnel committed
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
namespace irt {

using i8 = int8_t;
using i16 = int16_t;
using i32 = int32_t;
using i64 = int64_t;
using u8 = uint8_t;
using u16 = uint16_t;
using u32 = uint32_t;
using u64 = uint64_t;
using sz = size_t;

/*****************************************************************************
 *
 * Return status of many function
 *
 ****************************************************************************/

enum class status
{
    success,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
39
40
    unknown_dynamics,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
41
42
43
44
45
46
47
48
49
50
51
52
53
54
    block_allocator_bad_capacity,
    block_allocator_not_enough_memory,

    head_allocator_bad_capacity,
    head_allocator_not_enough_memory,

    simulation_not_enough_model,
    simulation_not_enough_memory_message_list_allocator,
    simulation_not_enough_memory_input_port_list_allocator,
    simulation_not_enough_memory_output_port_list_allocator,

    data_array_init_capacity_error,
    data_array_not_enough_memory,

55
56
57
    data_array_archive_init_capacity_error,
    data_array_archive_not_enough_memory,

58
59
60
61
    array_init_capacity_zero,
    array_init_capacity_too_big,
    array_init_not_enough_memory,

62
63
64
65
    vector_init_capacity_zero,
    vector_init_capacity_too_big,
    vector_init_not_enough_memory,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
66
67
68
69
    dynamics_unknown_id,
    dynamics_unknown_port_id,
    dynamics_not_enough_memory,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
70
71
72
73
    model_connect_output_port_unknown,
    model_connect_input_port_unknown,
    model_connect_already_exist,

74
75
76
77
78
79
80
81
    model_adder_empty_init_message,
    model_adder_bad_init_message,
    model_adder_bad_external_message,

    model_mult_empty_init_message,
    model_mult_bad_init_message,
    model_mult_bad_external_message,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
82
83
84
85
    model_integrator_internal_error,
    model_integrator_output_error,
    model_integrator_running_without_x_dot,
    model_integrator_ta_with_bad_x_dot,
86
87
    model_integrator_bad_external_message,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
88
89
90
91
    model_quantifier_bad_quantum_parameter,
    model_quantifier_bad_archive_length_parameter,
    model_quantifier_shifting_value_neg,
    model_quantifier_shifting_value_less_1,
92
    model_quantifier_bad_external_message,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
93

94
    model_cross_bad_external_message,
K-H-Ismail's avatar
K-H-Ismail committed
95
96

    model_time_func_bad_init_message,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
97

98
    gui_not_enough_memory,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
99
100
101
102
103
104
105
106

    io_file_format_error,
    io_file_format_model_error,
    io_file_format_model_number_error,
    io_file_format_model_unknown,
    io_file_format_dynamics_unknown,
    io_file_format_dynamics_limit_reach,
    io_file_format_dynamics_init_error
Gauthier Quesnel's avatar
Gauthier Quesnel committed
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
};

constexpr bool
is_success(status s) noexcept
{
    return s == status::success;
}

constexpr bool
is_bad(status s) noexcept
{
    return s != status::success;
}

template<typename... Args>
constexpr bool
is_status_equal(status s, Args... args) noexcept
{
    return ((s == args) || ... || false);
}

#ifndef NDEBUG
Gauthier Quesnel's avatar
Gauthier Quesnel committed
129
#if (defined(__i386__) || defined(__x86_64__)) && defined(__GNUC__) &&         \
130
  __GNUC__ >= 2
Gauthier Quesnel's avatar
Gauthier Quesnel committed
131
132
133
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm__ __volatile__("int $03");                                       \
134
135
    } while (0)
#elif (defined(_MSC_VER) || defined(__DMC__)) && defined(_M_IX86)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
136
137
138
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm int 3h                                                           \
139
140
    } while (0)
#elif defined(_MSC_VER)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
141
142
143
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __debugbreak();                                                        \
144
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
145
#elif defined(__alpha__) && !defined(__osf__) && defined(__GNUC__) &&          \
146
  __GNUC__ >= 2
Gauthier Quesnel's avatar
Gauthier Quesnel committed
147
148
149
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm__ __volatile__("bpt");                                           \
150
151
    } while (0)
#elif defined(__APPLE__)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
152
153
154
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __builtin_trap();                                                      \
155
156
    } while (0)
#else /* !__i386__ && !__alpha__ */
Gauthier Quesnel's avatar
Gauthier Quesnel committed
157
158
159
#define irt_breakpoint()                                                       \
    do {                                                                       \
        raise(SIGTRAP);                                                        \
160
161
    } while (0)
#endif /* __i386__ */
Gauthier Quesnel's avatar
Gauthier Quesnel committed
162
#else
Gauthier Quesnel's avatar
Gauthier Quesnel committed
163
164
#define irt_breakpoint()                                                       \
    do {                                                                       \
165
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
166
167
#endif

Gauthier Quesnel's avatar
Gauthier Quesnel committed
168
169
170
171
#define irt_bad_return(status__)                                               \
    do {                                                                       \
        irt_breakpoint();                                                      \
        return status__;                                                       \
172
173
    } while (0)

Gauthier Quesnel's avatar
Gauthier Quesnel committed
174
#define irt_return_if_bad(expr__)                                              \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
175
    do {                                                                       \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
176
        auto status__ = (expr__);                                              \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
177
178
179
180
        if (status__ != status::success) {                                     \
            irt_breakpoint();                                                  \
            return status__;                                                   \
        }                                                                      \
181
182
    } while (0)

Gauthier Quesnel's avatar
Gauthier Quesnel committed
183
184
185
186
187
188
#define irt_return_if_fail(expr__, status__)                                   \
    do {                                                                       \
        if (!(expr__)) {                                                       \
            irt_breakpoint();                                                  \
            return status__;                                                   \
        }                                                                      \
189
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226

inline status
check_return(status s) noexcept
{
    if (s != status::success)
        irt_breakpoint();

    return s;
}

/*****************************************************************************
 *
 * Definition of Time
 *
 * TODO:
 * - enable template definition of float or [float|double,bool absolute]
 *   representation of time?
 *
 ****************************************************************************/

using time = double;

template<typename T>
struct time_domain
{};

template<>
struct time_domain<time>
{
    using time_type = time;

    static constexpr const double infinity =
      std::numeric_limits<double>::infinity();
    static constexpr const double negative_infinity =
      -std::numeric_limits<double>::infinity();
    static constexpr const double zero = 0;

227
    static constexpr bool is_infinity(time t) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
228
229
230
231
    {
        return t == infinity || t == negative_infinity;
    }

232
    static constexpr bool is_zero(time t) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
    {
        return t == zero;
    }
};

/*****************************************************************************
 *
 * Small string
 *
 ****************************************************************************/

template<size_t length = 8>
class small_string
{
    char buffer_[length];
    u8 size_;

public:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
251
252
    using iterator = char*;
    using const_iterator = const char*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
    using size_type = u8;

    static_assert(length > size_t{ 1 } && length < size_t{ 254 });

    constexpr small_string() noexcept
    {
        clear();
    }

    constexpr small_string(const small_string& str) noexcept
    {
        std::copy_n(str.buffer_, str.size_, buffer_);
        buffer_[str.size_] = '\0';
        size_ = str.size_;
    }

    constexpr small_string(small_string&& str) noexcept
    {
        std::copy_n(str.buffer_, str.size_, buffer_);
        buffer_[str.size_] = '\0';
        size_ = str.size_;
        str.clear();
    }

    constexpr small_string& operator=(const small_string& str) noexcept
    {
        if (&str != this) {
            std::copy_n(str.buffer_, str.size_, buffer_);
            buffer_[str.size_] = '\0';
            size_ = str.size_;
        }

        return *this;
    }

    constexpr small_string& operator=(small_string&& str) noexcept
    {
        if (&str != this) {
            std::copy_n(str.buffer_, str.size_, buffer_);
            buffer_[str.size_] = '\0';
            size_ = str.size_;
        }

        return *this;
    }

    constexpr small_string(const char* str) noexcept
    {
        std::strncpy(buffer_, str, length - 1);
        buffer_[length - 1] = '\0';
        size_ = static_cast<u8>(std::strlen(buffer_));
    }

    constexpr small_string(const std::string_view str) noexcept
    {
        assign(str);
    }

    constexpr bool empty() const noexcept
    {
        constexpr unsigned char zero{ 0 };

        return zero == size_;
    }

Gauthier Quesnel's avatar
Gauthier Quesnel committed
318
319
    constexpr void size(std::size_t sz) noexcept
    {
320
321
        size_ = static_cast<u8>(std::min(sz, length - 1));
        buffer_[size_] = '\0';
Gauthier Quesnel's avatar
Gauthier Quesnel committed
322
323
    }

Gauthier Quesnel's avatar
Gauthier Quesnel committed
324
325
326
327
328
329
330
    constexpr std::size_t size() const noexcept
    {
        return size_;
    }

    constexpr std::size_t capacity() const noexcept
    {
331
        return length;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
332
333
334
335
    }

    constexpr void assign(const std::string_view str) noexcept
    {
336
        const size_t copy_length = std::min(str.size(), length - 1);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
337
338

        std::memcpy(buffer_, str.data(), copy_length);
339
340
341
        buffer_[copy_length] = '\0';

        size_ = static_cast<unsigned char>(copy_length);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
    }

    constexpr std::string_view sv() const noexcept
    {
        return { buffer_, size_ };
    }

    constexpr void append(const std::string_view str) noexcept
    {
        const size_t remaining = length - size_;

        if (remaining) {
            size_t copy = std::min(remaining - 1, str.size());
            std::strncpy(buffer_ + size_, str.data(), copy);
            copy += size_;
            size_ = static_cast<unsigned char>(copy);
            assert(size_ < length);

            buffer_[size_] = '\0';
        }
    }

    constexpr void clear() noexcept
    {
        std::fill_n(buffer_, length, '\0');
        size_ = 0;
    }

    constexpr const char* c_str() const noexcept
    {
        return buffer_;
    }

Gauthier Quesnel's avatar
Gauthier Quesnel committed
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
    constexpr iterator begin() noexcept
    {
        return buffer_;
    }

    constexpr iterator end() noexcept
    {
        return buffer_ + size_;
    }

    constexpr const_iterator begin() const noexcept
    {
        return buffer_;
    }

    constexpr const_iterator end() const noexcept
    {
        return buffer_ + size_;
    }

Gauthier Quesnel's avatar
Gauthier Quesnel committed
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
    constexpr bool operator==(const small_string& rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs.buffer_, length) == 0;
    }

    constexpr bool operator!=(const small_string& rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs.buffer_, length) != 0;
    }

    constexpr bool operator>(const small_string& rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs.buffer_, length) > 0;
    }

    constexpr bool operator<(const small_string& rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs.buffer_, length) < 0;
    }

    constexpr bool operator==(const char* rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs, length) == 0;
    }

    constexpr bool operator!=(const char* rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs, length) != 0;
    }

    constexpr bool operator>(const char* rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs, length) > 0;
    }

    constexpr bool operator<(const char* rhs) const noexcept
    {
        return std::strncmp(buffer_, rhs, length) < 0;
    }
};

/*****************************************************************************
 *
438
 * value
Gauthier Quesnel's avatar
Gauthier Quesnel committed
439
440
441
 *
 ****************************************************************************/

442
enum class value_type : i8
Gauthier Quesnel's avatar
Gauthier Quesnel committed
443
{
444
445
446
447
448
449
450
    none,
    integer_8,
    integer_32,
    integer_64,
    real_32,
    real_64
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
451

452
453
template<typename T, size_t length>
struct span
Gauthier Quesnel's avatar
Gauthier Quesnel committed
454
{
455
456
457
458
459
460
461
462
public:
    using value_type = T;
    using difference_type = std::ptrdiff_t;
    using pointer = T*;
    using reference = T&;
    using const_reference = T&;
    using iterator = T*;
    using const_iterator = const T*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
463

464
465
private:
    const T* data_;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
466

467
468
469
470
public:
    constexpr span(const T* ptr)
      : data_(ptr)
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
471

472
473
474
475
    constexpr T* data() noexcept
    {
        return data_;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
476

477
478
479
480
    constexpr const T* data() const noexcept
    {
        return data_;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
481

482
483
484
485
    constexpr size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
486

487
488
489
490
491
    constexpr T operator[](size_t i) const noexcept
    {
        assert(i < length);
        return data_[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
492

493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
    constexpr iterator begin() noexcept
    {
        return iterator{ data_ };
    }

    constexpr iterator end() noexcept
    {
        return iterator{ data_ + length };
    }

    constexpr const_iterator begin() const noexcept
    {
        return iterator{ data_ };
    }

    constexpr const_iterator end() const noexcept
    {
        return iterator{ data_ + length };
    }
};

template<class T, class... Rest>
constexpr bool
are_all_same() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
517
{
518
    return (std::is_same_v<T, Rest> && ...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
519
520
}

521
struct message
Gauthier Quesnel's avatar
Gauthier Quesnel committed
522
{
523
524
    using size_type = std::size_t;
    using difference_type = std::ptrdiff_t;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
525

526
    union
Gauthier Quesnel's avatar
Gauthier Quesnel committed
527
    {
528
529
530
531
532
        i8 integer_8[32];  // 32 bytes
        i32 integer_32[8]; // 8 * 4 bytes
        i64 integer_64[4]; // 4 * 8 bytes
        float real_32[8];  // 8 * 4 bytes
        double real_64[4]; // 4 * 8 bytes
Gauthier Quesnel's avatar
Gauthier Quesnel committed
533
534
    };

535
536
    u8 length;
    value_type type;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
537

538
539
540
541
    constexpr std::size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
542

543
544
545
546
547
    constexpr message() noexcept
      : integer_8{ 0 }
      , length{ 0 }
      , type{ value_type::none }
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
548

549
550
    template<typename... T>
    constexpr message(T... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
551
    {
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
        if constexpr (are_all_same<i8, T...>()) {
            static_assert(sizeof...(args) <= 32, "i8 message limited to 32");
            using unused = i8[];
            length = 0;
            (void)unused{ i8(0), (integer_8[length++] = args, i8(0))... };
            type = value_type::integer_8;
        } else if constexpr (are_all_same<i32, T...>()) {
            static_assert(sizeof...(args) <= 8, "i32 message limited to 32");
            using unused = i32[];
            length = 0;
            (void)unused{ i32(0), (integer_32[length++] = args, i32(0))... };
            type = value_type::integer_32;
        } else if constexpr (are_all_same<i64, T...>()) {
            static_assert(sizeof...(args) <= 4, "i64 message limited to 32");
            using unused = i64[];
            length = 0;
            (void)unused{ i64(0), (integer_64[length++] = args, i64(0))... };
            type = value_type::integer_64;
        } else if constexpr (are_all_same<float, T...>()) {
            static_assert(sizeof...(args) <= 8, "float message limited to 8");
            using unused = float[];
            length = 0;
            (void)unused{ 0.0f, (real_32[length++] = args, 0.0f)... };
            type = value_type::real_32;
            return;
        } else if constexpr (are_all_same<double, T...>()) {
            static_assert(sizeof...(args) <= 4, "double message limited to 4");
            using unused = double[];
            length = 0;
            (void)unused{ 0.0, (real_64[length++] = args, 0.0)... };
            type = value_type::real_64;
        }
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
585

586
587
588
589
    constexpr span<i8, 32> to_integer_8() const
    {
        assert(type == value_type::integer_8);
        return span<i8, 32>(integer_8);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
590
591
    }

592
    constexpr span<i32, 8> to_integer_32() const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
593
    {
594
595
596
        assert(type == value_type::integer_32);
        return span<i32, 8>(integer_32);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
597

598
599
600
601
602
    constexpr span<i64, 4> to_integer_64() const
    {
        assert(type == value_type::integer_64);
        return span<i64, 4>(integer_64);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
603

604
605
606
607
608
    constexpr span<float, 8> to_real_32() const
    {
        assert(type == value_type::real_32);
        return span<float, 8>(real_32);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
609

610
611
612
613
    constexpr span<double, 4> to_real_64() const
    {
        assert(type == value_type::real_64);
        return span<double, 4>(real_64);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
614
615
    }

616
617
    template<typename T>
    constexpr i8 to_integer_8(T i) const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
618
    {
619
        static_assert(std::is_integral_v<T>, "need [unsigned] integer");
Gauthier Quesnel's avatar
Gauthier Quesnel committed
620

621
622
623
624
625
626
627
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);

        assert(type == value_type::integer_8);
        assert(i < static_cast<T>(length));

        return integer_8[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
628
629
    }

630
631
    template<typename T>
    constexpr i32 to_integer_32(T i) const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
632
    {
633
        static_assert(std::is_integral_v<T>, "need [unsigned] integer");
Gauthier Quesnel's avatar
Gauthier Quesnel committed
634

635
636
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
637

638
639
        assert(type == value_type::integer_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
640

641
642
        return integer_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
643

644
645
646
647
    template<typename T>
    constexpr i64 to_integer_64(T i) const
    {
        static_assert(std::is_integral_v<T>, "need [unsigned] integer");
Gauthier Quesnel's avatar
Gauthier Quesnel committed
648

649
650
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
651

652
653
654
655
        assert(type == value_type::integer_64);
        assert(i < static_cast<T>(length));

        return integer_64[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
656
657
    }

658
659
    template<typename T>
    constexpr float to_real_32(T i) const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
660
    {
661
        static_assert(std::is_integral_v<T>, "need [unsigned] integer");
Gauthier Quesnel's avatar
Gauthier Quesnel committed
662

663
664
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
665

666
667
        assert(type == value_type::real_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
668

669
670
        return real_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
671

672
673
674
675
    template<typename T>
    constexpr double to_real_64(T i) const
    {
        static_assert(std::is_integral_v<T>, "need [unsigned] integer");
Gauthier Quesnel's avatar
Gauthier Quesnel committed
676

677
678
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
679

680
681
682
683
        assert(type == value_type::real_64);
        assert(i < static_cast<T>(length));

        return real_64[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
684
    }
685
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
686

687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
/*****************************************************************************
 *
 * Flat list
 *
 ****************************************************************************/

template<typename T>
class block_allocator
{
public:
    static_assert(std::is_trivially_destructible_v<T>,
                  "block_allocator is only for POD object");

    using value_type = T;

    union block
Gauthier Quesnel's avatar
Gauthier Quesnel committed
703
    {
704
705
706
        block* next;
        typename std::aligned_storage<sizeof(T), alignof(T)>::type storage;
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
707

708
private:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
709
    block* blocks{ nullptr };    // contains all preallocated blocks
710
711
712
713
    block* free_head{ nullptr }; // a free list
    sz size{ 0 };                // number of active elements allocated
    sz max_size{ 0 }; // number of elements allocated (with free_head)
    sz capacity{ 0 }; // capacity of the allocator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
714

715
716
public:
    block_allocator() = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
717

718
719
    block_allocator(const block_allocator&) = delete;
    block_allocator& operator=(const block_allocator&) = delete;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
720

721
722
723
724
    ~block_allocator() noexcept
    {
        if (blocks)
            std::free(blocks);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
725
726
    }

727
    status init(std::size_t new_capacity) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
728
    {
729
730
        if (new_capacity == 0)
            return status::block_allocator_bad_capacity;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
731

732
733
734
735
736
737
738
739
        if (new_capacity != capacity) {
            if (blocks)
                std::free(blocks);
            blocks =
              static_cast<block*>(std::malloc(new_capacity * sizeof(block)));
            if (blocks == nullptr)
                return status::block_allocator_not_enough_memory;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
740

741
742
743
744
        size = 0;
        max_size = 0;
        capacity = new_capacity;
        free_head = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
745

746
        return status::success;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
747
748
    }

749
    void reset() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
750
    {
751
752
753
754
755
        if (capacity > 0) {
            size = 0;
            max_size = 0;
            free_head = nullptr;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
756
757
    }

758
    std::pair<bool, T*> try_alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
759
    {
760
761
        if (free_head == nullptr && max_size >= capacity)
            return { false, nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
762

763
        return { true, alloc() };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
764
765
    }

766
    T* alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
767
    {
768
769
770
771
772
773
774
775
776
        ++size;
        block* new_block = nullptr;

        if (free_head != nullptr) {
            new_block = free_head;
            free_head = free_head->next;
        } else {
            assert(max_size < capacity);
            new_block = reinterpret_cast<block*>(&blocks[max_size++]);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
777
778
        }

779
        return reinterpret_cast<T*>(new_block);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
780
781
    }

782
    void free(T* n) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
783
    {
784
        assert(n);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
785

786
        block* ptr = reinterpret_cast<block*>(n);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
787

788
789
        ptr->next = free_head;
        free_head = ptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
790

791
        --size;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
792

793
794
795
796
        if (size == 0) {         // A special part: if it no longer exists
            max_size = 0;        // we reset the free list and the number
            free_head = nullptr; // of elements allocated.
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
797
    }
798
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
799

800
801
802
803
804
template<typename T>
class flat_list
{
public:
    struct node_type
Gauthier Quesnel's avatar
Gauthier Quesnel committed
805
    {
806
807
808
        T value;
        node_type* next = nullptr;
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
809

810
811
812
813
public:
    using allocator_type = block_allocator<node_type>;
    using value_type = T;
    using reference = T&;
814
    using const_reference = const T&;
815
    using pointer = T*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
816

817
    class iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
818
    {
819
820
    private:
        node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
821

822
823
824
825
826
827
    public:
        using iterator_category = std::forward_iterator_tag;
        using value_type = T;
        using pointer = T*;
        using reference = T&;
        using difference_type = std::ptrdiff_t;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
828

829
        iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
830

831
832
833
        iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
834

835
836
837
        iterator(const iterator& other) noexcept
          : node(other.node)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
838

839
840
841
842
843
        iterator& operator=(const iterator& other) noexcept
        {
            node = other.node;
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
844

845
846
847
848
        T& operator*() noexcept
        {
            return node->value;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
849

850
851
852
853
        T* operator->() noexcept
        {
            return &node->value;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
854

855
856
857
858
        iterator operator++() noexcept
        {
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
859

860
861
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
862

863
864
865
        iterator operator++(int) noexcept
        {
            iterator tmp(*this);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
866

867
868
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
869

870
871
            return tmp;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
872

873
874
875
876
        bool operator==(const iterator& other) const noexcept
        {
            return node == other.node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
877

878
879
880
881
        bool operator!=(const iterator& other) const noexcept
        {
            return node != other.node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
882

883
884
885
886
        void swap(iterator& other) noexcept
        {
            std::swap(node, other.node);
        }
887

Gauthier Quesnel's avatar
Gauthier Quesnel committed
888
        friend class flat_list<T>;
889
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
890

891
    class const_iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
892
    {
893
894
    private:
        const node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
895

896
897
898
899
900
901
    public:
        using iterator_category = std::forward_iterator_tag;
        using value_type = T;
        using pointer = T*;
        using reference = T&;
        using difference_type = std::ptrdiff_t;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
902

903
        const_iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
904

905
906
907
        const_iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
908

909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
        const_iterator(const const_iterator& other) noexcept
          : node(other.node)
        {}

        const_iterator& operator=(const const_iterator& other) noexcept
        {
            node = other.node;
            return *this;
        }

        const T& operator*() noexcept
        {
            return node->value;
        }

        const T* operator->() noexcept
        {
            return &node->value;
        }

        const_iterator operator++() noexcept
        {
            if (node != nullptr)
                node = node->next;

            return *this;
        }

        const_iterator operator++(int) noexcept
        {
            const_iterator tmp(*this);

            if (node != nullptr)
                node = node->next;

            return tmp;
        }

        bool operator==(const const_iterator& other) const noexcept
        {
            return node == other.node;
        }

        bool operator!=(const const_iterator& other) const noexcept
        {
            return node != other.node;
        }

        void swap(const_iterator& other) noexcept
        {
            std::swap(node, other.node);
        }
961

Gauthier Quesnel's avatar
Gauthier Quesnel committed
962
        friend class flat_list<T>;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
963
964
    };

965
966
967
private:
    allocator_type* allocator{ nullptr };
    node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
968

969
970
public:
    flat_list() = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
971

972
973
    flat_list(allocator_type* allocator_new) noexcept
      : allocator(allocator_new)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
974
975
    {}

976
977
978
979
980
981
    flat_list(const flat_list& other) = delete;
    flat_list& operator=(const flat_list& other) = delete;

    flat_list(flat_list&& other) noexcept
      : allocator(other.allocator)
      , node(other.node)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
982
    {
983
984
        other.allocator = nullptr;
        other.node = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
985
986
    }

987
    void set_allocator(allocator_type* allocator_new) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
988
    {
989
990
991
        clear();
        allocator = allocator_new;
        node = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
992
993
    }

994
    flat_list& operator=(flat_list&& other) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
995
    {
996
997
998
999
1000
1001
1002
1003
1004
        if (this != &other) {
            clear();
            allocator = other.allocator;
            other.allocator = nullptr;
            node = other.node;
            other.node = nullptr;
        }

        return *this;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1005
1006
    }

1007
    ~flat_list() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1008
    {
1009
        clear();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1010
1011
    }

1012
    void clear() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1013
    {
1014
1015
1016
1017
1018
1019
1020
        node_type* prev = node;

        while (node != nullptr) {
            node = node->next;
            allocator->free(prev);
            prev = node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1021
1022
    }

1023
    bool empty() const noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1024
    {
1025
        return node == nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1026
1027
    }

1028
    iterator begin() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1029
    {
1030
1031
        return iterator(node);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1032

1033
1034
1035
1036
    iterator end() noexcept
    {
        return iterator(nullptr);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1037

1038
1039
1040
1041
    const_iterator begin() const noexcept
    {
        return const_iterator(node);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1042

1043
1044
1045
    const_iterator end() const noexcept
    {
        return const_iterator(nullptr);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1046
1047
    }

1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
    reference front() noexcept
    {
        assert(!empty());

        return node->value;
    }

    const_reference front() const noexcept
    {
        assert(!empty());

        return node->value;
    }

1062
1063
    template<typename... Args>
    iterator emplace_front(Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1064
    {
1065
        node_type* new_node = allocator->alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1066

1067
        new (&new_node->value) T(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1068

1069
1070
        new_node->next = node;
        node = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1071

1072
        return begin();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1073
1074
    }

1075
1076
    template<typename... Args>
    iterator emplace_after(iterator it, Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1077
    {
1078
1079
        node_type* new_node = allocator->alloc();
        new (&new_node->value) T(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1080

1081
1082
        if (it->node == nullptr)
            return emplace_front(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1083

1084
1085
        new_node->next = it->node->next;
        it->node->next = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1086

1087
        return iterator(new_node);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1088
1089
    }

1090
1091
    template<typename... Args>
    iterator try_emplace_front(Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1092
    {
1093
        auto [success, new_node] = allocator->try_alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1094

1095
1096
        if (!success)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1097

1098
        new (&new_node->value) T(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1099

1100
1101
1102
1103
        new_node->next = node;
        node = new_node;

        return begin();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1104
1105
    }

1106
1107
    template<typename... Args>
    iterator try_emplace_after(iterator it, Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1108
    {
1109
        auto [success, new_node] = allocator->try_alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1110

1111
1112
        if (!success)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1113

1114
        new (&new_node->value) T(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1115

1116
1117
        if (it->node == nullptr)
            return emplace_front(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1118

1119
1120
        new_node->next = it->node->next;
        it->node->next = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1121

1122
        return iterator(new_node);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1123
1124
    }

1125
    void pop_front() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1126
    {
1127
1128
        if (node == nullptr)
            return;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1129

1130
1131
        node_type* to_delete = node;
        node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1132

1133
        if constexpr (!std::is_trivial_v<T>)
1134
            to_delete->value.~T();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1135

1136
        allocator->free(to_delete);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1137
1138
    }

1139
    iterator erase_after(iterator it) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1140
    {
1141
        assert(allocator);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1142

1143
1144
        if (it.node == nullptr)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1145

1146
1147
1148
        node_type* to_delete = it.node->next;
        if (to_delete == nullptr)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1149

1150
1151
        node_type* next = to_delete->next;
        it.node->next = next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1152

1153
        if constexpr (!std::is_trivial_v<T>)
1154
            to_delete->value.~T();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1155

1156
        allocator->free(to_delete);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1157

1158
        return iterator(next);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1159
1160
1161
1162
    }
};

template<typename T>
1163
class flat_double_list
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1164
{
1165
private:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1166
1167
1168
1169
    struct node_type
    {
        T value;
        node_type* next = nullptr;
1170
        node_type* prev = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
    };

public:
    using allocator_type = block_allocator<node_type>;
    using value_type = T;
    using reference = T&;
    using pointer = T*;

    class iterator
    {
    private:
1182
        flat_double_list* list{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1183
1184
1185
        node_type* node{ nullptr };

    public:
1186
        using iterator_category = std::bidirectional_iterator_tag;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1187
1188
1189
1190
1191
1192
        using value_type = T;
        using pointer = T*;
        using reference = T&;

        iterator() noexcept = default;

1193
1194
1195
        iterator(flat_double_list* lst, node_type* n) noexcept
          : list(lst)
          , node(n)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1196
1197
1198
        {}

        iterator(const iterator& other) noexcept
1199
1200
          : list(other.list)
          , node(other.node)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1201
1202
1203
1204
        {}

        iterator& operator=(const iterator& other) noexcept
        {
1205
            list = other.list;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1206
1207
1208
1209
1210
1211
1212
1213
1214
            node = other.node;
            return *this;
        }

        T& operator*() noexcept
        {
            return node->value;
        }

1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
        T* operator*() const noexcept
        {
            return node->value;
        }

        pointer operator->() noexcept
        {
            return &(node->value);
        }

        pointer operator->() const noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1226
1227
1228
1229
1230
1231
        {
            return &node->value;
        }

        iterator operator++() noexcept
        {
1232
            node = (node == nullptr) ? list->m_front : node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1233
1234
1235
1236
1237
1238
1239
1240

            return *this;
        }

        iterator operator++(int) noexcept
        {
            iterator tmp(*this);

1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
            node = (node == nullptr) ? list->m_front : node->next;

            return tmp;
        }

        iterator operator--() noexcept
        {
            node = (node == nullptr) ? list->m_back : node->prev;

            return *this;
        }

        iterator operator--(int) noexcept
        {
            iterator tmp(*this);

            node = (node == nullptr) ? list->m_back : node->prev;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273

            return tmp;
        }

        bool operator==(const iterator& other) const noexcept
        {
            return node == other.node;
        }

        bool operator!=(const iterator& other) const noexcept
        {
            return node != other.node;
        }

        void swap(iterator& other) noexcept
        {
1274
            std::swap(list, other.list);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1275
1276
1277
1278
1279
1280
1281
            std::swap(node, other.node);
        }
    };

    class const_iterator
    {
    private: