Method parse_orientation_data

src/board_controller/mentalab/explore.cpp:349–396

}

void Explore::parse_orientation_data (
    const ExploreHeader *header, double *package, unsigned char *payload)
{
    int payload_size = header->payload_size;
    if ((payload[payload_size - 4] != 0xAF) || (payload[payload_size - 3] != 0xBE) ||
        (payload[payload_size - 2] != 0xAD) || (payload[payload_size - 1] != 0xDE))
    {
        safe_logger (spdlog::level::warn, "checksum failed, {} {} {} {}", payload[payload_size - 4],
            payload[payload_size - 3], payload[payload_size - 2], payload[payload_size - 1]);
        return;
    }
    payload_size = payload_size - 4;

    std::vector<int> accel_channels = board_descr["auxiliary"]["accel_channels"];
    std::vector<int> gyro_channels = board_descr["auxiliary"]["gyro_channels"];
    std::vector<int> magnetometer_channels = board_descr["auxiliary"]["magnetometer_channels"];

    if (payload_size % 2 != 0) // 2 is int16
    {
        safe_logger (spdlog::level::warn, "Invalid payload size for Orn package: {}");
        return;
    }
    int num_datapoints = payload_size / 2;

    for (int i = 0; i < num_datapoints; i++)
    {
        double data = (double)cast_16bit_to_int32_swap_order ((unsigned char *)(payload + 2 * i));
        if (i < 3)
        {
            package[accel_channels[i]] = 0.061 * data;
        }
        else if (i < 6)
        {
            package[gyro_channels[i - 3]] = 8.750 * data;
        }
        else
        {
            if (i == 6)
            {
                data *= -1; // no idea why, copypaste, maybe bug in fw
            }
            package[magnetometer_channels[i - 6]] = 1.52 * data;
        }
    }
    package[board_descr["auxiliary"]["timestamp_channel"].get<int> ()] = get_timestamp ();
    package[board_descr["auxiliary"]["package_num_channel"].get<int> ()] = header->counter;
    push_package (package, (int)BrainFlowPresets::AUXILIARY_PRESET);
}

void Explore::parse_eeg_data (const ExploreHeader *header, double *package, unsigned char *payload,
    double vref, int n_packages)