104 lines
2.3 KiB
C
Executable file
104 lines
2.3 KiB
C
Executable file
#include "fingerprint_common.h"
|
|
#include <linux/of.h>
|
|
#include <linux/platform_data/spi-mt65xx.h>
|
|
|
|
|
|
void spi_get_ctrldata(struct spi_device *spi)
|
|
{
|
|
#ifndef ENABLE_SENSORS_FPRINT_SECURE
|
|
struct device_node *np, *data_np = NULL;
|
|
u32 tckdly = 0;
|
|
|
|
np = spi->dev.of_node;
|
|
if (!np) {
|
|
pr_err("%s : device node not founded\n", __func__);
|
|
return;
|
|
}
|
|
|
|
data_np = of_get_child_by_name(np, "controller-data");
|
|
if (!data_np) {
|
|
pr_err("%s : controller-data not founded\n", __func__);
|
|
return;
|
|
}
|
|
|
|
of_property_read_u32(data_np, "mediatek,tckdly", &tckdly);
|
|
((struct mtk_chip_config *)spi->controller_data)->tick_delay = tckdly;
|
|
|
|
of_node_put(data_np);
|
|
pr_info("%s done\n", __func__);
|
|
#endif
|
|
}
|
|
|
|
int spi_clk_register(struct spi_clk_setting *clk_setting, struct device *dev)
|
|
{
|
|
#ifdef ENABLE_SENSORS_FPRINT_SECURE
|
|
clk_setting->fp_spi_pclk = devm_clk_get(dev, "sel-clk");
|
|
if (IS_ERR(clk_setting->fp_spi_pclk)) {
|
|
pr_err("Can't get sel-clk\n");
|
|
return PTR_ERR(clk_setting->fp_spi_pclk);
|
|
}
|
|
|
|
clk_setting->fp_spi_sclk = devm_clk_get(dev, "spi-clk");
|
|
if (IS_ERR(clk_setting->fp_spi_sclk)) {
|
|
pr_err("Can't get spi-clk\n");
|
|
return PTR_ERR(clk_setting->fp_spi_sclk);
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int spi_clk_unregister(struct spi_clk_setting *clk_setting)
|
|
{
|
|
#ifdef ENABLE_SENSORS_FPRINT_SECURE
|
|
clk_put(clk_setting->fp_spi_pclk);
|
|
clk_put(clk_setting->fp_spi_sclk);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int spi_clk_enable(struct spi_clk_setting *clk_setting)
|
|
{
|
|
int retval = 0;
|
|
|
|
#ifdef ENABLE_SENSORS_FPRINT_SECURE
|
|
if (!clk_setting->enabled_clk) {
|
|
retval = clk_prepare_enable(clk_setting->fp_spi_sclk);
|
|
if (retval < 0) {
|
|
pr_err("Unable to enable spi clk\n");
|
|
return retval;
|
|
}
|
|
pr_debug("ENABLE_SPI_CLOCK %d\n", clk_setting->spi_speed);
|
|
__pm_stay_awake(clk_setting->spi_wake_lock);
|
|
clk_setting->enabled_clk = true;
|
|
}
|
|
#endif
|
|
|
|
return retval;
|
|
}
|
|
|
|
int spi_clk_disable(struct spi_clk_setting *clk_setting)
|
|
{
|
|
#ifdef ENABLE_SENSORS_FPRINT_SECURE
|
|
if (clk_setting->enabled_clk) {
|
|
clk_disable_unprepare(clk_setting->fp_spi_sclk);
|
|
__pm_relax(clk_setting->spi_wake_lock);
|
|
clk_setting->enabled_clk = false;
|
|
pr_debug("DISABLE_SPI_CLOCK\n");
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int cpu_speedup_enable(struct boosting_config *boosting)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int cpu_speedup_disable(struct boosting_config *boosting)
|
|
{
|
|
return 0;
|
|
}
|