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

Commit 16fb67f8 authored by Darshan Kumsi Srinivasa's avatar Darshan Kumsi Srinivasa Committed by Gerrit - the friendly Code Review server
Browse files

camera: flash: add gpio based led flashlight driver 



- Ported camera led gpio based flash driver from kernel 3.10 to
  kernel 4.9 for 8905
- media_entity_pads_init function are change from kernel 3.10 to 4.9
- media entity.function are change from kernel 3.10 to 4.9
- Add proper led_classdev name value as "flashlight" before registering
  led_classdev
- setting " led->cdev.flags |= LED_KEEP_TRIGGER" flags before registering
  led classdev
- call msm_led_torch_create_classdev for led_classdev registration.

Change-Id: Ibaffef4c7f2393108348472213c50339eda1beb8
Signed-off-by: default avatarDarshan Kumsi Srinivasa <darssr@codeaurora.org>
parent bcec8f77

arch/arm64/boot/dts/qcom/msm8905-camera-sensor-skub.dtsi

+0 −1
Original line number Diff line number Diff line
@@ -47,7 +47,6 @@ 
		qcom,torch-seq-val = <1 0>;

		qcom,flash-seq-val = <0 1>;

		qcom,duty-cycle = <0 30>;

		qcom,clk-freq = <0 150000>;

		linux,name = "flashlight";

		linux,default-trigger = "flashlight-trigger";

	};

drivers/media/platform/msm/camera_v2/sensor/flash/Makefile

+3 −0
Original line number Diff line number Diff line
@@ -2,5 +2,8 @@ ccflags-y += -Idrivers/media/platform/msm/camera_v2/sensor/cci 
ccflags-y += -Idrivers/media/platform/msm/camera_v2

ccflags-y += -Idrivers/media/platform/msm/camera_v2/common

ccflags-y += -Idrivers/media/platform/msm/camera_v2/sensor/io

obj-$(CONFIG_MSMB_CAMERA) += msm_led_flash.o

obj-$(CONFIG_MSMB_CAMERA) += msm_led_trigger.o

obj-$(CONFIG_MSMB_CAMERA) += msm_led_torch.o

obj-$(CONFIG_MSMB_CAMERA) += msm_flash.o

obj-$(CONFIG_MSMB_CAMERA) += qm215_gpio_flash.o

drivers/media/platform/msm/camera_v2/sensor/flash/msm_led_flash.c

0 → 100644
+126 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2009-2014, 2020, 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.

 *

 */



#define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__



#include "msm_led_flash.h"



#undef CDBG

#define CDBG(fmt, args...) pr_debug(fmt, ##args)



static struct v4l2_file_operations msm_led_flash_v4l2_subdev_fops;



static long msm_led_flash_subdev_ioctl(struct v4l2_subdev *sd,

	unsigned int cmd, void *arg)

{

	struct msm_led_flash_ctrl_t *fctrl = NULL;



	if (!sd) {

		pr_err("sd NULL\n");

		return -EINVAL;

	}

	fctrl = v4l2_get_subdevdata(sd);

	if (!fctrl) {

		pr_err("fctrl NULL\n");

		return -EINVAL;

	}

	switch (cmd) {

	case VIDIOC_MSM_SENSOR_GET_SUBDEV_ID:

		return fctrl->func_tbl->flash_get_subdev_id(fctrl, arg);

	case VIDIOC_MSM_FLASH_LED_DATA_CFG:

		return fctrl->func_tbl->flash_led_config(fctrl, arg);

	case MSM_SD_NOTIFY_FREEZE:

		return 0;

	case MSM_SD_SHUTDOWN:

		*(int *)arg = MSM_CAMERA_LED_RELEASE;

		return fctrl->func_tbl->flash_led_config(fctrl, arg);

	default:

		pr_err_ratelimited("invalid cmd %d\n", cmd);

		return -ENOIOCTLCMD;

	}

}



static struct v4l2_subdev_core_ops msm_flash_subdev_core_ops = {

	.ioctl = msm_led_flash_subdev_ioctl,

};



static struct v4l2_subdev_ops msm_flash_subdev_ops = {

	.core = &msm_flash_subdev_core_ops,

};



static const struct v4l2_subdev_internal_ops msm_flash_internal_ops;



int32_t msm_led_flash_create_v4lsubdev(struct platform_device *pdev, void *data)

