android_device_xiaomi_sm8350-common/vibrator/effect/effect.cpp

/*
 * Copyright (c) 2020, The Linux Foundation. All rights reserved.
 * Copyright (C) 2022 The LineageOS Project
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are
 * met:
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above
 *       copyright notice, this list of conditions and the following
 *       disclaimer in the documentation and/or other materials provided
 *       with the distribution.
 *     * Neither the name of The Linux Foundation nor the names of its
 *       contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#define LOG_TAG "libxiaomivibratoreffect"

#include <iostream>
#include <fstream>
#include <log/log.h>
#include <sys/stat.h>

#include "effect.h"

#define ARRAY_SIZE(a) (sizeof(a) / sizeof(*(a)))

static struct effect_stream effects[] = {
    {
        .effect_id = 0,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
    {
        .effect_id = 1,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
    {
        .effect_id = 2,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
    {
        .effect_id = 3,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
    {
        .effect_id = 4,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
    {
        .effect_id = 5,
        .data = 0,
        .length = 0,
        .play_rate_hz = 24000,
    },
};

// Array containing the paths to fifo data in vendor.
// The position in the array must match the effect id.
static const std::string fifo_data_paths[] = {
    "/vendor/firmware/seq_bin_wav1.bin",
    "/vendor/firmware/seq_bin_wav2.bin",
    "/vendor/firmware/seq_bin_wav3.bin",
    "/vendor/firmware/seq_bin_wav4.bin",
    "/vendor/firmware/seq_bin_wav5.bin",
    "/vendor/firmware/seq_bin_wav6.bin",
};

// Function to parse custom fifo data from vendor
int parse_custom_data(effect_stream *effect) {
    const char *path = fifo_data_paths[effect->effect_id].c_str();
    std::ifstream data;
    struct stat file_stat;
    int rc = 0;

    ALOGI("Parsing custom fifo data for effect %d from path %s",
            effect->effect_id, path);

    rc = stat(path, &file_stat);
    if (!rc) {
        effect->length = file_stat.st_size;
    } else {
        ALOGE("Could not open %s", path);
        return rc;
    }

    // Create a persistent 8-bit int array which contains the fifo data, one
    // slot of the array contains one byte of the fifo data from vendor.
    int8_t *custom_data = new int8_t[effect->length];

    data.open(path, std::ios::in | std::ios::binary);
    data.read(reinterpret_cast<char *>(custom_data), effect->length);
    data.close();

    effect->data = custom_data;

    return rc;
}

const struct effect_stream *get_effect_stream(uint32_t effect_id)
{
    int i;

    for (i = 0; i < ARRAY_SIZE(effects); i++) {
        if (effect_id == effects[i].effect_id) {
            if (effects[i].length == 0 && parse_custom_data(&effects[i])) {
                ALOGE("Could not get custom_data for effect %d", effects[i].effect_id);
                return NULL;
            }
            return &effects[i];
        }
    }

    return NULL;
}