151 lines
3.8 KiB
C
151 lines
3.8 KiB
C
|
#include "fingerprint_common.h"
|
||
|
|
|
||
|
|
#if defined(CONFIG_SENSORS_FINGERPRINT_MODULE)
|
||
|
|
#if IS_ENABLED(CONFIG_EXYNOS_PM_QOS) || IS_ENABLED(CONFIG_EXYNOS_PM_QOS_MODULE)
|
||
|
|
#include <soc/samsung/exynos_pm_qos.h>
|
||
|
|
static struct exynos_pm_qos_request fingerprint_boost_qos;
|
||
|
|
#endif
|
||
|
|
#elif defined(CONFIG_SECURE_OS_BOOSTER_API)
|
||
|
|
#include <mach/secos_booster.h>
|
||
|
|
#elif defined(CONFIG_TZDEV_BOOST)
|
||
|
|
#if defined(CONFIG_TEEGRIS_VERSION) && (CONFIG_TEEGRIS_VERSION >= 4)
|
||
|
|
#include <../drivers/misc/tzdev/extensions/boost.h>
|
||
|
|
#else
|
||
|
|
#include <../drivers/misc/tzdev/tz_boost.h>
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
void spi_get_ctrldata(struct spi_device *spi)
|
||
|
|
{
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
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, "gate_spi_clk");
|
||
|
|
if (IS_ERR(clk_setting->fp_spi_pclk)) {
|
||
|
|
pr_err("Can't get gate_spi_clk\n");
|
||
|
|
return PTR_ERR(clk_setting->fp_spi_pclk);
|
||
|
|
}
|
||
|
|
|
||
|
|
clk_setting->fp_spi_sclk = devm_clk_get(dev, "ipclk_spi");
|
||
|
|
if (IS_ERR(clk_setting->fp_spi_sclk)) {
|
||
|
|
pr_err("Can't get ipclk_spi\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 rc = 0;
|
||
|
|
|
||
|
|
#ifdef ENABLE_SENSORS_FPRINT_SECURE
|
||
|
|
if (!clk_setting->enabled_clk) {
|
||
|
|
clk_prepare_enable(clk_setting->fp_spi_pclk);
|
||
|
|
clk_prepare_enable(clk_setting->fp_spi_sclk);
|
||
|
|
|
||
|
|
if (clk_get_rate(clk_setting->fp_spi_sclk) != (clk_setting->spi_speed * 4)) {
|
||
|
|
rc = clk_set_rate(clk_setting->fp_spi_sclk, clk_setting->spi_speed * 4);
|
||
|
|
if (rc < 0)
|
||
|
|
pr_err("SPI clk set failed: %d\n", rc);
|
||
|
|
else
|
||
|
|
pr_debug("Set SPI clock rate: %u(%lu)\n",
|
||
|
|
clk_setting->spi_speed, clk_get_rate(clk_setting->fp_spi_sclk) / 4);
|
||
|
|
} else {
|
||
|
|
pr_debug("Set SPI clock rate: %u(%lu)\n",
|
||
|
|
clk_setting->spi_speed, clk_get_rate(clk_setting->fp_spi_sclk) / 4);
|
||
|
|
}
|
||
|
|
|
||
|
|
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 rc;
|
||
|
|
}
|
||
|
|
|
||
|
|
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_pclk);
|
||
|
|
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)
|
||
|
|
{
|
||
|
|
int retval = 0;
|
||
|
|
|
||
|
|
pr_info("%s\n", __func__);
|
||
|
|
/* Module build & TEEGris */
|
||
|
|
#if defined(CONFIG_SENSORS_FINGERPRINT_MODULE)
|
||
|
|
#if IS_ENABLED(CONFIG_EXYNOS_PM_QOS) || IS_ENABLED(CONFIG_EXYNOS_PM_QOS_MODULE)
|
||
|
|
exynos_pm_qos_add_request(&fingerprint_boost_qos, PM_QOS_CLUSTER1_FREQ_MIN,
|
||
|
|
PM_QOS_CLUSTER1_FREQ_MAX_DEFAULT_VALUE);
|
||
|
|
#endif
|
||
|
|
/* TEEGris */
|
||
|
|
#elif defined(CONFIG_TZDEV_BOOST)
|
||
|
|
tz_boost_enable();
|
||
|
|
/* Kinibi */
|
||
|
|
#elif defined(CONFIG_SECURE_OS_BOOSTER_API)
|
||
|
|
retval = secos_booster_start(MAX_PERFORMANCE);
|
||
|
|
if (retval)
|
||
|
|
pr_err("booster start failed. (%d)\n", retval);
|
||
|
|
|
||
|
|
#else
|
||
|
|
pr_info("FP_CPU_SPEEDUP does not supported\n");
|
||
|
|
#endif
|
||
|
|
|
||
|
|
return retval;
|
||
|
|
}
|
||
|
|
|
||
|
|
int cpu_speedup_disable(struct boosting_config *boosting)
|
||
|
|
{
|
||
|
|
int retval = 0;
|
||
|
|
|
||
|
|
pr_info("%s\n", __func__);
|
||
|
|
/* Module build & TEEGris */
|
||
|
|
#if defined(CONFIG_SENSORS_FINGERPRINT_MODULE)
|
||
|
|
#if IS_ENABLED(CONFIG_EXYNOS_PM_QOS) || IS_ENABLED(CONFIG_EXYNOS_PM_QOS_MODULE)
|
||
|
|
exynos_pm_qos_remove_request(&fingerprint_boost_qos);
|
||
|
|
#endif
|
||
|
|
/* TEEGris */
|
||
|
|
#elif defined(CONFIG_TZDEV_BOOST)
|
||
|
|
tz_boost_disable();
|
||
|
|
/* Kinibi */
|
||
|
|
#elif defined(CONFIG_SECURE_OS_BOOSTER_API)
|
||
|
|
retval = secos_booster_stop();
|
||
|
|
if (retval)
|
||
|
|
pr_err("booster stop failed. (%d)\n", retval);
|
||
|
|
|
||
|
|
#else
|
||
|
|
pr_info("FP_CPU_SPEEDUP does not supported\n");
|
||
|
|
#endif
|
||
|
|
|
||
|
|
return retval;
|
||
|
|
}
|