media: ti-vpe: cal: Iterate over correct number of CAMERARX instances

When performing operations on all CAMERARX instances, code usually
iterates over all cal->phy[] entries and skips the NULL pointers. The
number of available CAMERARX instances is however available through
cal->data->num_csi2_phy. Use it instead.

Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Reviewed-by: Benoit Parrot <bparrot@ti.com>
Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl>
Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
This commit is contained in:
Laurent Pinchart 2020-12-07 00:53:35 +01:00 committed by Mauro Carvalho Chehab
parent 695baaa373
commit 71c1f16ddd
1 changed files with 9 additions and 11 deletions

View File

@ -263,12 +263,9 @@ void cal_quickdump_regs(struct cal_dev *cal)
(__force const void *)cal->base, (__force const void *)cal->base,
resource_size(cal->res), false); resource_size(cal->res), false);
for (i = 0; i < ARRAY_SIZE(cal->phy); ++i) { for (i = 0; i < cal->data->num_csi2_phy; ++i) {
struct cal_camerarx *phy = cal->phy[i]; struct cal_camerarx *phy = cal->phy[i];
if (!phy)
continue;
cal_info(cal, "CSI2 Core %u Registers @ %pa:\n", i, cal_info(cal, "CSI2 Core %u Registers @ %pa:\n", i,
&phy->res->start); &phy->res->start);
print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET, 16, 4, print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET, 16, 4,
@ -464,7 +461,7 @@ static irqreturn_t cal_irq(int irq_cal, void *data)
if (status & CAL_HL_IRQ_OCPO_ERR_MASK) if (status & CAL_HL_IRQ_OCPO_ERR_MASK)
dev_err_ratelimited(cal->dev, "OCPO ERROR\n"); dev_err_ratelimited(cal->dev, "OCPO ERROR\n");
for (i = 0; i < CAL_NUM_CSI2_PORTS; ++i) { for (i = 0; i < cal->data->num_csi2_phy; ++i) {
if (status & CAL_HL_IRQ_CIO_MASK(i)) { if (status & CAL_HL_IRQ_CIO_MASK(i)) {
u32 cio_stat = cal_read(cal, u32 cio_stat = cal_read(cal,
CAL_CSI2_COMPLEXIO_IRQSTATUS(i)); CAL_CSI2_COMPLEXIO_IRQSTATUS(i));
@ -608,13 +605,13 @@ static int cal_async_notifier_register(struct cal_dev *cal)
v4l2_async_notifier_init(&cal->notifier); v4l2_async_notifier_init(&cal->notifier);
cal->notifier.ops = &cal_async_notifier_ops; cal->notifier.ops = &cal_async_notifier_ops;
for (i = 0; i < ARRAY_SIZE(cal->phy); ++i) { for (i = 0; i < cal->data->num_csi2_phy; ++i) {
struct cal_camerarx *phy = cal->phy[i]; struct cal_camerarx *phy = cal->phy[i];
struct cal_v4l2_async_subdev *casd; struct cal_v4l2_async_subdev *casd;
struct v4l2_async_subdev *asd; struct v4l2_async_subdev *asd;
struct fwnode_handle *fwnode; struct fwnode_handle *fwnode;
if (!phy || !phy->sensor_node) if (!phy->sensor_node)
continue; continue;
fwnode = of_fwnode_handle(phy->sensor_node); fwnode = of_fwnode_handle(phy->sensor_node);
@ -997,7 +994,7 @@ error_context:
} }
error_camerarx: error_camerarx:
for (i = 0; i < ARRAY_SIZE(cal->phy); i++) for (i = 0; i < cal->data->num_csi2_phy; i++)
cal_camerarx_destroy(cal->phy[i]); cal_camerarx_destroy(cal->phy[i]);
cal_media_cleanup(cal); cal_media_cleanup(cal);
@ -1026,7 +1023,7 @@ static int cal_remove(struct platform_device *pdev)
cal_media_cleanup(cal); cal_media_cleanup(cal);
for (i = 0; i < ARRAY_SIZE(cal->phy); i++) for (i = 0; i < cal->data->num_csi2_phy; i++)
cal_camerarx_destroy(cal->phy[i]); cal_camerarx_destroy(cal->phy[i]);
pm_runtime_put_sync(&pdev->dev); pm_runtime_put_sync(&pdev->dev);
@ -1038,14 +1035,15 @@ static int cal_remove(struct platform_device *pdev)
static int cal_runtime_resume(struct device *dev) static int cal_runtime_resume(struct device *dev)
{ {
struct cal_dev *cal = dev_get_drvdata(dev); struct cal_dev *cal = dev_get_drvdata(dev);
unsigned int i;
if (cal->data->flags & DRA72_CAL_PRE_ES2_LDO_DISABLE) { if (cal->data->flags & DRA72_CAL_PRE_ES2_LDO_DISABLE) {
/* /*
* Apply errata on both port everytime we (re-)enable * Apply errata on both port everytime we (re-)enable
* the clock * the clock
*/ */
cal_camerarx_i913_errata(cal->phy[0]); for (i = 0; i < cal->data->num_csi2_phy; i++)
cal_camerarx_i913_errata(cal->phy[1]); cal_camerarx_i913_errata(cal->phy[i]);
} }
return 0; return 0;