core.hpp 150 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
    model_connect_output_port_unknown,
    model_connect_input_port_unknown,
    model_connect_already_exist,
73
    model_connect_bad_dynamics,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
74

75
76
77
78
79
80
81
82
    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
83
84
85
    model_integrator_dq_error,
    model_integrator_X_error,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
86
87
88
89
    model_integrator_internal_error,
    model_integrator_output_error,
    model_integrator_running_without_x_dot,
    model_integrator_ta_with_bad_x_dot,
90
91
    model_integrator_bad_external_message,

Gauthier Quesnel's avatar
Gauthier Quesnel committed
92
93
94
95
    model_quantifier_bad_quantum_parameter,
    model_quantifier_bad_archive_length_parameter,
    model_quantifier_shifting_value_neg,
    model_quantifier_shifting_value_less_1,
96
    model_quantifier_bad_external_message,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
97

98
    model_cross_bad_external_message,
K-H-Ismail's avatar
K-H-Ismail committed
99
100

    model_time_func_bad_init_message,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
101

K-H-Ismail's avatar
K-H-Ismail committed
102
103
    model_accumulator_bad_external_message,

104
    gui_not_enough_memory,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
105
106
107
108
109
110
111
112

    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
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
};

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);
}

134
135
template<typename T, typename... Args>
constexpr bool
136
match(const T& s, Args... args) noexcept
137
138
139
140
{
    return ((s == args) || ... || false);
}

Gauthier Quesnel's avatar
Gauthier Quesnel committed
141
#ifndef NDEBUG
Gauthier Quesnel's avatar
Gauthier Quesnel committed
142
#if (defined(__i386__) || defined(__x86_64__)) && defined(__GNUC__) &&         \
143
  __GNUC__ >= 2
Gauthier Quesnel's avatar
Gauthier Quesnel committed
144
145
146
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm__ __volatile__("int $03");                                       \
147
148
    } while (0)
#elif (defined(_MSC_VER) || defined(__DMC__)) && defined(_M_IX86)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
149
150
151
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm int 3h                                                           \
152
153
    } while (0)
#elif defined(_MSC_VER)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
154
155
156
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __debugbreak();                                                        \
157
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
158
#elif defined(__alpha__) && !defined(__osf__) && defined(__GNUC__) &&          \
159
  __GNUC__ >= 2
Gauthier Quesnel's avatar
Gauthier Quesnel committed
160
161
162
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __asm__ __volatile__("bpt");                                           \
163
164
    } while (0)
#elif defined(__APPLE__)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
165
166
167
#define irt_breakpoint()                                                       \
    do {                                                                       \
        __builtin_trap();                                                      \
168
169
    } while (0)
#else /* !__i386__ && !__alpha__ */
Gauthier Quesnel's avatar
Gauthier Quesnel committed
170
171
172
#define irt_breakpoint()                                                       \
    do {                                                                       \
        raise(SIGTRAP);                                                        \
173
174
    } while (0)
#endif /* __i386__ */
Gauthier Quesnel's avatar
Gauthier Quesnel committed
175
#else
Gauthier Quesnel's avatar
Gauthier Quesnel committed
176
177
#define irt_breakpoint()                                                       \
    do {                                                                       \
178
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
179
180
#endif

Gauthier Quesnel's avatar
Gauthier Quesnel committed
181
182
183
184
#define irt_bad_return(status__)                                               \
    do {                                                                       \
        irt_breakpoint();                                                      \
        return status__;                                                       \
185
186
    } while (0)

Gauthier Quesnel's avatar
Gauthier Quesnel committed
187
#define irt_return_if_bad(expr__)                                              \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
188
    do {                                                                       \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
189
        auto status__ = (expr__);                                              \
Gauthier Quesnel's avatar
Gauthier Quesnel committed
190
191
192
193
        if (status__ != status::success) {                                     \
            irt_breakpoint();                                                  \
            return status__;                                                   \
        }                                                                      \
194
195
    } while (0)

Gauthier Quesnel's avatar
Gauthier Quesnel committed
196
197
198
199
200
201
#define irt_return_if_fail(expr__, status__)                                   \
    do {                                                                       \
        if (!(expr__)) {                                                       \
            irt_breakpoint();                                                  \
            return status__;                                                   \
        }                                                                      \
202
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239

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;

240
    static constexpr bool is_infinity(time t) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
241
242
243
244
    {
        return t == infinity || t == negative_infinity;
    }

245
    static constexpr bool is_zero(time t) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
    {
        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
264
265
    using iterator = char*;
    using const_iterator = const char*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
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
318
319
320
321
322
323
324
325
326
327
328
329
330
    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
331
332
    constexpr void size(std::size_t sz) noexcept
    {
333
334
        size_ = static_cast<u8>(std::min(sz, length - 1));
        buffer_[size_] = '\0';
Gauthier Quesnel's avatar
Gauthier Quesnel committed
335
336
    }

Gauthier Quesnel's avatar
Gauthier Quesnel committed
337
338
339
340
341
342
343
    constexpr std::size_t size() const noexcept
    {
        return size_;
    }

    constexpr std::size_t capacity() const noexcept
    {
344
        return length;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
345
346
347
348
    }

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

        std::memcpy(buffer_, str.data(), copy_length);
352
353
354
        buffer_[copy_length] = '\0';

        size_ = static_cast<unsigned char>(copy_length);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
    }

    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
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
    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
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
438
439
440
441
442
443
444
445
446
447
448
449
450
    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;
    }
};

