{
        struct dsi_data *dsi = to_dsi_data(dssdev);
        struct dsi_clk_calc_ctx ctx;
+       struct omap_dss_dsi_config cfg = *config;
        bool ok;
        int r;
 
        mutex_lock(&dsi->lock);
 
-       dsi->pix_fmt = config->pixel_format;
-       dsi->mode = config->mode;
+       cfg.mode = dsi->mode;
+       cfg.pixel_format = dsi->pix_fmt;
 
-       if (mipi_dsi_pixel_format_to_bpp(dsi->pix_fmt) < 0) {
-               DSSERR("invalid pixel format\n");
-               r = -EINVAL;
-               goto err;
-       }
-
-       if (config->mode == OMAP_DSS_DSI_VIDEO_MODE)
-               ok = dsi_vm_calc(dsi, config, &ctx);
+       if (dsi->mode == OMAP_DSS_DSI_VIDEO_MODE)
+               ok = dsi_vm_calc(dsi, &cfg, &ctx);
        else
-               ok = dsi_cm_calc(dsi, config, &ctx);
+               ok = dsi_cm_calc(dsi, &cfg, &ctx);
 
        if (!ok) {
                DSSERR("failed to find suitable DSI clock settings\n");
        dsi_pll_calc_dsi_fck(dsi, &ctx.dsi_cinfo);
 
        r = dsi_lp_clock_calc(ctx.dsi_cinfo.clkout[HSDIV_DSI],
-               config->lp_clk_min, config->lp_clk_max, &dsi->user_lp_cinfo);
+               cfg.lp_clk_min, cfg.lp_clk_max, &dsi->user_lp_cinfo);
        if (r) {
                DSSERR("failed to find suitable DSI LP clock settings\n");
                goto err;
                return -EBUSY;
        }
 
+       if (mipi_dsi_pixel_format_to_bpp(client->format) < 0) {
+               DSSERR("invalid pixel format\n");
+               return -EINVAL;
+       }
+
        dsi->vc[channel].dest = client;
+
+       dsi->pix_fmt = client->format;
+       if (client->mode_flags & MIPI_DSI_MODE_VIDEO)
+               dsi->mode = OMAP_DSS_DSI_VIDEO_MODE;
+       else
+               dsi->mode = OMAP_DSS_DSI_CMD_MODE;
+
        return 0;
 }