drivers/fingerprint/qbt2000_platform.c

/*
 * Copyright (C) 2018 Samsung Electronics. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 */

#include "fingerprint.h"
#include "qbt2000_common.h"

#if defined(CONFIG_TZDEV_BOOST) && defined(ENABLE_SENSORS_FPRINT_SECURE)
#include <../drivers/misc/tzdev/tz_boost.h>
#endif

int qbt2000_sec_spi_prepare(int speed)
{
	struct clk *fp_spi_pclk, *fp_spi_sclk;
	int ret;

	fp_spi_pclk = clk_get(NULL, "fp-spi-pclk");

	if (IS_ERR(fp_spi_pclk)) {
		pr_err("%s: Can't get fp_spi_pclk\n", __func__);
		return -1;
	}

	fp_spi_sclk = clk_get(NULL, "fp-spi-sclk");

	if (IS_ERR(fp_spi_sclk)) {
		pr_err("%s: Can't get fp_spi_sclk\n", __func__);
		return -1;
	}

	clk_prepare_enable(fp_spi_pclk);
	clk_prepare_enable(fp_spi_sclk);

	if (clk_get_rate(fp_spi_sclk) != (speed * 4)) {

		ret = clk_set_rate(fp_spi_sclk, speed * 4);
		if (ret < 0)
			pr_err("%s, SPI clk set failed: %d\n", __func__, ret);

		else
			pr_debug("%s, Set SPI clock rate: %u(%lu)\n",
				__func__, speed, clk_get_rate(fp_spi_sclk) / 4);
	} else
		pr_debug("%s, Set SPI clock rate: %u(%lu)\n",
			__func__, speed, clk_get_rate(fp_spi_sclk) / 4);

	clk_put(fp_spi_pclk);
	clk_put(fp_spi_sclk);

	return 0;
}

int qbt2000_sec_spi_unprepare(void)
{
	struct clk *fp_spi_pclk, *fp_spi_sclk;

	fp_spi_pclk = clk_get(NULL, "fp-spi-pclk");
	if (IS_ERR(fp_spi_pclk)) {
		pr_err("%s: Can't get fp_spi_pclk\n", __func__);
		return -1;
	}

	fp_spi_sclk = clk_get(NULL, "fp-spi-sclk");

	if (IS_ERR(fp_spi_sclk)) {
		pr_err("%s: Can't get fp_spi_sclk\n", __func__);
		return -1;
	}

	clk_disable_unprepare(fp_spi_pclk);
	clk_disable_unprepare(fp_spi_sclk);

	clk_put(fp_spi_pclk);
	clk_put(fp_spi_sclk);

	return 0;
}

int qbt2000_set_clk(struct qbt2000_drvdata *drvdata, bool onoff)
{
	int rc = 0;

	if (drvdata->enabled_clk == onoff) {
		pr_err("%s: already %s\n", __func__, onoff ? "enabled" : "disabled");
		return rc;
	}

	if (onoff) {
		rc = qbt2000_sec_spi_prepare(drvdata->spi_speed);
		if (rc < 0) {
			pr_err("%s: couldn't enable spi clk: %d\n", __func__, rc);
			return rc;
		}
		wake_lock(&drvdata->fp_spi_lock);
		drvdata->enabled_clk = true;
	} else {
		rc = qbt2000_sec_spi_unprepare();
		if (rc < 0) {
			pr_err("%s: couldn't disable spi clk: %d\n", __func__, rc);
			return rc;
		}
		wake_unlock(&drvdata->fp_spi_lock);
		drvdata->enabled_clk = false;
	}
	return rc;
}

int qbt2000_register_platform_variable(struct qbt2000_drvdata *drvdata)
{
	return 0;
}

int qbt2000_unregister_platform_variable(struct qbt2000_drvdata *drvdata)
{
	return 0;
}

int qbt2000_set_cpu_speedup(struct qbt2000_drvdata *drvdata, int onoff)
{
	int rc = 0;
#if defined(CONFIG_TZDEV_BOOST) && defined(ENABLE_SENSORS_FPRINT_SECURE)
	if (onoff) {
		pr_info("%s: SPEEDUP ON:%d\n", __func__, onoff);
		tz_boost_enable();
	} else {
		pr_info("%s: SPEEDUP OFF:%d\n", __func__, onoff);
		tz_boost_disable();
	}
#endif
	return rc;
}