{

	struct msm_led_flash_ctrl_t *fctrl =

		(struct msm_led_flash_ctrl_t *)data;

	CDBG("Enter\n");



	if (!fctrl) {

		pr_err("fctrl NULL\n");

		return -EINVAL;

	}



	/* Initialize sub device */

	v4l2_subdev_init(&fctrl->msm_sd.sd, &msm_flash_subdev_ops);

	v4l2_set_subdevdata(&fctrl->msm_sd.sd, fctrl);



	fctrl->pdev = pdev;

	fctrl->msm_sd.sd.internal_ops = &msm_flash_internal_ops;

	fctrl->msm_sd.sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;

	snprintf(fctrl->msm_sd.sd.name, ARRAY_SIZE(fctrl->msm_sd.sd.name),

		"msm_flash");

	media_entity_pads_init(&fctrl->msm_sd.sd.entity, 0, NULL);

	fctrl->msm_sd.sd.entity.function = MSM_CAMERA_SUBDEV_LED_FLASH;

	fctrl->msm_sd.close_seq = MSM_SD_CLOSE_2ND_CATEGORY | 0x1;

	msm_sd_register(&fctrl->msm_sd);



	msm_led_flash_v4l2_subdev_fops = v4l2_subdev_fops;

#ifdef CONFIG_COMPAT

	msm_led_flash_v4l2_subdev_fops.compat_ioctl32 =

		msm_led_flash_v4l2_subdev_fops.unlocked_ioctl;

#endif

	fctrl->msm_sd.sd.devnode->fops = &msm_led_flash_v4l2_subdev_fops;

	CDBG("probe success\n");

	return 0;

}



int32_t msm_led_i2c_flash_create_v4lsubdev(void *data)

{

	struct msm_led_flash_ctrl_t *fctrl =

		(struct msm_led_flash_ctrl_t *)data;

	CDBG("Enter\n");



	if (!fctrl) {

		pr_err("fctrl NULL\n");

		return -EINVAL;

	}



	/* Initialize sub device */

	v4l2_subdev_init(&fctrl->msm_sd.sd, &msm_flash_subdev_ops);

	v4l2_set_subdevdata(&fctrl->msm_sd.sd, fctrl);



	fctrl->msm_sd.sd.internal_ops = &msm_flash_internal_ops;

	fctrl->msm_sd.sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;

	snprintf(fctrl->msm_sd.sd.name, ARRAY_SIZE(fctrl->msm_sd.sd.name),

		"msm_flash");

	media_entity_pads_init(&fctrl->msm_sd.sd.entity, 0, NULL);

	fctrl->msm_sd.sd.entity.function = MSM_CAMERA_SUBDEV_LED_FLASH;

	msm_sd_register(&fctrl->msm_sd);



	msm_led_flash_v4l2_subdev_fops = v4l2_subdev_fops;

	fctrl->msm_sd.sd.devnode->fops = &msm_led_flash_v4l2_subdev_fops;



	CDBG("probe success\n");

	return 0;

}

drivers/media/platform/msm/camera_v2/sensor/flash/msm_led_flash.h

0 → 100644
+98 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2009-2014, 2020 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 MSM_LED_FLASH_H

#define MSM_LED_FLASH_H



#include <linux/leds.h>

#include <linux/platform_device.h>

#include <media/v4l2-subdev.h>

#include <media/msm_cam_sensor.h>

#include <soc/qcom/camera2.h>

#include "msm_camera_i2c.h"

#include "msm_sd.h"





struct msm_led_flash_ctrl_t;



struct msm_flash_fn_t {

	int32_t (*flash_get_subdev_id)(struct msm_led_flash_ctrl_t *, void *);

	int32_t (*flash_led_config)(struct msm_led_flash_ctrl_t *, void *);

	int32_t (*flash_led_init)(struct msm_led_flash_ctrl_t *);

	int32_t (*flash_led_release)(struct msm_led_flash_ctrl_t *);

	int32_t (*flash_led_off)(struct msm_led_flash_ctrl_t *);

	int32_t (*flash_led_low)(struct msm_led_flash_ctrl_t *);

	int32_t (*flash_led_high)(struct msm_led_flash_ctrl_t *);

};



struct msm_led_flash_reg_t {

	struct msm_camera_i2c_reg_setting *init_setting;

	struct msm_camera_i2c_reg_setting *off_setting;

	struct msm_camera_i2c_reg_setting *release_setting;

	struct msm_camera_i2c_reg_setting *low_setting;

	struct msm_camera_i2c_reg_setting *high_setting;

};



struct msm_led_flash_ctrl_t {

	struct msm_camera_i2c_client *flash_i2c_client;

	struct msm_sd_subdev msm_sd;

