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

Commit 9a3795ef authored by Viswanadha Raju Thotakura's avatar Viswanadha Raju Thotakura Committed by Gerrit - the friendly Code Review server
Browse files

msm: camera: Enable support for CCI driver 



Add support for CCI driver to interface to I2C
based camera devices.

CRs-Fixed: 2015567
Change-Id: Ia69c1f339278bb7fce85c6c15787a764afc1e872
Signed-off-by: default avatarViswanadha Raju Thotakura <viswanad@codeaurora.org>
parent 426ec66c

drivers/media/platform/msm/camera/cam_sensor_module/Makefile

+1 −0
Original line number Diff line number Diff line 
obj-$(CONFIG_SPECTRA_CAMERA) += cam_sensor_utils/

obj-$(CONFIG_SPECTRA_CAMERA) += cam_cci/
 
 No newline at end of file

drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/Makefile

0 → 100644
+7 −0
Original line number Diff line number Diff line 
ccflags-y += -Idrivers/media/platform/msm/camera/cam_utils

ccflags-y += -Idrivers/media/platform/msm/camera/cam_cpas/include

ccflags-y += -Idrivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_io

ccflags-y += -Idrivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils

ccflags-y += -Idrivers/media/platform/msm/camera/cam_req_mgr



obj-$(CONFIG_SPECTRA_CAMERA) += cam_cci_dev.o cam_cci_core.o cam_cci_soc.o

drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.c

0 → 100644
+1303 −0

File added.

Preview size limit exceeded, changes collapsed.

drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.h

0 → 100644
+46 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2017, The Linux Foundation. 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 and

 * only 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.

 */

#ifndef _CAM_CCI_CORE_H_

#define _CAM_CCI_CORE_H_



#include <linux/irqreturn.h>

#include <media/cam_sensor.h>

#include "cam_cci_dev.h"

#include "cam_cci_soc.h"



/**

 * @cci_dev: CCI device structure

 * @c_ctrl: CCI control structure

 *

 * This API gets CCI clk rates

 */

uint32_t *cam_cci_get_clk_rates(struct cci_device *cci_dev,

	struct cam_cci_ctrl *c_ctrl);



/**

 * @sd: V4L2 sub device

 * @c_ctrl: CCI control structure

 *

 * This API handles I2C operations for CCI

 */

int32_t cam_cci_core_cfg(struct v4l2_subdev *sd,

	struct cam_cci_ctrl *cci_ctrl);



/**

 * @irq_num: IRQ number

 * @data: CCI private structure

 *

 * This API handles CCI IRQs

 */

irqreturn_t cam_cci_irq(int irq_num, void *data);



#endif /* _CAM_CCI_CORE_H_ */

drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.c

0 → 100644
+276 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2017, The Linux Foundation. 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 and

 * only 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 "cam_cci_dev.h"

#include "cam_req_mgr_dev.h"

#include "cam_cci_soc.h"

#include "cam_cci_core.h"



#define CCI_MAX_DELAY 1000000

#define CCI_TIMEOUT msecs_to_jiffies(500)



static struct v4l2_subdev *g_cci_subdev;



struct v4l2_subdev *cam_cci_get_subdev(void)

{

	return g_cci_subdev;

}



static long cam_cci_subdev_ioctl(struct v4l2_subdev *sd,

	unsigned int cmd, void *arg)

{

	int32_t rc = 0;



	switch (cmd) {

	case VIDIOC_MSM_CCI_CFG:

		rc = cam_cci_core_cfg(sd, arg);

		break;

	default:

		pr_err("%s:%d Invalid ioctl cmd: %d\n",

			__func__, __LINE__, cmd);

		rc = -ENOIOCTLCMD;

	}



	return rc;

}



irqreturn_t cam_cci_irq(int irq_num, void *data)