/*****************************************************************************
 *
451
 * value
Gauthier Quesnel's avatar
Gauthier Quesnel committed
452
453
454
 *
 ****************************************************************************/

455
enum class value_type : i8
Gauthier Quesnel's avatar
Gauthier Quesnel committed
456
{
457
458
459
460
461
462
463
    none,
    integer_8,
    integer_32,
    integer_64,
    real_32,
    real_64
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
464

465
466
template<typename T, size_t length>
struct span
Gauthier Quesnel's avatar
Gauthier Quesnel committed
467
{
468
469
470
471
472
473
474
475
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
476

477
478
private:
    const T* data_;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
479

480
481
482
483
public:
    constexpr span(const T* ptr)
      : data_(ptr)
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
484

485
486
487
488
    constexpr T* data() noexcept
    {
        return data_;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
489

490
491
492
493
    constexpr const T* data() const noexcept
    {
        return data_;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
494

495
496
497
498
    constexpr size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
499

500
501
502
503
504
    constexpr T operator[](size_t i) const noexcept
    {
        assert(i < length);
        return data_[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
505

506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
    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
530
{
531
    return (std::is_same_v<T, Rest> && ...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
532
533
}

534
struct message
Gauthier Quesnel's avatar
Gauthier Quesnel committed
535
{
536
537
    using size_type = std::size_t;
    using difference_type = std::ptrdiff_t;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
538

539
    union
Gauthier Quesnel's avatar
Gauthier Quesnel committed
540
    {
541
542
543
544
545
        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
546
547
    };

548
549
    u8 length;
    value_type type;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
550

551
552
553
554
    constexpr std::size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
555

556
557
558
559
560
    constexpr message() noexcept
      : integer_8{ 0 }
      , length{ 0 }
      , type{ value_type::none }
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
561

562
563
    template<typename... T>
    constexpr message(T... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
564
    {
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
        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
598

599
600
601
602
    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
603
604
    }

605
    constexpr span<i32, 8> to_integer_32() const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
606
    {
607
608
609
        assert(type == value_type::integer_32);
        return span<i32, 8>(integer_32);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
610

611
612
613
614
615
    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
616

617
618
619
620
621
    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
622

623
624
625
626
    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
627
628
    }

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

634
635
636
637
638
639
640
        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
641
642
    }

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

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

651
652
        assert(type == value_type::integer_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
653

654
655
        return integer_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
656

657
658
659
660
    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
661

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

665
666
667
668
        assert(type == value_type::integer_64);
        assert(i < static_cast<T>(length));

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

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

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

679
680
        assert(type == value_type::real_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
681

682
683
        return real_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
684

685
686
687
688
    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
689

690
691
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
692

693
694
695
696
        assert(type == value_type::real_64);
        assert(i < static_cast<T>(length));

        return real_64[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
697
    }
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715

    template<typename T>
    constexpr double cast_to_real_64(T i) const
    {
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);

        switch (type) {
        case value_type::integer_8:
            return static_cast<double>(to_integer_8(i));
        case value_type::integer_32:
            return static_cast<double>(to_integer_32(i));
        case value_type::integer_64:
            return static_cast<double>(to_integer_64(i));
        case value_type::real_32:
            return static_cast<double>(to_real_32(i));
        case value_type::real_64:
            return static_cast<double>(to_real_64(i));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
716
717
        default:
            return 0.0;
718
719
720
721
        }

        return 0.0;
    }
722
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
723

724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
/*****************************************************************************
 *
 * 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
740
    {
741
742
743
        block* next;
        typename std::aligned_storage<sizeof(T), alignof(T)>::type storage;
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
744

745
private:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
746
    block* blocks{ nullptr };    // contains all preallocated blocks
747
748
749
750
    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
751

752
753
public:
    block_allocator() = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
754

755
756
    block_allocator(const block_allocator&) = delete;
    block_allocator& operator=(const block_allocator&) = delete;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
757

758
759
760
761
    ~block_allocator() noexcept
    {
        if (blocks)
            std::free(blocks);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
762
763
    }

764
    status init(std::size_t new_capacity) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
765
    {
766
767
        if (new_capacity == 0)
            return status::block_allocator_bad_capacity;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
768

769
770
771
772
773
774
775
776
        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
777

778
779
780
781
        size = 0;
        max_size = 0;
        capacity = new_capacity;
        free_head = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
782

783
        return status::success;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
784
785
    }

786
    void reset() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
787
    {
788
789
790
791
792
        if (capacity > 0) {
            size = 0;
            max_size = 0;
            free_head = nullptr;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
793
794
    }

795
    std::pair<bool, T*> try_alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
796
    {
797
798
        if (free_head == nullptr && max_size >= capacity)
            return { false, nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
799

800
        return { true, alloc() };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
801
802
    }

803
    T* alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
804
    {
805
806
807
808
809
810
811
812
813
        ++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
814
815
        }

816
        return reinterpret_cast<T*>(new_block);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
817
818
    }

819
    void free(T* n) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
820
    {
821
        assert(n);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
822

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

825
826
        ptr->next = free_head;
        free_head = ptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
827

828
        --size;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
829

830
831
832
833
        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
834
    }
835
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
836

837
838
839
840
841
template<typename T>
class flat_list
{
public:
    struct node_type
Gauthier Quesnel's avatar
Gauthier Quesnel committed
842
    {
843
844
845
        T value;
        node_type* next = nullptr;
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
846

847
848
849
850
public:
    using allocator_type = block_allocator<node_type>;
    using value_type = T;
    using reference = T&;
851
    using const_reference = const T&;
852
    using pointer = T*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
853

854
    class iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
855
    {
856
857
    private:
        node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
858

859
860
861
862
863
864
    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
865

866
        iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
867

868
869
870
        iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
871

872
873
874
        iterator(const iterator& other) noexcept
          : node(other.node)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
875

876
877
878
879
880
        iterator& operator=(const iterator& other) noexcept
        {
            node = other.node;
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
881

882
883
884
885
        T& operator*() noexcept
        {
            return node->value;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
886

887
888
889
890
        T* operator->() noexcept
        {
            return &node->value;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
891

892
893
894
895
        iterator operator++() noexcept
        {
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
896

897
898
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
899

900
901
902
        iterator operator++(int) noexcept
        {
            iterator tmp(*this);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
903

904
905
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
906

907
908
            return tmp;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
909

910
911
912
913
        bool operator==(const iterator& other) const noexcept
        {
            return node == other.node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
914

915
916
917
918
        bool operator!=(const iterator& other) const noexcept
        {
            return node != other.node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
919

920
921
922
923
        void swap(iterator& other) noexcept
        {
            std::swap(node, other.node);
        }
924

Gauthier Quesnel's avatar
Gauthier Quesnel committed
925
        friend class flat_list<T>;
926
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
927

928
    class const_iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
929
    {
930
931
    private:
        const node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
932

933
934
935
936
937
938
    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
939

940
        const_iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
941

942
943
944
        const_iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
945

946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
        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);
        }
998

Gauthier Quesnel's avatar
Gauthier Quesnel committed
999
        friend class flat_list<T>;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1000
1001
    };

1002
1003
1004
private:
    allocator_type* allocator{ nullptr };
    node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1005

1006
1007
public:
    flat_list() = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1008

1009
1010
    flat_list(allocator_type* allocator_new) noexcept
      : allocator(allocator_new)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1011
1012
    {}

1013
1014
1015
1016
1017
1018
    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
1019
    {
1020
1021
        other.allocator = nullptr;
        other.node = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1022
1023
    }

1024
    void set_allocator(allocator_type* allocator_new) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1025
    {
1026
1027
1028
        clear();
        allocator = allocator_new;
        node = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1029
1030
    }

1031
    flat_list& operator=(flat_list&& other) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1032
    {
1033
1034
1035
1036
1037
1038
1039
1040
1041
        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
1042
1043
    }

1044
    ~flat_list() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1045
    {
1046
        clear();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1047
1048
    }

1049
    void clear() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1050
    {
1051
1052
1053
1054
1055
1056
1057
        node_type* prev = node;

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

1060
    bool empty() const noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1061
    {
1062
        return node == nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1063
1064
    }

1065
    iterator begin() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1066
    {
1067
1068
        return iterator(node);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1069

1070
1071
1072
1073
    iterator end() noexcept
    {
        return iterator(nullptr);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1074

1075
1076
1077
1078
    const_iterator begin() const noexcept
    {
        return const_iterator(node);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1079

1080
1081
1082
    const_iterator end() const noexcept
    {
        return const_iterator(nullptr);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1083
1084
    }

1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
    reference front() noexcept
    {
        assert(!empty());

        return node->value;
    }

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

        return node->value;
    }

1099
1100
    template<typename... Args>
    iterator emplace_front(Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1101
    {
1102
        node_type* new_node = allocator->alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1103

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

1106
1107
        new_node->next = node;
        node = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1108

1109
        return begin();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1110
1111
    }

1112
1113
    template<typename... Args>
    iterator emplace_after(iterator it, Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1114
    {
1115
1116
        node_type* new_node = allocator->alloc();
        new (&new_node->value) T(std::forward<Args>(args)...);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1117

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

1121
1122
        new_node->next = it->node->next;
        it->node->next = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1123

1124
        return iterator(new_node);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1125
1126
    }

1127
1128
    template<typename... Args>
    iterator try_emplace_front(Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1129
    {
1130
        auto [success, new_node] = allocator->try_alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1131

1132
1133
        if (!success)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1134

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

1137
1138
1139
1140
        new_node->next = node;
        node = new_node;

        return begin();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1141
1142
    }

1143
1144
    template<typename... Args>
    iterator try_emplace_after(iterator it, Args&&... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1145
    {
1146
        auto [success, new_node] = allocator->try_alloc();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1147

1148
1149
        if (!success)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1150

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

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

1156
1157
        new_node->next = it->node->next;
        it->node->next = new_node;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1158

1159
        return iterator(new_node);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1160
1161
    }

1162
    void pop_front() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1163
    {
1164
1165
        if (node == nullptr)
            return;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1166

1167
1168
        node_type* to_delete = node;
        node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1169

1170
        if constexpr (!std::is_trivial_v<T>)
1171
            to_delete->value.~T();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1172

1173
        allocator->free(to_delete);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1174
1175
    }

1176
    iterator erase_after(iterator it) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1177
    {
1178
        assert(allocator);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1179

1180
1181
        if (it.node == nullptr)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1182

1183
1184
1185
        node_type* to_delete = it.node->next;
        if (to_delete == nullptr)
            return end();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1186

1187
1188
        node_type* next = to_delete->next;
        it.node->next = next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1189

1190
        if constexpr (!std::is_trivial_v<T>)
1191
            to_delete->value.~T();
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1192

1193
        allocator->free(to_delete);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1194

1195
        return iterator(next);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1196
1197
1198
1199
    }
};

template<typename T>
1200
class flat_double_list
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1201
{
1202
private:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1203
1204
1205
1206
    struct node_type
    {
        T value;
        node_type* next = nullptr;
1207
        node_type* prev = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
    };

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

    class iterator
    {
    private:
1219
        flat_double_list* list{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1220
1221
1222
        node_type* node{ nullptr };

    public:
1223
        using iterator_category = std::bidirectional_iterator_tag;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1224
1225
1226
1227
1228
1229
        using value_type = T;
        using pointer = T*;
        using reference = T&;

        iterator() noexcept = default;

1230
1231
1232
        iterator(flat_double_list* lst, node_type* n) noexcept
          : list(lst)
          , node(n)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1233
1234
1235
        {}

        iterator(const iterator& other) noexcept
1236
1237
          : list(other.list)
          , node(other.node)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1238
1239
1240
1241
        {}

        iterator& operator=(const iterator& other) noexcept
        {
1242
            list = other.list;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
1243
1244
1245
1246
1247
1248
1249
1250
1251
            node = other.node;
            return *this;
        }

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

1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
        T* operator*() const noexcept
        {
            return node->value;
        }

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