core.hpp 136 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

K-H-Ismail's avatar
K-H-Ismail committed
98
99
    model_accumulator_bad_external_message,

100
    gui_not_enough_memory,
Gauthier Quesnel's avatar
Gauthier Quesnel committed
101
102
103
104
105
106
107
108

    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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
};

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

130
131
template<typename T, typename... Args>
constexpr bool
132
match(const T& s, Args... args) noexcept
133
134
135
136
{
    return ((s == args) || ... || false);
}

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

Gauthier Quesnel's avatar
Gauthier Quesnel committed
177
178
179
180
#define irt_bad_return(status__)                                               \
    do {                                                                       \
        irt_breakpoint();                                                      \
        return status__;                                                       \
181
182
    } while (0)

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

Gauthier Quesnel's avatar
Gauthier Quesnel committed
192
193
194
195
196
197
#define irt_return_if_fail(expr__, status__)                                   \
    do {                                                                       \
        if (!(expr__)) {                                                       \
            irt_breakpoint();                                                  \
            return status__;                                                   \
        }                                                                      \
198
    } while (0)
Gauthier Quesnel's avatar
Gauthier Quesnel committed
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
227
228
229
230
231
232
233
234
235

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;

236
    static constexpr bool is_infinity(time t) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
237
238
239
240
    {
        return t == infinity || t == negative_infinity;
    }

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

Gauthier Quesnel's avatar
Gauthier Quesnel committed
333
334
335
336
337
338
339
    constexpr std::size_t size() const noexcept
    {
        return size_;
    }

    constexpr std::size_t capacity() const noexcept
    {
340
        return length;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
341
342
343
344
    }

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

        std::memcpy(buffer_, str.data(), copy_length);
348
349
350
        buffer_[copy_length] = '\0';

        size_ = static_cast<unsigned char>(copy_length);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
351
352
353
354
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
    }

    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
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
    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
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
438
439
440
441
442
443
444
445
446
    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;
    }
};

/*****************************************************************************
 *
447
 * value
Gauthier Quesnel's avatar
Gauthier Quesnel committed
448
449
450
 *
 ****************************************************************************/

