[media] V4L: mx2_camera: .try_fmt shouldn't fail

If the user is requesting too large a frame, instead of failing
select an acceptable geometry, preserving the requested aspect ratio.

Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 10 insertions, 5 deletions

diff --git a/drivers/media/video/mx2_camera.c b/drivers/media/video/mx2_camera.c
index e05e80090959..55d48442c2eb 100644
--- a/drivers/media/video/mx2_camera.c
+++ b/drivers/media/video/mx2_camera.c
@@ -973,11 +973,16 @@ static int mx2_camera_try_fmt(struct soc_camera_device *icd,
                 if (pix->bytesperline < 0)
                         return pix->bytesperline;
                 pix->sizeimage = pix->height * pix->bytesperline;
-                if (pix->sizeimage > (4 * 0x3ffff)) { /* CSIRXCNT limit */
-                        dev_warn(icd->dev.parent,
-                                        "Image size (%u) above limit\n",
-                                        pix->sizeimage);
-                        return -EINVAL;
+                /* Check against the CSIRXCNT limit */
+                if (pix->sizeimage > 4 * 0x3ffff) {
+                        /* Adjust geometry, preserve aspect ratio */
+                        unsigned int new_height = int_sqrt(4 * 0x3ffff *
+                                        pix->height / pix->bytesperline);
+                        pix->width = new_height * pix->width / pix->height;
+                        pix->height = new_height;
+                        pix->bytesperline = soc_mbus_bytes_per_line(pix->width,
+                                                        xlate->host_fmt);
+                        BUG_ON(pix->bytesperline < 0);
                 }
         }