{

	uint32_t irq;

	struct cci_device *cci_dev = data;



	irq = cam_io_r_mb(cci_dev->base + CCI_IRQ_STATUS_0_ADDR);

	cam_io_w_mb(irq, cci_dev->base + CCI_IRQ_CLEAR_0_ADDR);

	cam_io_w_mb(0x1, cci_dev->base + CCI_IRQ_GLOBAL_CLEAR_CMD_ADDR);



	if (irq & CCI_IRQ_STATUS_0_RST_DONE_ACK_BMSK) {

		if (cci_dev->cci_master_info[MASTER_0].reset_pending == TRUE) {

			cci_dev->cci_master_info[MASTER_0].reset_pending =

				FALSE;

			complete(&cci_dev->cci_master_info[MASTER_0].

				reset_complete);

		}

		if (cci_dev->cci_master_info[MASTER_1].reset_pending == TRUE) {

			cci_dev->cci_master_info[MASTER_1].reset_pending =

				FALSE;

			complete(&cci_dev->cci_master_info[MASTER_1].

				reset_complete);

		}

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M0_RD_DONE_BMSK) {

		cci_dev->cci_master_info[MASTER_0].status = 0;

		complete(&cci_dev->cci_master_info[MASTER_0].reset_complete);

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M0_Q0_REPORT_BMSK) {

		struct cam_cci_master_info *cci_master_info;



		cci_master_info = &cci_dev->cci_master_info[MASTER_0];

		atomic_set(&cci_master_info->q_free[QUEUE_0], 0);

		cci_master_info->status = 0;

		if (atomic_read(&cci_master_info->done_pending[QUEUE_0]) == 1) {

			complete(&cci_master_info->report_q[QUEUE_0]);

			atomic_set(&cci_master_info->done_pending[QUEUE_0], 0);

		}

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M0_Q1_REPORT_BMSK) {

		struct cam_cci_master_info *cci_master_info;



		cci_master_info = &cci_dev->cci_master_info[MASTER_0];

		atomic_set(&cci_master_info->q_free[QUEUE_1], 0);

		cci_master_info->status = 0;

		if (atomic_read(&cci_master_info->done_pending[QUEUE_1]) == 1) {

			complete(&cci_master_info->report_q[QUEUE_1]);

			atomic_set(&cci_master_info->done_pending[QUEUE_1], 0);

		}

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M1_RD_DONE_BMSK) {

		cci_dev->cci_master_info[MASTER_1].status = 0;

		complete(&cci_dev->cci_master_info[MASTER_1].reset_complete);

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M1_Q0_REPORT_BMSK) {

		struct cam_cci_master_info *cci_master_info;



		cci_master_info = &cci_dev->cci_master_info[MASTER_1];

		atomic_set(&cci_master_info->q_free[QUEUE_0], 0);

		cci_master_info->status = 0;

		if (atomic_read(&cci_master_info->done_pending[QUEUE_0]) == 1) {

			complete(&cci_master_info->report_q[QUEUE_0]);

			atomic_set(&cci_master_info->done_pending[QUEUE_0], 0);

		}

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M1_Q1_REPORT_BMSK) {

		struct cam_cci_master_info *cci_master_info;



		cci_master_info = &cci_dev->cci_master_info[MASTER_1];

		atomic_set(&cci_master_info->q_free[QUEUE_1], 0);

		cci_master_info->status = 0;

		if (atomic_read(&cci_master_info->done_pending[QUEUE_1]) == 1) {

			complete(&cci_master_info->report_q[QUEUE_1]);

			atomic_set(&cci_master_info->done_pending[QUEUE_1], 0);

		}

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M0_Q0Q1_HALT_ACK_BMSK) {

		cci_dev->cci_master_info[MASTER_0].reset_pending = TRUE;

		cam_io_w_mb(CCI_M0_RESET_RMSK,

			cci_dev->base + CCI_RESET_CMD_ADDR);

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M1_Q0Q1_HALT_ACK_BMSK) {

		cci_dev->cci_master_info[MASTER_1].reset_pending = TRUE;

		cam_io_w_mb(CCI_M1_RESET_RMSK,

			cci_dev->base + CCI_RESET_CMD_ADDR);

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M0_ERROR_BMSK) {

		pr_err("%s:%d MASTER_0 error 0x%x\n", __func__, __LINE__, irq);

		cci_dev->cci_master_info[MASTER_0].status = -EINVAL;

		cam_io_w_mb(CCI_M0_HALT_REQ_RMSK,

			cci_dev->base + CCI_HALT_REQ_ADDR);

	}

	if (irq & CCI_IRQ_STATUS_0_I2C_M1_ERROR_BMSK) {

		pr_err("%s:%d MASTER_1 error 0x%x\n", __func__, __LINE__, irq);

		cci_dev->cci_master_info[MASTER_1].status = -EINVAL;

		cam_io_w_mb(CCI_M1_HALT_REQ_RMSK,

			cci_dev->base + CCI_HALT_REQ_ADDR);

	}

	return IRQ_HANDLED;

}



static int cam_cci_irq_routine(struct v4l2_subdev *sd, u32 status,

	bool *handled)

{

	struct cci_device *cci_dev = v4l2_get_subdevdata(sd);

	irqreturn_t ret;



	ret = cam_cci_irq(cci_dev->irq->start, cci_dev);

	*handled = TRUE;

	return 0;

}



