Camera | 9.如何让camera支持闪光灯？-基于rk3568

一、闪光灯基本原理

工作模式

Camera flash led分flash和torch两种模式。

flash：

拍照时上光灯瞬间亮一下，电流比较大，目前是1000mA，最大电流不能超过led最大承受能力

torch：

只用于录video或者拿led当手电筒的情况，电流不能太大，

flash开启需要先从torch过渡，这样电流可以慢慢增大，减少冲击。

二、驱动移植

1. 硬件电路

sgm3141总体来说比较简单，只有两个引脚用于控制：FLASH_EN、FLASH/TORCH。

FLASH_EN

闪光灯使能引脚。

FLASH/TORCH

此处led flash和TORCH功能共用了同一个gpio。

注意:

有的摄像头是通过pwm来控制闪光灯，具体问题具体分析，不要教条

2. 设备树

瑞芯微sdk中没有专门针对sgm3141的驱动，网上搜了一大圈也没有搜到，很多闪光灯都是基于I2C接口，通过I2C来设置上光灯的工作模式，好在sdk中有类似的芯片rgb13h驱动，该驱动只有一个引脚用于闪光灯，和我们的功能很类似。

参考驱动文件：leds-rgb13h.c

sgm3141设备树节点

       flash_sgm3141:flash-sgm3141 {

               status = "okay";

               compatible = "sgmicro,sgm3141";

               label = "gpio-flash";

               pinctrl-names = "default";

               pinctrl-0 = <&flash_led_gpios>;

               led-max-microamp = <20000>;

               flash-max-microamp = <20000>;

               flash-max-timeout-us = <1000000>;

               strobe-gpios = <&gpio3 RK_PC7 GPIO_ACTIVE_HIGH>;

               enable-gpios = <&gpio3 RK_PD0 GPIO_ACTIVE_HIGH>;

               rockchip,camera-module-index = <0>;

               rockchip,camera-module-facing = "back";

       };

        ov13850: ov13850@10 {

        	……

            flash-leds = <&flash_sgm3141>;

        	……

        };

pinctrl设置：

 &pinctrl {

       ……

       flash-led {

               flash_led_gpios: flash-led {

                       rockchip,pins =

                       /* flash led enable*/

                       <3 RK_PD0 RK_FUNC_GPIO &pcfg_pull_none>,

                       <3 RK_PC6 RK_FUNC_GPIO &pcfg_pull_none>;

               };

       };

       ……

 };

@drivers/leds/Makefile

obj-y                  += sgm3141.o

驱动模块直接写死，不罗嗦

三、xml

要app支持闪光灯，还需要修改xml文件，打开该功能

@hardware/rockchip/camera/etc/camera/camera3_profiles.xml

@hardware/rockchip/camera/etc/camera/camera3_profiles_rk356x.xml

<flash.info.available value="TRUE"/>

这样，打开app就可以看到上光灯的按钮。

四、拓扑结构

拓扑结构中entity

rk3568_r:/ # media-ctl -d /dev/media0 -p

……

- entity 70: m01_f_ov5648 4-0036 (1 pad, 1 link)

             type V4L2 subdev subtype Sensor

             device node name /dev/v4l-subdev3

        pad0: Source

                [fmt:SBGGR10/2592x1944]

                -> "rockchip-csi2-dphy0":0 []

- entity 74: m00_b_ov13850 4-0010 (1 pad, 1 link)

             type V4L2 subdev subtype Sensor

             device node name /dev/v4l-subdev4

        pad0: Source

                [fmt:SBGGR10/4224x3136]

                -> "rockchip-csi2-dphy0":0 []

- entity 78: m00_b_gpio-flash (0 pad, 0 link)

             type V4L2 subdev subtype Flash

             device node name /dev/v4l-subdev5

摄像头：

m00_b_ov13850、m01_f_ov5648

闪光灯：

m00_b_gpio-flash，v4l2子设备/dev/v4l-subdev5

第4个字母b表示后置摄像头。

五、调试

驱动会通过sysfs创建文件节点

rk3568_r:/sys/class/leds/gpio-flash # ls

brightness  flash_strobe   max_brightness     power      trigger

device      flash_timeout  max_flash_timeout  subsystem  uevent

亮灭灯

亮灯

rk3568_r:/sys/class/leds/gpio-flash # echo 1 > brightness

echo 1 > brightness

灭灯

1|rk3568_r:/sys/class/leds/gpio-flash # echo 0 > brightness

echo 0 > brightness

操作对应函数调用关系

[  374.302386] Call trace:

[  374.302428] dump_backtrace+0x0/0x178

[  374.302471] show_stack+0x14/0x20

[  374.302518] dump_stack+0x94/0xb4

[  374.302560] sgm3141_led_brightness_set+0x18/0x40

[  374.302592] led_set_brightness_nopm+0x14/0x48

[  374.302624] led_set_brightness+0x50/0x80

[  374.302662] brightness_store+0x74/0xc8

[  374.302691] dev_attr_store+0x18/0x28

[  374.302728] sysfs_kf_write+0x48/0x58

[  374.302759] kernfs_fop_write+0xf4/0x220

[  374.302793] __vfs_write+0x34/0x158

[  374.302810] vfs_write+0xb0/0x1d0

[  374.302828] ksys_write+0x64/0xe0

[  374.302860] __arm64_sys_write+0x14/0x20

[  374.302904] el0_svc_common.constprop.0+0x64/0x178

[  374.302947] el0_svc_handler+0x28/0x78

[  374.302984] el0_svc+0x8/0xc

[  425.607850] healthd: battery l=50 v=3 t=2.6 h=2 st=3 fc=100 chg=au

