Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 04dddde8 authored by Arjun Singh's avatar Arjun Singh Committed by Gerrit - the friendly Code Review server
Browse files

soc: qcom: bgcom: Add suspend resume to aligned to SPI pm 



Adds pm suspend resume call backs to be aligned with SPI driver.

Change-Id: I057c2d5f74b3c39c58647a0ea594d4d667644271
Signed-off-by: default avatarArjun Singh <arsingh@codeaurora.org>
Signed-off-by: default avatarRamesh Yadav Javadi <javadi@codeaurora.org>
parent 7bcb1bb4

drivers/soc/qcom/bg_rsb.c

+10 −11
Original line number Original line Diff line number Diff line
@@ -968,9 +968,9 @@ static int bg_rsb_remove(struct platform_device *pdev) 
	return 0;

	return 0;

}

}





static int bg_rsb_resume(struct platform_device *pdev)

static int bg_rsb_resume(struct device *pldev)

{

{

	int rc;

	struct platform_device *pdev = to_platform_device(pldev);

	struct bgrsb_priv *dev = platform_get_drvdata(pdev);

	struct bgrsb_priv *dev = platform_get_drvdata(pdev);





	if (dev->bgrsb_current_state == BGRSB_STATE_RSB_CONFIGURED)

	if (dev->bgrsb_current_state == BGRSB_STATE_RSB_CONFIGURED)
@@ -978,12 +978,6 @@ static int bg_rsb_resume(struct platform_device *pdev) 




	if (dev->bgrsb_current_state == BGRSB_STATE_INIT) {

	if (dev->bgrsb_current_state == BGRSB_STATE_INIT) {

		if (bgrsb_ldo_work(dev, BGRSB_ENABLE_LDO11) == 0) {

		if (bgrsb_ldo_work(dev, BGRSB_ENABLE_LDO11) == 0) {

			rc = bgrsb_configr_rsb(dev, true);

			if (rc != 0) {

				pr_err("BG failed to configure RSB %d\n", rc);

				bgrsb_ldo_work(dev, BGRSB_DISABLE_LDO11);

				return rc;

			}

			dev->bgrsb_current_state = BGRSB_STATE_RSB_CONFIGURED;

			dev->bgrsb_current_state = BGRSB_STATE_RSB_CONFIGURED;

			pr_debug("RSB Cofigured\n");

			pr_debug("RSB Cofigured\n");

			return 0;

			return 0;
@@ -993,8 +987,9 @@ static int bg_rsb_resume(struct platform_device *pdev) 
	return -EINVAL;

	return -EINVAL;

}

}





static int bg_rsb_suspend(struct platform_device *pdev, pm_message_t state)

static int bg_rsb_suspend(struct device *pldev)

{

{

	struct platform_device *pdev = to_platform_device(pldev);

	struct bgrsb_priv *dev = platform_get_drvdata(pdev);

	struct bgrsb_priv *dev = platform_get_drvdata(pdev);





	if (dev->bgrsb_current_state == BGRSB_STATE_INIT)

	if (dev->bgrsb_current_state == BGRSB_STATE_INIT)
@@ -1021,15 +1016,19 @@ static const struct of_device_id bg_rsb_of_match[] = { 
	{ }

	{ }

};

};





static const struct dev_pm_ops pm_rsb = {

	.resume		= bg_rsb_resume,

	.suspend	= bg_rsb_suspend,

};



static struct platform_driver bg_rsb_driver = {

static struct platform_driver bg_rsb_driver = {

	.driver = {

	.driver = {

		.name = "bg-rsb",

		.name = "bg-rsb",

		.of_match_table = bg_rsb_of_match,

		.of_match_table = bg_rsb_of_match,

		.pm = &pm_rsb,

	},

	},

	.probe		= bg_rsb_probe,

	.probe		= bg_rsb_probe,

	.remove		= bg_rsb_remove,

	.remove		= bg_rsb_remove,

	.resume		= bg_rsb_resume,

	.suspend	= bg_rsb_suspend,

};

};





module_platform_driver(bg_rsb_driver);

module_platform_driver(bg_rsb_driver);

drivers/soc/qcom/bgcom_spi.c

+68 −23
Original line number Original line Diff line number Diff line
@@ -63,6 +63,7 @@ enum bgcom_req_type { 
	BGCOM_READ_REG = 0,

	BGCOM_READ_REG = 0,

	BGCOM_READ_FIFO = 1,

	BGCOM_READ_FIFO = 1,

	BGCOM_READ_AHB = 2,

	BGCOM_READ_AHB = 2,

	BGCOM_WRITE_REG = 3,

};

};





struct bg_spi_priv {

struct bg_spi_priv {
@@ -112,6 +113,9 @@ static DECLARE_WORK(input_work, send_input_events); 




static struct mutex bg_resume_mutex;

static struct mutex bg_resume_mutex;





static atomic_t  bg_is_spi_active;

static int bg_irq;



static void augmnt_fifo(uint8_t *data, int pos)

static void augmnt_fifo(uint8_t *data, int pos)

{

{

	data[pos] = '\0';

	data[pos] = '\0';
@@ -197,6 +201,10 @@ static int read_bg_locl(enum bgcom_req_type req_type, 
	case BGCOM_READ_FIFO:

	case BGCOM_READ_FIFO:

		ret = bgcom_fifo_read(&clnt_handle, no_of_words, buf);

		ret = bgcom_fifo_read(&clnt_handle, no_of_words, buf);

		break;

		break;

	case BGCOM_WRITE_REG:

		ret = bgcom_reg_write(&clnt_handle, BG_CMND_REG,

					no_of_words, buf);

		break;

	case BGCOM_READ_AHB:

	case BGCOM_READ_AHB:

		break;

		break;

	}

	}
@@ -232,6 +240,9 @@ static int bgcom_transfer(void *handle, uint8_t *tx_buf, 
	tx_xfer = &bg_spi->xfer1;

	tx_xfer = &bg_spi->xfer1;

	spi = bg_spi->spi;

	spi = bg_spi->spi;





	if (!atomic_read(&bg_is_spi_active))

		return -ECANCELED;



	mutex_lock(&bg_spi->xfer_mutex);

	mutex_lock(&bg_spi->xfer_mutex);

	bg_spi_reinit_xfer(tx_xfer);

	bg_spi_reinit_xfer(tx_xfer);

	tx_xfer->tx_buf = tx_buf;

	tx_xfer->tx_buf = tx_buf;
@@ -621,6 +632,11 @@ int bgcom_fifo_read(void *handle, uint32_t num_words, 
		return -EBUSY;

		return -EBUSY;

	}

	}





	if (bgcom_resume(handle)) {

		pr_err("Failed to resume\n");

		return -EBUSY;

	}



	size = num_words*BG_SPI_WORD_SIZE;

	size = num_words*BG_SPI_WORD_SIZE;

	txn_len = BG_SPI_READ_LEN + size;

	txn_len = BG_SPI_READ_LEN + size;

	tx_buf = kzalloc(txn_len, GFP_KERNEL | GFP_ATOMIC);

	tx_buf = kzalloc(txn_len, GFP_KERNEL | GFP_ATOMIC);
@@ -671,6 +687,11 @@ int bgcom_reg_write(void *handle, uint8_t reg_start_addr, 
		return -EBUSY;

		return -EBUSY;

	}

	}





	if (bgcom_resume(handle)) {

		pr_err("Failed to resume\n");

		return -EBUSY;

	}



	size = num_regs*BG_SPI_WORD_SIZE;

	size = num_regs*BG_SPI_WORD_SIZE;

	txn_len = BG_SPI_WRITE_CMND_LEN + size;

	txn_len = BG_SPI_WRITE_CMND_LEN + size;
@@ -766,6 +787,9 @@ int bgcom_resume(void *handle) 
	if (handle == NULL)

	if (handle == NULL)

		return -EINVAL;

		return -EINVAL;





	if (!atomic_read(&bg_is_spi_active))

		return -ECANCELED;



	cntx = (struct bg_context *)handle;

	cntx = (struct bg_context *)handle;

	bg_spi = cntx->bg_spi;

	bg_spi = cntx->bg_spi;
@@ -796,29 +820,9 @@ EXPORT_SYMBOL(bgcom_resume); 




int bgcom_suspend(void *handle)

int bgcom_suspend(void *handle)

{

{

	struct bg_spi_priv *bg_spi;

	if (!handle)

	struct bg_context *cntx;

	uint32_t cmnd_reg = 0;

	int ret = 0;



	if (handle == NULL)

		return -EINVAL;

		return -EINVAL;



	return 0;

	cntx = (struct bg_context *)handle;

	bg_spi = cntx->bg_spi;

	mutex_lock(&bg_resume_mutex);

	if (bg_spi->bg_state == BGCOM_STATE_SUSPEND)

		goto unlock;



	cmnd_reg |= BIT(31);

	ret = bgcom_reg_write(handle, BG_CMND_REG, 1, &cmnd_reg);

	if (ret == 0)

		bg_spi->bg_state = BGCOM_STATE_SUSPEND;



unlock:

	mutex_unlock(&bg_resume_mutex);

	pr_info("suspended with : %d\n", ret);

	return ret;

}

}

EXPORT_SYMBOL(bgcom_suspend);

EXPORT_SYMBOL(bgcom_suspend);
@@ -931,7 +935,6 @@ static int bg_spi_probe(struct spi_device *spi) 
	struct bg_spi_priv *bg_spi;

	struct bg_spi_priv *bg_spi;

	struct device_node *node;

	struct device_node *node;

	int irq_gpio = 0;

	int irq_gpio = 0;

	int bg_irq = 0;

	int ret;

	int ret;





	bg_spi = devm_kzalloc(&spi->dev, sizeof(*bg_spi),

	bg_spi = devm_kzalloc(&spi->dev, sizeof(*bg_spi),
@@ -969,6 +972,7 @@ static int bg_spi_probe(struct spi_device *spi) 
	if (ret)

	if (ret)

		goto err_ret;

		goto err_ret;





	atomic_set(&bg_is_spi_active, 1);

	pr_info("Bgcom Probed successfully\n");

	pr_info("Bgcom Probed successfully\n");

	return ret;

	return ret;
@@ -990,6 +994,46 @@ static int bg_spi_remove(struct spi_device *spi) 
	return 0;

	return 0;

}

}





static int bgcom_pm_suspend(struct device *dev)

{

	uint32_t cmnd_reg = 0;

	struct spi_device *s_dev = to_spi_device(dev);

	struct bg_spi_priv *bg_spi = spi_get_drvdata(s_dev);

	int ret = 0;



	if (bg_spi->bg_state == BGCOM_STATE_SUSPEND)

		return 0;



	cmnd_reg |= BIT(31);

	ret = read_bg_locl(BGCOM_WRITE_REG, 1, &cmnd_reg);

	if (ret == 0) {

		bg_spi->bg_state = BGCOM_STATE_SUSPEND;

		atomic_set(&bg_is_spi_active, 0);

	}

	pr_info("suspended with : %d\n", ret);

	return ret;

}



static int bgcom_pm_resume(struct device *dev)

{

	struct bg_context clnt_handle;

	int ret;

	struct bg_spi_priv *spi =

		container_of(bg_com_drv, struct bg_spi_priv, lhandle);



	clnt_handle.bg_spi = spi;

	atomic_set(&bg_is_spi_active, 1);

	ret = bgcom_resume(&clnt_handle);

	if (ret == 0)

		pr_info("Bgcom resumed\n");

	return ret;

}



static const struct dev_pm_ops bgcom_pm = {

	.suspend = bgcom_pm_suspend,

	.resume = bgcom_pm_resume,

};



static const struct of_device_id bg_spi_of_match[] = {

static const struct of_device_id bg_spi_of_match[] = {

	{ .compatible = "qcom,bg-spi", },

	{ .compatible = "qcom,bg-spi", },

	{ }

	{ }
@@ -1000,6 +1044,7 @@ static struct spi_driver bg_spi_driver = { 
	.driver = {

	.driver = {

		.name = "bg-spi",

		.name = "bg-spi",

		.of_match_table = bg_spi_of_match,

		.of_match_table = bg_spi_of_match,

		.pm = &bgcom_pm,

	},

	},

	.probe = bg_spi_probe,

	.probe = bg_spi_probe,

	.remove = bg_spi_remove,

	.remove = bg_spi_remove,