static struct v4l2_subdev_core_ops cci_subdev_core_ops = {

	.ioctl = cam_cci_subdev_ioctl,

	.interrupt_service_routine = cam_cci_irq_routine,

};



static const struct v4l2_subdev_ops cci_subdev_ops = {

	.core = &cci_subdev_core_ops,

};



static const struct v4l2_subdev_internal_ops cci_subdev_intern_ops;



static int cam_cci_platform_probe(struct platform_device *pdev)

{

	struct cam_cpas_register_params cpas_parms;

	struct cci_device *new_cci_dev;

	int rc = 0;



	new_cci_dev = kzalloc(sizeof(struct cci_device),

		GFP_KERNEL);

	if (!new_cci_dev)

		return -ENOMEM;



	new_cci_dev->v4l2_dev_str.pdev = pdev;



	rc = cam_cci_parse_dt_info(pdev, new_cci_dev);

	if (rc < 0) {

		pr_err("%s: %d Resource get Failed: %d\n",

			__func__, __LINE__, rc);

		goto cci_no_resource;

	}



	new_cci_dev->v4l2_dev_str.internal_ops =

		&cci_subdev_intern_ops;

	new_cci_dev->v4l2_dev_str.ops =

		&cci_subdev_ops;

	strlcpy(new_cci_dev->device_name, CAMX_CCI_DEV_NAME,

		sizeof(new_cci_dev->device_name));

	new_cci_dev->v4l2_dev_str.name =

		new_cci_dev->device_name;

	new_cci_dev->v4l2_dev_str.sd_flags =

		(V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS);

	new_cci_dev->v4l2_dev_str.ent_function =

		CAM_CCI_DEVICE_TYPE;

	new_cci_dev->v4l2_dev_str.token =

		new_cci_dev;



	rc = cam_register_subdev(&(new_cci_dev->v4l2_dev_str));

	if (rc < 0) {

		pr_err("%s:%d :Error: Fail with cam_register_subdev\n",

			__func__, __LINE__);

		goto cci_no_resource;

	}



	platform_set_drvdata(pdev, &(new_cci_dev->v4l2_dev_str.sd));

	v4l2_set_subdevdata(&new_cci_dev->v4l2_dev_str.sd, new_cci_dev);

	g_cci_subdev = &new_cci_dev->v4l2_dev_str.sd;



	cpas_parms.cam_cpas_client_cb = NULL;

	cpas_parms.cell_index = 0;

	cpas_parms.dev = &pdev->dev;

	cpas_parms.userdata = new_cci_dev;

	strlcpy(cpas_parms.identifier, "cci", CAM_HW_IDENTIFIER_LENGTH);

	rc = cam_cpas_register_client(&cpas_parms);

	if (rc) {

		pr_err("%s:%d CPAS registration failed\n", __func__, __LINE__);

		goto cci_no_resource;

	}

	CDBG("CPAS registration successful handle=%d\n",

		cpas_parms.client_handle);

	new_cci_dev->cpas_handle = cpas_parms.client_handle;



	return rc;

cci_no_resource:

	kfree(new_cci_dev);

	return rc;

}



static int cam_cci_device_remove(struct platform_device *pdev)

{

	struct v4l2_subdev *subdev = platform_get_drvdata(pdev);

	struct cci_device *cci_dev =

		v4l2_get_subdevdata(subdev);



	cam_cpas_unregister_client(cci_dev->cpas_handle);

	cam_cci_soc_remove(pdev, cci_dev);

	devm_kfree(&pdev->dev, cci_dev);

	return 0;

}



static const struct of_device_id cam_cci_dt_match[] = {

	{.compatible = "qcom,cci"},

	{}

};



MODULE_DEVICE_TABLE(of, cam_cci_dt_match);



static struct platform_driver cci_driver = {

	.probe = cam_cci_platform_probe,

	.remove = cam_cci_device_remove,

	.driver = {

		.name = CAMX_CCI_DEV_NAME,

		.owner = THIS_MODULE,

		.of_match_table = cam_cci_dt_match,

	},

};



static int __init cam_cci_init_module(void)

{

	return platform_driver_register(&cci_driver);

}



static void __exit cam_cci_exit_module(void)

{

	platform_driver_unregister(&cci_driver);

}



module_init(cam_cci_init_module);

module_exit(cam_cci_exit_module);

MODULE_DESCRIPTION("MSM CCI driver");

MODULE_LICENSE("GPL v2");