	struct platform_device *pdev;

	struct msm_flash_fn_t *func_tbl;

	struct msm_camera_sensor_board_info *flashdata;

	struct msm_led_flash_reg_t *reg_setting;

	/* Flash */

	const char *flash_trigger_name[MAX_LED_TRIGGERS];

	struct led_trigger *flash_trigger[MAX_LED_TRIGGERS];

	uint32_t flash_num_sources;

	uint32_t flash_op_current[MAX_LED_TRIGGERS];

	uint32_t flash_max_current[MAX_LED_TRIGGERS];

	uint32_t flash_max_duration[MAX_LED_TRIGGERS];

	/* Torch */

	const char *torch_trigger_name[MAX_LED_TRIGGERS];

	struct led_trigger *torch_trigger[MAX_LED_TRIGGERS];

	uint32_t torch_num_sources;

	uint32_t torch_op_current[MAX_LED_TRIGGERS];

	uint32_t torch_max_current[MAX_LED_TRIGGERS];



	void *data;

	enum msm_camera_device_type_t flash_device_type;

	enum cci_i2c_master_t cci_i2c_master;

	enum msm_camera_led_config_t led_state;

	uint32_t subdev_id;

	struct msm_pinctrl_info pinctrl_info;

};



int msm_flash_i2c_probe(struct i2c_client *client,

	const struct i2c_device_id *id);



int msm_flash_probe(struct platform_device *pdev, const void *data);



int32_t msm_led_flash_create_v4lsubdev(struct platform_device *pdev,

	void *data);



int32_t msm_led_torch_create_classdev(struct platform_device *pdev,

	void *data);



int32_t msm_led_i2c_flash_create_v4lsubdev(void *data);



int32_t msm_led_i2c_trigger_get_subdev_id(struct msm_led_flash_ctrl_t *fctrl,

	void *arg);



int32_t msm_led_i2c_trigger_config(struct msm_led_flash_ctrl_t *fctrl,

	void *data);



int msm_flash_led_init(struct msm_led_flash_ctrl_t *fctrl);

int msm_flash_led_release(struct msm_led_flash_ctrl_t *fctrl);

int msm_flash_led_off(struct msm_led_flash_ctrl_t *fctrl);

int msm_flash_led_low(struct msm_led_flash_ctrl_t *fctrl);

int msm_flash_led_high(struct msm_led_flash_ctrl_t *fctrl);

#endif

drivers/media/platform/msm/camera_v2/sensor/flash/msm_led_torch.c

0 → 100644
+83 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2013-2014, 2020, 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.

 *

 */



#define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__



#include <linux/module.h>

#include "msm_led_flash.h"



static struct led_trigger *torch_trigger;



static void msm_led_torch_brightness_set(struct led_classdev *led_cdev,

				enum led_brightness value)

{

	if (!torch_trigger) {

		pr_err("No torch trigger found, can't set brightness\n");

		return;

	}



	led_trigger_event(torch_trigger, value);

};



static struct led_classdev msm_torch_led[MAX_LED_TRIGGERS] = {

	{

		.name		= "flashlight",

		.brightness_set	= msm_led_torch_brightness_set,

		.brightness	= LED_OFF,

	},

	{

		.name		= "torch-light1",

		.brightness_set	= msm_led_torch_brightness_set,

		.brightness	= LED_OFF,

	},

	{

		.name		= "torch-light2",

		.brightness_set	= msm_led_torch_brightness_set,

		.brightness	= LED_OFF,

	},

};



int32_t msm_led_torch_create_classdev(struct platform_device *pdev,

				void *data)

{

	int32_t i, rc = 0;

	struct msm_led_flash_ctrl_t *fctrl =

		(struct msm_led_flash_ctrl_t *)data;



	if (!fctrl) {

		pr_err("Invalid fctrl\n");

		return -EINVAL;

	}



	for (i = 0; i < fctrl->torch_num_sources; i++) {

		if (fctrl->torch_trigger[i]) {

			torch_trigger = fctrl->torch_trigger[i];

			msm_torch_led[i].flags |= LED_KEEP_TRIGGER;

			msm_led_torch_brightness_set(&msm_torch_led[i],

				LED_OFF);



			rc = led_classdev_register(&pdev->dev,

				&msm_torch_led[i]);

			if (rc) {

				pr_err("Failed to register %d led dev. rc = %d\n",

						i, rc);

				return rc;

			}

		} else {

			pr_err("Invalid fctrl->torch_trigger[%d]\n", i);

			return -EINVAL;

		}

	}



	return 0;

};