struct vpfe_ipipe_device *ipipe = v4l2_get_subdevdata(sd);
        unsigned int i;
        int rval = 0;
+       struct ipipe_module_params *params;
 
        for (i = 0; i < ARRAY_SIZE(ipipe_modules); i++) {
                const struct ipipe_module_if *module_if;
-               struct ipipe_module_params *params;
                void *from, *to;
                size_t size;
 
                from = *(void **)((void *)cfg + module_if->config_offset);
 
                params = kmalloc(sizeof(*params), GFP_KERNEL);
+               if (!params)
+                       return -ENOMEM;
                to = (void *)params + module_if->param_offset;
                size = module_if->param_size;
 
                if (to && from && size) {
                        if (copy_from_user(to, (void __user *)from, size)) {
                                rval = -EFAULT;
-                               break;
+                               goto error_free;
                        }
                        rval = module_if->set(ipipe, to);
                        if (rval)
-                               goto error;
+                               goto error_free;
                } else if (to && !from && size) {
                        rval = module_if->set(ipipe, NULL);
                        if (rval)
-                               goto error;
+                               goto error_free;
                }
                kfree(params);
        }
-error:
+       return rval;
+
+error_free:
+       kfree(params);
        return rval;
 }