139 lines
4.2 KiB
C++
139 lines
4.2 KiB
C++
/*
|
|
* 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/0_click_P_RTP.bin",
|
|
"/vendor/firmware/1_doubelClick_P_RTP.bin",
|
|
"/vendor/firmware/2_tick_P_RTP.bin",
|
|
"/vendor/firmware/3_thud_P_RTP.bin",
|
|
"/vendor/firmware/4_pop_P_RTP.bin",
|
|
"/vendor/firmware/5_heavyClick_P_RTP.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;
|
|
}
|