[  437.663757] CPU: 3 PID: 1727 Comm: sh Not tainted 4.19.232 #326

[  437.663869] Hardware name: Rockchip RK3568 EVB1 DDR4 V10 Board (DT)

闪灯

rk3568_r:/sys/class/leds/gpio-flash # echo 1 > flash_strobe

echo 1 > flash_strobe

操作对应函数调用关系

[  492.026239] Call trace:

[  492.026291] dump_backtrace+0x0/0x178

[  492.026320] show_stack+0x14/0x20

[  492.026354] dump_stack+0x94/0xb4

[  492.026391] sgm3141_led_flash_strobe_set+0x24/0x78

[  492.026453] flash_strobe_store+0x88/0xd8

[  492.026517] dev_attr_store+0x18/0x28

[  492.026571] sysfs_kf_write+0x48/0x58

[  492.026620] kernfs_fop_write+0xf4/0x220

[  492.026683] __vfs_write+0x34/0x158

[  492.026733] vfs_write+0xb0/0x1d0

[  492.026784] ksys_write+0x64/0xe0

[  492.026833] __arm64_sys_write+0x14/0x20

[  492.026867] el0_svc_common.constprop.0+0x64/0x178

[  492.026912] el0_svc_handler+0x28/0x78

[  492.026966] el0_svc+0x8/0xc

[  494.218112] CPU: 2 PID: 1727 Comm: sh Not tainted 4.19.232 #326

[  494.218218] Hardware name: Rockchip RK3568 EVB1 DDR4 V10 Board (DT)

为方便查看驱动回调函数调用顺序，可以在下面3个回调函数入口增加dump_stack()，

sgm3141_led_brightness_set()

sgm3141_led_flash_strobe_set()

sgm3141_set_ctrl()

六、app 测试驱动 log分析

1. 上电加载驱动log

rk3568_r:/ # dmesg | grep sgm3141

dmesg | grep sgm3141

[    0.853883] sgm3141-flash flash-sgm3141: driver version: 00.01.01

[    0.853956] sgm3141-flash flash-sgm3141: Unable to get pwm device

2. 打开摄像头

打开摄像头功能，app调用ioctl命令如下：

V4L2_CID_FLASH_LED_MODE ：app 设置led mode为 V4L2_FLASH_LED_MODE_FLASH(1)
V4L2_CID_FLASH_TIMEOUT ：设置超时时间
V4L2_CID_FLASH_STROBE_STOP ：停止闪光

[   36.213220] sgm3141 V4L2_CID_FLASH_LED_MODE 1

[   36.213250] sgm3141_set_ctrl(),376

[   36.213256] sgm3141_set_output(),78 0

[   36.213265] sgm3141_led_flash_strobe_set(),166 state=1

[   36.213281] sgm3141_set_output(),78 1

[   36.213298] sgm3141 V4L2_CID_FLASH_TIMEOUT

[   36.213300] sgm3141_set_ctrl(),412

[   36.213308] sgm3141_led_flash_timeout_set(),195 timeout=500000

[   36.213318] sgm3141 V4L2_CID_FLASH_STROBE_STOP 1

[   36.213323] sgm3141_set_ctrl(),406

[   36.213327] sgm3141_led_flash_strobe_set(),166 state=0

[   36.213332] sgm3141_set_output(),78 0

[   36.213461] sgm3141_timeout_work(),117

3. 拍照

拍照功能，app调用ioctl命令如下：

V4L2_CID_FLASH_LED_MODE ：设置led mod为 V4L2_FLASH_LED_MODE_TORCH(2),并点灯
V4L2_CID_FLASH_LED_MODE：到达指定超时时间（2.7秒），设置led mod为 V4L2_FLASH_LED_MODE_NONE 0
V4L2_CID_FLASH_LED_MODE：在此设置led mod为V4L2_FLASH_LED_MODE_FLASH(1)
V4L2_CID_FLASH_STROBE_STOP:停止闪光



[   90.246203] sgm3141 V4L2_CID_FLASH_LED_MODE 2

[   90.246251] sgm3141_set_ctrl(),376

[   90.246262] sgm3141_set_output(),78 0

[   90.246277] sgm3141_set_output(),78 1

[   92.902746] sgm3141 V4L2_CID_FLASH_LED_MODE 0

[   92.902775] sgm3141_set_ctrl(),376

[   92.902781] sgm3141_set_output(),78 0

[   93.034903] sgm3141 V4L2_CID_FLASH_LED_MODE 1

[   93.034929] sgm3141_set_ctrl(),376

[   93.034934] sgm3141_set_output(),78 0

[   93.034943] sgm3141_led_flash_strobe_set(),166 state=1

[   93.034959] sgm3141_set_output(),78 1

[   93.034977] sgm3141 V4L2_CID_FLASH_STROBE_STOP 1

[   93.034988] sgm3141_set_ctrl(),406

[   93.034993] sgm3141_led_flash_strobe_set(),166 state=0

[   93.035002] sgm3141_set_output(),78 0

[   93.035058] sgm3141_timeout_work(),117

从log可以看出，app拍照的时候，闪光灯操作是通过v4l2下发的命令，

而我们直接操作宏dev_attr_store创建的文件节点则是通过在sysfs文件节点（brightness flash_strobe）直接调用到操作函数。

4. 退出摄像头

[  317.882459] sgm3141 V4L2_CID_FLASH_LED_MODE 0

[  317.882522] sgm3141_set_ctrl(),376

[  317.882532] sgm3141_set_output(),78 0

七、驱动获取

一口君修改过的驱动已经上传到gitee，获取地址：

https://gitee.com/yikoulinux/sgm3141

交流嵌入式底层开发技术，后台留言，加一口君好友。