451
enum class value_type : i8
Gauthier Quesnel's avatar
Gauthier Quesnel committed
452
{
453
454
455
456
457
458
459
    none,
    integer_8,
    integer_32,
    integer_64,
    real_32,
    real_64
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
460

461
462
template<typename T, size_t length>
struct span
Gauthier Quesnel's avatar
Gauthier Quesnel committed
463
{
464
465
466
467
468
469
470
471
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
472

473
474
private:
    const T* data_;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
475

476
477
478
479
public:
    constexpr span(const T* ptr)
      : data_(ptr)
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
480

481
482
483
484
    constexpr T* data() noexcept
    {
        return data_;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
485

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

491
492
493
494
    constexpr size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
495

496
497
498
499
500
    constexpr T operator[](size_t i) const noexcept
    {
        assert(i < length);
        return data_[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
501

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

530
struct message
Gauthier Quesnel's avatar
Gauthier Quesnel committed
531
{
532
533
    using size_type = std::size_t;
    using difference_type = std::ptrdiff_t;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
534

535
    union
Gauthier Quesnel's avatar
Gauthier Quesnel committed
536
    {
537
538
539
540
541
        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
542
543
    };

544
545
    u8 length;
    value_type type;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
546

547
548
549
550
    constexpr std::size_t size() const noexcept
    {
        return length;
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
551

552
553
554
555
556
    constexpr message() noexcept
      : integer_8{ 0 }
      , length{ 0 }
      , type{ value_type::none }
    {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
557

558
559
    template<typename... T>
    constexpr message(T... args) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
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
585
586
587
588
589
590
591
592
593
        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
594

595
596
597
598
    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
599
600
    }

601
    constexpr span<i32, 8> to_integer_32() const
Gauthier Quesnel's avatar
Gauthier Quesnel committed
602
    {
603
604
605
        assert(type == value_type::integer_32);
        return span<i32, 8>(integer_32);
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
606

607
608
609
610
611
    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
612

613
614
615
616
617
    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
618

619
620
621
622
    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
623
624
    }

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

630
631
632
633
634
635
636
        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
637
638
    }

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

644
645
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
646

647
648
        assert(type == value_type::integer_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
649

650
651
        return integer_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
652

653
654
655
656
    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
657

658
659
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
660

661
662
663
664
        assert(type == value_type::integer_64);
        assert(i < static_cast<T>(length));

        return integer_64[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
665
666
    }

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

672
673
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
674

675
676
        assert(type == value_type::real_32);
        assert(i < static_cast<T>(length));
Gauthier Quesnel's avatar
Gauthier Quesnel committed
677

678
679
        return real_32[i];
    }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
680

681
682
683
684
    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
685

686
687
        if constexpr (std::is_signed_v<T>)
            assert(i >= 0);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
688

689
690
691
692
        assert(type == value_type::real_64);
        assert(i < static_cast<T>(length));

        return real_64[i];
Gauthier Quesnel's avatar
Gauthier Quesnel committed
693
    }
694
695
696
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));
        }

        return 0.0;
    }
716
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
717

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

739
private:
Gauthier Quesnel's avatar
Gauthier Quesnel committed
740
    block* blocks{ nullptr };    // contains all preallocated blocks
741
742
743
744
    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
745

746
747
public:
    block_allocator() = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
748

749
750
    block_allocator(const block_allocator&) = delete;
    block_allocator& operator=(const block_allocator&) = delete;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
751

752
753
754
755
    ~block_allocator() noexcept
    {
        if (blocks)
            std::free(blocks);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
756
757
    }

758
    status init(std::size_t new_capacity) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
759
    {
760
761
        if (new_capacity == 0)
            return status::block_allocator_bad_capacity;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
762

763
764
765
766
767
768
769
770
        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
771

772
773
774
775
        size = 0;
        max_size = 0;
        capacity = new_capacity;
        free_head = nullptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
776

777
        return status::success;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
778
779
    }

780
    void reset() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
781
    {
782
783
784
785
786
        if (capacity > 0) {
            size = 0;
            max_size = 0;
            free_head = nullptr;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
787
788
    }

789
    std::pair<bool, T*> try_alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
790
    {
791
792
        if (free_head == nullptr && max_size >= capacity)
            return { false, nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
793

794
        return { true, alloc() };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
795
796
    }

797
    T* alloc() noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
798
    {
799
800
801
802
803
804
805
806
807
        ++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
808
809
        }

810
        return reinterpret_cast<T*>(new_block);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
811
812
    }

813
    void free(T* n) noexcept
Gauthier Quesnel's avatar
Gauthier Quesnel committed
814
    {
815
        assert(n);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
816

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

819
820
        ptr->next = free_head;
        free_head = ptr;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
821

822
        --size;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
823

824
825
826
827
        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
828
    }
829
};
Gauthier Quesnel's avatar
Gauthier Quesnel committed
830

831
832
833
834
835
template<typename T>
class flat_list
{
public:
    struct node_type
Gauthier Quesnel's avatar
Gauthier Quesnel committed
836
    {
837
838
839
        T value;
        node_type* next = nullptr;
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
840

841
842
843
844
public:
    using allocator_type = block_allocator<node_type>;
    using value_type = T;
    using reference = T&;
845
    using const_reference = const T&;
846
    using pointer = T*;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
847

848
    class iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
849
    {
850
851
    private:
        node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
852

853
854
855
856
857
858
    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
859

860
        iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
861

862
863
864
        iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
865

866
867
868
        iterator(const iterator& other) noexcept
          : node(other.node)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
869

870
871
872
873
874
        iterator& operator=(const iterator& other) noexcept
        {
            node = other.node;
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
875

876
877
878
879
        T& operator*() noexcept
        {
            return node->value;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
880

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

886
887
888
889
        iterator operator++() noexcept
        {
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
890

891
892
            return *this;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
893

894
895
896
        iterator operator++(int) noexcept
        {
            iterator tmp(*this);
Gauthier Quesnel's avatar
Gauthier Quesnel committed
897

898
899
            if (node != nullptr)
                node = node->next;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
900

901
902
            return tmp;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
903

904
905
906
907
        bool operator==(const iterator& other) const noexcept
        {
            return node == other.node;
        }
Gauthier Quesnel's avatar
Gauthier Quesnel committed
908

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

914
915
916
917
        void swap(iterator& other) noexcept
        {
            std::swap(node, other.node);
        }
918

Gauthier Quesnel's avatar
Gauthier Quesnel committed
919
        friend class flat_list<T>;
920
    };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
921

922
    class const_iterator
Gauthier Quesnel's avatar
Gauthier Quesnel committed
923
    {
924
925
    private:
        const node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
926

927
928
929
930
931
932
    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
933

934
        const_iterator() noexcept = default;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
935

936
937
938
        const_iterator(node_type* n) noexcept
          : node(n)
        {}
Gauthier Quesnel's avatar
Gauthier Quesnel committed
939

940
941
942
943
944
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
        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);
        }
992

Gauthier Quesnel's avatar
Gauthier Quesnel committed
993
        friend class flat_list<T>;
Gauthier Quesnel's avatar
Gauthier Quesnel committed
994
995
    };

996
997
998
private:
    allocator_type* allocator{ nullptr };
    node_type* node{ nullptr };
Gauthier Quesnel's avatar
Gauthier Quesnel committed
999

1000
public:
For faster browsing, not all history is shown. View entire blame