fork/GramFirmware

git clone https://git.julia.blue/fork/GramFirmware

CarVacrebase to configurator818d962

gram
2.2 KiB79 linesraw
1#include "core/config_utils.hpp"
2
3#include "core/state.hpp"
4#include "util/state_util.hpp"
5
6#include <config.pb.h>
7
8CommunicationBackendConfig backend_config_from_buttons(
9    const InputState &inputs,
10    const CommunicationBackendConfig *backend_configs,
11    size_t backend_configs_count
12) {
13    for (size_t i = 0; i < backend_configs_count; i++) {
14        const CommunicationBackendConfig &backend_config = backend_configs[i];
15        // Build bit mask for checking for matching button hold.
16        uint64_t button_hold_mask = make_button_mask(
17            backend_config.activation_binding,
18            backend_config.activation_binding_count
19        );
20
21        // Check if button hold matches.
22        if (all_buttons_held(inputs.buttons, button_hold_mask)) {
23            return backend_config;
24        }
25    }
26
27    return CommunicationBackendConfig{
28        .backend_id = COMMS_BACKEND_UNSPECIFIED,
29        .default_mode_config = 0,
30    };
31}
32
33CommunicationBackendConfig backend_config_from_id(
34    CommunicationBackendId backend_id,
35    const CommunicationBackendConfig *backend_configs,
36    size_t backend_configs_count
37) {
38    for (size_t i = 0; i < backend_configs_count; i++) {
39        const CommunicationBackendConfig &backend_config = backend_configs[i];
40        if (backend_config.backend_id == backend_id) {
41            return backend_config;
42        }
43    }
44
45    return CommunicationBackendConfig{
46        .backend_id = backend_id,
47        .default_mode_config = 0,
48    };
49}
50
51uint8_t backend_config_id_from_backend_id(
52    CommunicationBackendId backend_id,
53    const CommunicationBackendConfig *backend_configs,
54    size_t backend_configs_count
55) {
56    for (size_t i = 0; i < backend_configs_count; i++) {
57        const CommunicationBackendConfig &backend_config = backend_configs[i];
58        if (backend_config.backend_id == backend_id) {
59            return i + 1;
60        }
61    }
62
63    return 0;
64}
65
66uint8_t mode_config_id_from_mode_id(
67    GameModeId mode_id,
68    const GameModeConfig *mode_configs,
69    size_t mode_configs_count
70) {
71    for (size_t i = 0; i < mode_configs_count; i++) {
72        const GameModeConfig &mode = mode_configs[i];
73        if (mode.mode_id == mode_id) {
74            return i + 1;
75        }
76    }
77
78    return 0;
79}