shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-10 21:07:02 +09:00
Code Issues Packages Projects Releases Wiki Activity

media: rockchip: vicap add shutdown function

Browse Source 
Signed-off-by: Zefa Chen <zefa.chen@rock-chips.com>
Change-Id: I957415449aa3f6efc3832a10cee049135d4c76af
This commit is contained in:
Zefa Chen
2022-04-02 11:06:01 +08:00
parent f4d48b8c25
commit 3435f139fd
3 changed files with 45 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

28
drivers/media/platform/rockchip/cif/hw.c
View File

@@ -1270,6 +1270,33 @@ static int rkcif_plat_remove(struct platform_device *pdev)
return 0; return 0;
} }
static void rkcif_hw_shutdown(struct platform_device *pdev)
{
struct rkcif_hw *cif_hw = platform_get_drvdata(pdev);
struct rkcif_device *cif_dev = NULL;
int i = 0;
if (cif_hw->chip_id == CHIP_RK3588_CIF ||
cif_hw->chip_id == CHIP_RV1106_CIF) {
write_cif_reg(cif_hw->base_addr, 0, 0);
} else {
for (i = 0; i < cif_hw->dev_num; i++) {
cif_dev = cif_hw->cif_dev[i];
if (atomic_read(&cif_dev->pipe.stream_cnt)) {
if (cif_dev->inf_id == RKCIF_MIPI_LVDS)
rkcif_write_register(cif_dev,
CIF_REG_MIPI_LVDS_CTRL,
0);
else
rkcif_write_register(cif_dev,
CIF_REG_DVP_CTRL,
0);
}
}
}
disable_irq(cif_hw->irq);
}
static int __maybe_unused rkcif_runtime_suspend(struct device *dev) static int __maybe_unused rkcif_runtime_suspend(struct device *dev)
{ {
struct rkcif_hw *cif_hw = dev_get_drvdata(dev); struct rkcif_hw *cif_hw = dev_get_drvdata(dev);
@@ -1306,6 +1333,7 @@ static struct platform_driver rkcif_hw_plat_drv = {
}, },
.probe = rkcif_plat_hw_probe, .probe = rkcif_plat_hw_probe,
.remove = rkcif_plat_remove, .remove = rkcif_plat_remove,
.shutdown = rkcif_hw_shutdown,
}; };
static int __init rk_cif_plat_drv_init(void) static int __init rk_cif_plat_drv_init(void)

13
drivers/media/platform/rockchip/cif/mipi-csi2.c
View File

@@ -880,6 +880,7 @@ static int csi2_probe(struct platform_device *pdev)
if (ret < 0) if (ret < 0)
v4l2_err(&csi2->sd, "request csi-intr1 irq failed: %d\n", v4l2_err(&csi2->sd, "request csi-intr1 irq failed: %d\n",
ret); ret);
csi2->irq1 = irq;
} else { } else {
v4l2_err(&csi2->sd, "No found irq csi-intr1\n"); v4l2_err(&csi2->sd, "No found irq csi-intr1\n");
} }
@@ -893,6 +894,7 @@ static int csi2_probe(struct platform_device *pdev)
if (ret < 0) if (ret < 0)
v4l2_err(&csi2->sd, "request csi-intr2 failed: %d\n", v4l2_err(&csi2->sd, "request csi-intr2 failed: %d\n",
ret); ret);
csi2->irq2 = irq;
} else { } else {
v4l2_err(&csi2->sd, "No found irq csi-intr2\n"); v4l2_err(&csi2->sd, "No found irq csi-intr2\n");
} }
@@ -917,6 +919,16 @@ rmmutex:
return ret; return ret;
} }
static void csi2_shutdown(struct platform_device *pdev)
{
struct v4l2_subdev *sd = platform_get_drvdata(pdev);
struct csi2_dev *csi2 = sd_to_dev(sd);
csi2_disable(csi2);
disable_irq(csi2->irq1);
disable_irq(csi2->irq2);
}
static int csi2_remove(struct platform_device *pdev) static int csi2_remove(struct platform_device *pdev)
{ {
struct v4l2_subdev *sd = platform_get_drvdata(pdev); struct v4l2_subdev *sd = platform_get_drvdata(pdev);
@@ -936,6 +948,7 @@ static struct platform_driver csi2_driver = {
}, },
.probe = csi2_probe, .probe = csi2_probe,
.remove = csi2_remove, .remove = csi2_remove,
.shutdown = csi2_shutdown,
}; };
int __init rkcif_csi2_plat_drv_init(void) int __init rkcif_csi2_plat_drv_init(void)

6
drivers/media/platform/rockchip/cif/mipi-csi2.h
View File

@@ -147,8 +147,10 @@ struct csi2_dev {
const struct csi2_match_data *match_data; const struct csi2_match_data *match_data;
int num_sensors; int num_sensors;
atomic_t frm_sync_seq; atomic_t frm_sync_seq;
struct csi2_err_stats err_list[RK_CSI2_ERR_MAX]; struct csi2_err_stats err_list[RK_CSI2_ERR_MAX];
bool is_check_sot_sync; int irq1;
int irq2;
bool is_check_sot_sync;
}; };
u32 rkcif_csi2_get_sof(struct csi2_dev *csi2_dev); u32 rkcif_csi2_get_sof(struct csi2_dev *csi2_dev);