#include <linux/device.h>
 #include <linux/iopoll.h>
+#include <linux/slab.h>
 
 #include "ipu3-css.h"
 #include "ipu3-css-fw.h"
        struct v4l2_rect *const bds = &r[IPU3_CSS_RECT_BDS];
        struct v4l2_rect *const env = &r[IPU3_CSS_RECT_ENVELOPE];
        struct v4l2_rect *const gdc = &r[IPU3_CSS_RECT_GDC];
-       struct imgu_css_queue q[IPU3_CSS_QUEUES];
-       struct v4l2_pix_format_mplane *const in =
-                                       &q[IPU3_CSS_QUEUE_IN].fmt.mpix;
-       struct v4l2_pix_format_mplane *const out =
-                                       &q[IPU3_CSS_QUEUE_OUT].fmt.mpix;
-       struct v4l2_pix_format_mplane *const vf =
-                                       &q[IPU3_CSS_QUEUE_VF].fmt.mpix;
+       struct imgu_css_queue *q;
+       struct v4l2_pix_format_mplane *in, *out, *vf;
        int i, s, ret;
 
+       q = kcalloc(IPU3_CSS_QUEUES, sizeof(struct imgu_css_queue), GFP_KERNEL);
+       if (!q)
+               return -ENOMEM;
+
+       in  = &q[IPU3_CSS_QUEUE_IN].fmt.mpix;
+       out = &q[IPU3_CSS_QUEUE_OUT].fmt.mpix;
+       vf  = &q[IPU3_CSS_QUEUE_VF].fmt.mpix;
+
        /* Adjust all formats, get statistics buffer sizes and formats */
        for (i = 0; i < IPU3_CSS_QUEUES; i++) {
                if (fmts[i])
                                        IPU3_CSS_QUEUE_TO_FLAGS(i))) {
                        dev_notice(css->dev, "can not initialize queue %s\n",
                                   qnames[i]);
-                       return -EINVAL;
+                       ret = -EINVAL;
+                       goto out;
                }
        }
        for (i = 0; i < IPU3_CSS_RECTS; i++) {
        if (!imgu_css_queue_enabled(&q[IPU3_CSS_QUEUE_IN]) ||
            !imgu_css_queue_enabled(&q[IPU3_CSS_QUEUE_OUT])) {
                dev_warn(css->dev, "required queues are disabled\n");
-               return -EINVAL;
+               ret = -EINVAL;
+               goto out;
        }
 
        if (!imgu_css_queue_enabled(&q[IPU3_CSS_QUEUE_OUT])) {
        ret = imgu_css_find_binary(css, pipe, q, r);
        if (ret < 0) {
                dev_err(css->dev, "failed to find suitable binary\n");
-               return -EINVAL;
+               ret = -EINVAL;
+               goto out;
        }
        css->pipes[pipe].bindex = ret;
 
                                                IPU3_CSS_QUEUE_TO_FLAGS(i))) {
                                dev_err(css->dev,
                                        "final resolution adjustment failed\n");
-                               return -EINVAL;
+                               ret = -EINVAL;
+                               goto out;
                        }
                        *fmts[i] = q[i].fmt.mpix;
                }
                 bds->width, bds->height, gdc->width, gdc->height,
                 out->width, out->height, vf->width, vf->height);
 
-       return 0;
+       ret = 0;
+out:
+       kfree(q);
+       return ret;
 }
 
 int imgu_css_fmt_set(struct imgu_css *css,