drm/fb-helper: pass physical dimensions to fbdev
[sfrench/cifs-2.6.git] / drivers / gpu / drm / drm_fb_helper.c
index 574af01d3ce94a1cc266d32e3128ab0d0e96c3d6..1b8f013ffa6503ec960cee3bdb9cb7c3fa78d2bc 100644 (file)
@@ -106,11 +106,11 @@ static DEFINE_MUTEX(kernel_fb_helper_lock);
  */
 
 #define drm_fb_helper_for_each_connector(fbh, i__) \
-       for (({ lockdep_assert_held(&(fbh)->dev->mode_config.mutex); }), \
+       for (({ lockdep_assert_held(&(fbh)->lock); }), \
             i__ = 0; i__ < (fbh)->connector_count; i__++)
 
-int drm_fb_helper_add_one_connector(struct drm_fb_helper *fb_helper,
-                                   struct drm_connector *connector)
+static int __drm_fb_helper_add_one_connector(struct drm_fb_helper *fb_helper,
+                                            struct drm_connector *connector)
 {
        struct drm_fb_helper_connector *fb_conn;
        struct drm_fb_helper_connector **temp;
@@ -119,7 +119,7 @@ int drm_fb_helper_add_one_connector(struct drm_fb_helper *fb_helper,
        if (!drm_fbdev_emulation)
                return 0;
 
-       WARN_ON(!mutex_is_locked(&fb_helper->dev->mode_config.mutex));
+       lockdep_assert_held(&fb_helper->lock);
 
        count = fb_helper->connector_count + 1;
 
@@ -141,8 +141,21 @@ int drm_fb_helper_add_one_connector(struct drm_fb_helper *fb_helper,
        drm_connector_get(connector);
        fb_conn->connector = connector;
        fb_helper->connector_info[fb_helper->connector_count++] = fb_conn;
+
        return 0;
 }
+
+int drm_fb_helper_add_one_connector(struct drm_fb_helper *fb_helper,
+                                   struct drm_connector *connector)
+{
+       int err;
+
+       mutex_lock(&fb_helper->lock);
+       err = __drm_fb_helper_add_one_connector(fb_helper, connector);
+       mutex_unlock(&fb_helper->lock);
+
+       return err;
+}
 EXPORT_SYMBOL(drm_fb_helper_add_one_connector);
 
 /**
@@ -169,11 +182,10 @@ int drm_fb_helper_single_add_all_connectors(struct drm_fb_helper *fb_helper)
        if (!drm_fbdev_emulation)
                return 0;
 
-       mutex_lock(&dev->mode_config.mutex);
+       mutex_lock(&fb_helper->lock);
        drm_connector_list_iter_begin(dev, &conn_iter);
        drm_for_each_connector_iter(connector, &conn_iter) {
-               ret = drm_fb_helper_add_one_connector(fb_helper, connector);
-
+               ret = __drm_fb_helper_add_one_connector(fb_helper, connector);
                if (ret)
                        goto fail;
        }
@@ -192,14 +204,14 @@ fail:
        fb_helper->connector_count = 0;
 out:
        drm_connector_list_iter_end(&conn_iter);
-       mutex_unlock(&dev->mode_config.mutex);
+       mutex_unlock(&fb_helper->lock);
 
        return ret;
 }
 EXPORT_SYMBOL(drm_fb_helper_single_add_all_connectors);
 
-int drm_fb_helper_remove_one_connector(struct drm_fb_helper *fb_helper,
-                                      struct drm_connector *connector)
+static int __drm_fb_helper_remove_one_connector(struct drm_fb_helper *fb_helper,
+                                               struct drm_connector *connector)
 {
        struct drm_fb_helper_connector *fb_helper_connector;
        int i, j;
@@ -207,9 +219,9 @@ int drm_fb_helper_remove_one_connector(struct drm_fb_helper *fb_helper,
        if (!drm_fbdev_emulation)
                return 0;
 
-       WARN_ON(!mutex_is_locked(&fb_helper->dev->mode_config.mutex));
+       lockdep_assert_held(&fb_helper->lock);
 
-       for (i = 0; i < fb_helper->connector_count; i++) {
+       drm_fb_helper_for_each_connector(fb_helper, i) {
                if (fb_helper->connector_info[i]->connector == connector)
                        break;
        }
@@ -227,23 +239,19 @@ int drm_fb_helper_remove_one_connector(struct drm_fb_helper *fb_helper,
 
        return 0;
 }
-EXPORT_SYMBOL(drm_fb_helper_remove_one_connector);
 
-static void drm_fb_helper_save_lut_atomic(struct drm_crtc *crtc, struct drm_fb_helper *helper)
+int drm_fb_helper_remove_one_connector(struct drm_fb_helper *fb_helper,
+                                      struct drm_connector *connector)
 {
-       uint16_t *r_base, *g_base, *b_base;
-       int i;
-
-       if (helper->funcs->gamma_get == NULL)
-               return;
+       int err;
 
-       r_base = crtc->gamma_store;
-       g_base = r_base + crtc->gamma_size;
-       b_base = g_base + crtc->gamma_size;
+       mutex_lock(&fb_helper->lock);
+       err = __drm_fb_helper_remove_one_connector(fb_helper, connector);
+       mutex_unlock(&fb_helper->lock);
 
-       for (i = 0; i < crtc->gamma_size; i++)
-               helper->funcs->gamma_get(crtc, &r_base[i], &g_base[i], &b_base[i], i);
+       return err;
 }
+EXPORT_SYMBOL(drm_fb_helper_remove_one_connector);
 
 static void drm_fb_helper_restore_lut_atomic(struct drm_crtc *crtc)
 {
@@ -285,7 +293,6 @@ int drm_fb_helper_debug_enter(struct fb_info *info)
                        if (drm_drv_uses_atomic_modeset(mode_set->crtc->dev))
                                continue;
 
-                       drm_fb_helper_save_lut_atomic(mode_set->crtc, helper);
                        funcs->mode_set_base_atomic(mode_set->crtc,
                                                    mode_set->fb,
                                                    mode_set->x,
@@ -298,20 +305,6 @@ int drm_fb_helper_debug_enter(struct fb_info *info)
 }
 EXPORT_SYMBOL(drm_fb_helper_debug_enter);
 
-/* Find the real fb for a given fb helper CRTC */
-static struct drm_framebuffer *drm_mode_config_fb(struct drm_crtc *crtc)
-{
-       struct drm_device *dev = crtc->dev;
-       struct drm_crtc *c;
-
-       drm_for_each_crtc(c, dev) {
-               if (crtc->base.id == c->base.id)
-                       return c->primary->fb;
-       }
-
-       return NULL;
-}
-
 /**
  * drm_fb_helper_debug_leave - implementation for &fb_ops.fb_debug_leave
  * @info: fbdev registered by the helper
@@ -328,8 +321,11 @@ int drm_fb_helper_debug_leave(struct fb_info *info)
                struct drm_mode_set *mode_set = &helper->crtc_info[i].mode_set;
 
                crtc = mode_set->crtc;
+               if (drm_drv_uses_atomic_modeset(crtc->dev))
+                       continue;
+
                funcs = crtc->helper_private;
-               fb = drm_mode_config_fb(crtc);
+               fb = crtc->primary->fb;
 
                if (!crtc->enabled)
                        continue;
@@ -342,9 +338,6 @@ int drm_fb_helper_debug_leave(struct fb_info *info)
                if (funcs->mode_set_base_atomic == NULL)
                        continue;
 
-               if (drm_drv_uses_atomic_modeset(crtc->dev))
-                       continue;
-
                drm_fb_helper_restore_lut_atomic(mode_set->crtc);
                funcs->mode_set_base_atomic(mode_set->crtc, fb, crtc->x,
                                            crtc->y, LEAVE_ATOMIC_MODE_SET);
@@ -354,19 +347,24 @@ int drm_fb_helper_debug_leave(struct fb_info *info)
 }
 EXPORT_SYMBOL(drm_fb_helper_debug_leave);
 
-static int restore_fbdev_mode_atomic(struct drm_fb_helper *fb_helper)
+static int restore_fbdev_mode_atomic(struct drm_fb_helper *fb_helper, bool active)
 {
        struct drm_device *dev = fb_helper->dev;
        struct drm_plane *plane;
        struct drm_atomic_state *state;
        int i, ret;
        unsigned int plane_mask;
+       struct drm_modeset_acquire_ctx ctx;
+
+       drm_modeset_acquire_init(&ctx, 0);
 
        state = drm_atomic_state_alloc(dev);
-       if (!state)
-               return -ENOMEM;
+       if (!state) {
+               ret = -ENOMEM;
+               goto out_ctx;
+       }
 
-       state->acquire_ctx = dev->mode_config.acquire_ctx;
+       state->acquire_ctx = &ctx;
 retry:
        plane_mask = 0;
        drm_for_each_plane(plane, dev) {
@@ -375,7 +373,7 @@ retry:
                plane_state = drm_atomic_get_plane_state(state, plane);
                if (IS_ERR(plane_state)) {
                        ret = PTR_ERR(plane_state);
-                       goto fail;
+                       goto out_state;
                }
 
                plane_state->rotation = DRM_MODE_ROTATE_0;
@@ -389,7 +387,7 @@ retry:
 
                ret = __drm_atomic_helper_disable_plane(plane, plane_state);
                if (ret != 0)
-                       goto fail;
+                       goto out_state;
        }
 
        for (i = 0; i < fb_helper->crtc_count; i++) {
@@ -397,23 +395,38 @@ retry:
 
                ret = __drm_atomic_helper_set_config(mode_set, state);
                if (ret != 0)
-                       goto fail;
+                       goto out_state;
+
+               /*
+                * __drm_atomic_helper_set_config() sets active when a
+                * mode is set, unconditionally clear it if we force DPMS off
+                */
+               if (!active) {
+                       struct drm_crtc *crtc = mode_set->crtc;
+                       struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
+
+                       crtc_state->active = false;
+               }
        }
 
        ret = drm_atomic_commit(state);
 
-fail:
+out_state:
        drm_atomic_clean_old_fb(dev, plane_mask, ret);
 
        if (ret == -EDEADLK)
                goto backoff;
 
        drm_atomic_state_put(state);
+out_ctx:
+       drm_modeset_drop_locks(&ctx);
+       drm_modeset_acquire_fini(&ctx);
+
        return ret;
 
 backoff:
        drm_atomic_state_clear(state);
-       drm_atomic_legacy_backoff(state);
+       drm_modeset_backoff(&ctx);
 
        goto retry;
 }
@@ -422,8 +435,9 @@ static int restore_fbdev_mode_legacy(struct drm_fb_helper *fb_helper)
 {
        struct drm_device *dev = fb_helper->dev;
        struct drm_plane *plane;
-       int i;
+       int i, ret = 0;
 
+       drm_modeset_lock_all(fb_helper->dev);
        drm_for_each_plane(plane, dev) {
                if (plane->type != DRM_PLANE_TYPE_PRIMARY)
                        drm_plane_force_disable(plane);
@@ -437,34 +451,33 @@ static int restore_fbdev_mode_legacy(struct drm_fb_helper *fb_helper)
        for (i = 0; i < fb_helper->crtc_count; i++) {
                struct drm_mode_set *mode_set = &fb_helper->crtc_info[i].mode_set;
                struct drm_crtc *crtc = mode_set->crtc;
-               int ret;
 
                if (crtc->funcs->cursor_set2) {
                        ret = crtc->funcs->cursor_set2(crtc, NULL, 0, 0, 0, 0, 0);
                        if (ret)
-                               return ret;
+                               goto out;
                } else if (crtc->funcs->cursor_set) {
                        ret = crtc->funcs->cursor_set(crtc, NULL, 0, 0, 0);
                        if (ret)
-                               return ret;
+                               goto out;
                }
 
                ret = drm_mode_set_config_internal(mode_set);
                if (ret)
-                       return ret;
+                       goto out;
        }
+out:
+       drm_modeset_unlock_all(fb_helper->dev);
 
-       return 0;
+       return ret;
 }
 
 static int restore_fbdev_mode(struct drm_fb_helper *fb_helper)
 {
        struct drm_device *dev = fb_helper->dev;
 
-       drm_warn_on_modeset_not_all_locked(dev);
-
        if (drm_drv_uses_atomic_modeset(dev))
-               return restore_fbdev_mode_atomic(fb_helper);
+               return restore_fbdev_mode_atomic(fb_helper, true);
        else
                return restore_fbdev_mode_legacy(fb_helper);
 }
@@ -482,23 +495,26 @@ static int restore_fbdev_mode(struct drm_fb_helper *fb_helper)
  */
 int drm_fb_helper_restore_fbdev_mode_unlocked(struct drm_fb_helper *fb_helper)
 {
-       struct drm_device *dev = fb_helper->dev;
        bool do_delayed;
        int ret;
 
        if (!drm_fbdev_emulation)
                return -ENODEV;
 
-       drm_modeset_lock_all(dev);
+       if (READ_ONCE(fb_helper->deferred_setup))
+               return 0;
+
+       mutex_lock(&fb_helper->lock);
        ret = restore_fbdev_mode(fb_helper);
 
        do_delayed = fb_helper->delayed_hotplug;
        if (do_delayed)
                fb_helper->delayed_hotplug = false;
-       drm_modeset_unlock_all(dev);
+       mutex_unlock(&fb_helper->lock);
 
        if (do_delayed)
                drm_fb_helper_hotplug_event(fb_helper);
+
        return ret;
 }
 EXPORT_SYMBOL(drm_fb_helper_restore_fbdev_mode_unlocked);
@@ -517,10 +533,12 @@ static bool drm_fb_helper_is_bound(struct drm_fb_helper *fb_helper)
                return false;
 
        drm_for_each_crtc(crtc, dev) {
+               drm_modeset_lock(&crtc->mutex, NULL);
                if (crtc->primary->fb)
                        crtcs_bound++;
                if (crtc->primary->fb == fb_helper->fb)
                        bound++;
+               drm_modeset_unlock(&crtc->mutex);
        }
 
        if (bound < crtcs_bound)
@@ -548,11 +566,11 @@ static bool drm_fb_helper_force_kernel_mode(void)
                if (dev->switch_power_state == DRM_SWITCH_POWER_OFF)
                        continue;
 
-               drm_modeset_lock_all(dev);
+               mutex_lock(&helper->lock);
                ret = restore_fbdev_mode(helper);
                if (ret)
                        error = true;
-               drm_modeset_unlock_all(dev);
+               mutex_unlock(&helper->lock);
        }
        return error;
 }
@@ -581,23 +599,14 @@ static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = {
 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { };
 #endif
 
-static void drm_fb_helper_dpms(struct fb_info *info, int dpms_mode)
+static void dpms_legacy(struct drm_fb_helper *fb_helper, int dpms_mode)
 {
-       struct drm_fb_helper *fb_helper = info->par;
        struct drm_device *dev = fb_helper->dev;
        struct drm_crtc *crtc;
        struct drm_connector *connector;
        int i, j;
 
-       /*
-        * For each CRTC in this fb, turn the connectors on/off.
-        */
        drm_modeset_lock_all(dev);
-       if (!drm_fb_helper_is_bound(fb_helper)) {
-               drm_modeset_unlock_all(dev);
-               return;
-       }
-
        for (i = 0; i < fb_helper->crtc_count; i++) {
                crtc = fb_helper->crtc_info[i].mode_set.crtc;
 
@@ -615,6 +624,26 @@ static void drm_fb_helper_dpms(struct fb_info *info, int dpms_mode)
        drm_modeset_unlock_all(dev);
 }
 
+static void drm_fb_helper_dpms(struct fb_info *info, int dpms_mode)
+{
+       struct drm_fb_helper *fb_helper = info->par;
+
+       /*
+        * For each CRTC in this fb, turn the connectors on/off.
+        */
+       mutex_lock(&fb_helper->lock);
+       if (!drm_fb_helper_is_bound(fb_helper)) {
+               mutex_unlock(&fb_helper->lock);
+               return;
+       }
+
+       if (drm_drv_uses_atomic_modeset(fb_helper->dev))
+               restore_fbdev_mode_atomic(fb_helper, dpms_mode == DRM_MODE_DPMS_ON);
+       else
+               dpms_legacy(fb_helper, dpms_mode);
+       mutex_unlock(&fb_helper->lock);
+}
+
 /**
  * drm_fb_helper_blank - implementation for &fb_ops.fb_blank
  * @blank: desired blanking state
@@ -734,6 +763,7 @@ void drm_fb_helper_prepare(struct drm_device *dev, struct drm_fb_helper *helper,
        INIT_WORK(&helper->resume_work, drm_fb_helper_resume_worker);
        INIT_WORK(&helper->dirty_work, drm_fb_helper_dirty_work);
        helper->dirty_clip.x1 = helper->dirty_clip.y1 = ~0;
+       mutex_init(&helper->lock);
        helper->funcs = funcs;
        helper->dev = dev;
 }
@@ -899,6 +929,7 @@ void drm_fb_helper_fini(struct drm_fb_helper *fb_helper)
        }
        mutex_unlock(&kernel_fb_helper_lock);
 
+       mutex_destroy(&fb_helper->lock);
        drm_fb_helper_crtc_free(fb_helper);
 
 }
@@ -1167,22 +1198,23 @@ void drm_fb_helper_set_suspend_unlocked(struct drm_fb_helper *fb_helper,
 }
 EXPORT_SYMBOL(drm_fb_helper_set_suspend_unlocked);
 
-static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green,
-                    u16 blue, u16 regno, struct fb_info *info)
+static int setcmap_pseudo_palette(struct fb_cmap *cmap, struct fb_info *info)
 {
-       struct drm_fb_helper *fb_helper = info->par;
-       struct drm_framebuffer *fb = fb_helper->fb;
+       u32 *palette = (u32 *)info->pseudo_palette;
+       int i;
 
-       if (info->fix.visual == FB_VISUAL_TRUECOLOR) {
-               u32 *palette;
+       if (cmap->start + cmap->len > 16)
+               return -EINVAL;
+
+       for (i = 0; i < cmap->len; ++i) {
+               u16 red = cmap->red[i];
+               u16 green = cmap->green[i];
+               u16 blue = cmap->blue[i];
                u32 value;
-               /* place color in psuedopalette */
-               if (regno > 16)
-                       return -EINVAL;
-               palette = (u32 *)info->pseudo_palette;
-               red >>= (16 - info->var.red.length);
-               green >>= (16 - info->var.green.length);
-               blue >>= (16 - info->var.blue.length);
+
+               red >>= 16 - info->var.red.length;
+               green >>= 16 - info->var.green.length;
+               blue >>= 16 - info->var.blue.length;
                value = (red << info->var.red.offset) |
                        (green << info->var.green.offset) |
                        (blue << info->var.blue.offset);
@@ -1192,23 +1224,169 @@ static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green,
                        mask <<= info->var.transp.offset;
                        value |= mask;
                }
-               palette[regno] = value;
-               return 0;
+               palette[cmap->start + i] = value;
        }
 
-       /*
-        * The driver really shouldn't advertise pseudo/directcolor
-        * visuals if it can't deal with the palette.
-        */
-       if (WARN_ON(!fb_helper->funcs->gamma_set ||
-                   !fb_helper->funcs->gamma_get))
-               return -EINVAL;
+       return 0;
+}
+
+static int setcmap_legacy(struct fb_cmap *cmap, struct fb_info *info)
+{
+       struct drm_fb_helper *fb_helper = info->par;
+       struct drm_crtc *crtc;
+       u16 *r, *g, *b;
+       int i, ret = 0;
 
-       WARN_ON(fb->format->cpp[0] != 1);
+       drm_modeset_lock_all(fb_helper->dev);
+       for (i = 0; i < fb_helper->crtc_count; i++) {
+               crtc = fb_helper->crtc_info[i].mode_set.crtc;
+               if (!crtc->funcs->gamma_set || !crtc->gamma_size)
+                       return -EINVAL;
 
-       fb_helper->funcs->gamma_set(crtc, red, green, blue, regno);
+               if (cmap->start + cmap->len > crtc->gamma_size)
+                       return -EINVAL;
 
-       return 0;
+               r = crtc->gamma_store;
+               g = r + crtc->gamma_size;
+               b = g + crtc->gamma_size;
+
+               memcpy(r + cmap->start, cmap->red, cmap->len * sizeof(*r));
+               memcpy(g + cmap->start, cmap->green, cmap->len * sizeof(*g));
+               memcpy(b + cmap->start, cmap->blue, cmap->len * sizeof(*b));
+
+               ret = crtc->funcs->gamma_set(crtc, r, g, b,
+                                            crtc->gamma_size, NULL);
+               if (ret)
+                       return ret;
+       }
+       drm_modeset_unlock_all(fb_helper->dev);
+
+       return ret;
+}
+
+static struct drm_property_blob *setcmap_new_gamma_lut(struct drm_crtc *crtc,
+                                                      struct fb_cmap *cmap)
+{
+       struct drm_device *dev = crtc->dev;
+       struct drm_property_blob *gamma_lut;
+       struct drm_color_lut *lut;
+       int size = crtc->gamma_size;
+       int i;
+
+       if (!size || cmap->start + cmap->len > size)
+               return ERR_PTR(-EINVAL);
+
+       gamma_lut = drm_property_create_blob(dev, sizeof(*lut) * size, NULL);
+       if (IS_ERR(gamma_lut))
+               return gamma_lut;
+
+       lut = (struct drm_color_lut *)gamma_lut->data;
+       if (cmap->start || cmap->len != size) {
+               u16 *r = crtc->gamma_store;
+               u16 *g = r + crtc->gamma_size;
+               u16 *b = g + crtc->gamma_size;
+
+               for (i = 0; i < cmap->start; i++) {
+                       lut[i].red = r[i];
+                       lut[i].green = g[i];
+                       lut[i].blue = b[i];
+               }
+               for (i = cmap->start + cmap->len; i < size; i++) {
+                       lut[i].red = r[i];
+                       lut[i].green = g[i];
+                       lut[i].blue = b[i];
+               }
+       }
+
+       for (i = 0; i < cmap->len; i++) {
+               lut[cmap->start + i].red = cmap->red[i];
+               lut[cmap->start + i].green = cmap->green[i];
+               lut[cmap->start + i].blue = cmap->blue[i];
+       }
+
+       return gamma_lut;
+}
+
+static int setcmap_atomic(struct fb_cmap *cmap, struct fb_info *info)
+{
+       struct drm_fb_helper *fb_helper = info->par;
+       struct drm_device *dev = fb_helper->dev;
+       struct drm_property_blob *gamma_lut = NULL;
+       struct drm_modeset_acquire_ctx ctx;
+       struct drm_crtc_state *crtc_state;
+       struct drm_atomic_state *state;
+       struct drm_crtc *crtc;
+       u16 *r, *g, *b;
+       int i, ret = 0;
+       bool replaced;
+
+       drm_modeset_acquire_init(&ctx, 0);
+
+       state = drm_atomic_state_alloc(dev);
+       if (!state) {
+               ret = -ENOMEM;
+               goto out_ctx;
+       }
+
+       state->acquire_ctx = &ctx;
+retry:
+       for (i = 0; i < fb_helper->crtc_count; i++) {
+               crtc = fb_helper->crtc_info[i].mode_set.crtc;
+
+               if (!gamma_lut)
+                       gamma_lut = setcmap_new_gamma_lut(crtc, cmap);
+               if (IS_ERR(gamma_lut)) {
+                       ret = PTR_ERR(gamma_lut);
+                       gamma_lut = NULL;
+                       goto out_state;
+               }
+
+               crtc_state = drm_atomic_get_crtc_state(state, crtc);
+               if (IS_ERR(crtc_state)) {
+                       ret = PTR_ERR(crtc_state);
+                       goto out_state;
+               }
+
+               replaced  = drm_property_replace_blob(&crtc_state->degamma_lut,
+                                                     NULL);
+               replaced |= drm_property_replace_blob(&crtc_state->ctm, NULL);
+               replaced |= drm_property_replace_blob(&crtc_state->gamma_lut,
+                                                     gamma_lut);
+               crtc_state->color_mgmt_changed |= replaced;
+       }
+
+       ret = drm_atomic_commit(state);
+       if (ret)
+               goto out_state;
+
+       for (i = 0; i < fb_helper->crtc_count; i++) {
+               crtc = fb_helper->crtc_info[i].mode_set.crtc;
+
+               r = crtc->gamma_store;
+               g = r + crtc->gamma_size;
+               b = g + crtc->gamma_size;
+
+               memcpy(r + cmap->start, cmap->red, cmap->len * sizeof(*r));
+               memcpy(g + cmap->start, cmap->green, cmap->len * sizeof(*g));
+               memcpy(b + cmap->start, cmap->blue, cmap->len * sizeof(*b));
+       }
+
+out_state:
+       if (ret == -EDEADLK)
+               goto backoff;
+
+       drm_property_blob_put(gamma_lut);
+       drm_atomic_state_put(state);
+out_ctx:
+       drm_modeset_drop_locks(&ctx);
+       drm_modeset_acquire_fini(&ctx);
+
+       return ret;
+
+backoff:
+       drm_atomic_state_clear(state);
+       drm_modeset_backoff(&ctx);
+       goto retry;
 }
 
 /**
@@ -1219,52 +1397,29 @@ static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green,
 int drm_fb_helper_setcmap(struct fb_cmap *cmap, struct fb_info *info)
 {
        struct drm_fb_helper *fb_helper = info->par;
-       struct drm_device *dev = fb_helper->dev;
-       const struct drm_crtc_helper_funcs *crtc_funcs;
-       u16 *red, *green, *blue, *transp;
-       struct drm_crtc *crtc;
-       int i, j, rc = 0;
-       int start;
+       int ret;
 
        if (oops_in_progress)
                return -EBUSY;
 
-       drm_modeset_lock_all(dev);
+       mutex_lock(&fb_helper->lock);
+
        if (!drm_fb_helper_is_bound(fb_helper)) {
-               drm_modeset_unlock_all(dev);
-               return -EBUSY;
+               ret = -EBUSY;
+               goto out;
        }
 
-       for (i = 0; i < fb_helper->crtc_count; i++) {
-               crtc = fb_helper->crtc_info[i].mode_set.crtc;
-               crtc_funcs = crtc->helper_private;
-
-               red = cmap->red;
-               green = cmap->green;
-               blue = cmap->blue;
-               transp = cmap->transp;
-               start = cmap->start;
-
-               for (j = 0; j < cmap->len; j++) {
-                       u16 hred, hgreen, hblue, htransp = 0xffff;
-
-                       hred = *red++;
-                       hgreen = *green++;
-                       hblue = *blue++;
+       if (info->fix.visual == FB_VISUAL_TRUECOLOR)
+               ret = setcmap_pseudo_palette(cmap, info);
+       else if (drm_drv_uses_atomic_modeset(fb_helper->dev))
+               ret = setcmap_atomic(cmap, info);
+       else
+               ret = setcmap_legacy(cmap, info);
 
-                       if (transp)
-                               htransp = *transp++;
+out:
+       mutex_unlock(&fb_helper->lock);
 
-                       rc = setcolreg(crtc, hred, hgreen, hblue, start++, info);
-                       if (rc)
-                               goto out;
-               }
-               if (crtc_funcs->load_lut)
-                       crtc_funcs->load_lut(crtc);
-       }
- out:
-       drm_modeset_unlock_all(dev);
-       return rc;
+       return ret;
 }
 EXPORT_SYMBOL(drm_fb_helper_setcmap);
 
@@ -1281,12 +1436,11 @@ int drm_fb_helper_ioctl(struct fb_info *info, unsigned int cmd,
                        unsigned long arg)
 {
        struct drm_fb_helper *fb_helper = info->par;
-       struct drm_device *dev = fb_helper->dev;
        struct drm_mode_set *mode_set;
        struct drm_crtc *crtc;
        int ret = 0;
 
-       mutex_lock(&dev->mode_config.mutex);
+       mutex_lock(&fb_helper->lock);
        if (!drm_fb_helper_is_bound(fb_helper)) {
                ret = -EBUSY;
                goto unlock;
@@ -1331,7 +1485,7 @@ int drm_fb_helper_ioctl(struct fb_info *info, unsigned int cmd,
        }
 
 unlock:
-       mutex_unlock(&dev->mode_config.mutex);
+       mutex_unlock(&fb_helper->lock);
        return ret;
 }
 EXPORT_SYMBOL(drm_fb_helper_ioctl);
@@ -1463,61 +1617,36 @@ int drm_fb_helper_set_par(struct fb_info *info)
 }
 EXPORT_SYMBOL(drm_fb_helper_set_par);
 
-static int pan_display_atomic(struct fb_var_screeninfo *var,
-                             struct fb_info *info)
+static void pan_set(struct drm_fb_helper *fb_helper, int x, int y)
 {
-       struct drm_fb_helper *fb_helper = info->par;
-       struct drm_device *dev = fb_helper->dev;
-       struct drm_atomic_state *state;
-       struct drm_plane *plane;
-       int i, ret;
-       unsigned int plane_mask;
-
-       state = drm_atomic_state_alloc(dev);
-       if (!state)
-               return -ENOMEM;
+       int i;
 
-       state->acquire_ctx = dev->mode_config.acquire_ctx;
-retry:
-       plane_mask = 0;
        for (i = 0; i < fb_helper->crtc_count; i++) {
                struct drm_mode_set *mode_set;
 
                mode_set = &fb_helper->crtc_info[i].mode_set;
 
-               mode_set->x = var->xoffset;
-               mode_set->y = var->yoffset;
-
-               ret = __drm_atomic_helper_set_config(mode_set, state);
-               if (ret != 0)
-                       goto fail;
-
-               plane = mode_set->crtc->primary;
-               plane_mask |= (1 << drm_plane_index(plane));
-               plane->old_fb = plane->fb;
+               mode_set->x = x;
+               mode_set->y = y;
        }
+}
 
-       ret = drm_atomic_commit(state);
-       if (ret != 0)
-               goto fail;
+static int pan_display_atomic(struct fb_var_screeninfo *var,
+                             struct fb_info *info)
+{
+       struct drm_fb_helper *fb_helper = info->par;
+       int ret;
 
-       info->var.xoffset = var->xoffset;
-       info->var.yoffset = var->yoffset;
+       pan_set(fb_helper, var->xoffset, var->yoffset);
 
-fail:
-       drm_atomic_clean_old_fb(dev, plane_mask, ret);
+       ret = restore_fbdev_mode_atomic(fb_helper, true);
+       if (!ret) {
+               info->var.xoffset = var->xoffset;
+               info->var.yoffset = var->yoffset;
+       } else
+               pan_set(fb_helper, info->var.xoffset, info->var.yoffset);
 
-       if (ret == -EDEADLK)
-               goto backoff;
-
-       drm_atomic_state_put(state);
        return ret;
-
-backoff:
-       drm_atomic_state_clear(state);
-       drm_atomic_legacy_backoff(state);
-
-       goto retry;
 }
 
 static int pan_display_legacy(struct fb_var_screeninfo *var,
@@ -1528,6 +1657,7 @@ static int pan_display_legacy(struct fb_var_screeninfo *var,
        int ret = 0;
        int i;
 
+       drm_modeset_lock_all(fb_helper->dev);
        for (i = 0; i < fb_helper->crtc_count; i++) {
                modeset = &fb_helper->crtc_info[i].mode_set;
 
@@ -1542,6 +1672,7 @@ static int pan_display_legacy(struct fb_var_screeninfo *var,
                        }
                }
        }
+       drm_modeset_unlock_all(fb_helper->dev);
 
        return ret;
 }
@@ -1561,9 +1692,9 @@ int drm_fb_helper_pan_display(struct fb_var_screeninfo *var,
        if (oops_in_progress)
                return -EBUSY;
 
-       drm_modeset_lock_all(dev);
+       mutex_lock(&fb_helper->lock);
        if (!drm_fb_helper_is_bound(fb_helper)) {
-               drm_modeset_unlock_all(dev);
+               mutex_unlock(&fb_helper->lock);
                return -EBUSY;
        }
 
@@ -1571,7 +1702,7 @@ int drm_fb_helper_pan_display(struct fb_var_screeninfo *var,
                ret = pan_display_atomic(var, info);
        else
                ret = pan_display_legacy(var, info);
-       drm_modeset_unlock_all(dev);
+       mutex_unlock(&fb_helper->lock);
 
        return ret;
 }
@@ -1579,8 +1710,7 @@ EXPORT_SYMBOL(drm_fb_helper_pan_display);
 
 /*
  * Allocates the backing storage and sets up the fbdev info structure through
- * the ->fb_probe callback and then registers the fbdev and sets up the panic
- * notifier.
+ * the ->fb_probe callback.
  */
 static int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper,
                                         int preferred_bpp)
@@ -1678,13 +1808,8 @@ static int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper,
        }
 
        if (crtc_count == 0 || sizes.fb_width == -1 || sizes.fb_height == -1) {
-               /*
-                * hmm everyone went away - assume VGA cable just fell out
-                * and will come back later.
-                */
-               DRM_INFO("Cannot find any crtc or sizes - going 1024x768\n");
-               sizes.fb_width = sizes.surface_width = 1024;
-               sizes.fb_height = sizes.surface_height = 768;
+               DRM_INFO("Cannot find any crtc or sizes\n");
+               return -EAGAIN;
        }
 
        /* Handle our overallocation */
@@ -1696,17 +1821,6 @@ static int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper,
        if (ret < 0)
                return ret;
 
-       /*
-        * Set the fb pointer - usually drm_setup_crtcs does this for hotplug
-        * events, but at init time drm_setup_crtcs needs to be called before
-        * the fb is allocated (since we need to figure out the desired size of
-        * the fb before we can allocate it ...). Hence we need to fix things up
-        * here again.
-        */
-       for (i = 0; i < fb_helper->crtc_count; i++)
-               if (fb_helper->crtc_info[i].mode_set.num_connectors)
-                       fb_helper->crtc_info[i].mode_set.fb = fb_helper->fb;
-
        return 0;
 }
 
@@ -1768,8 +1882,6 @@ void drm_fb_helper_fill_var(struct fb_info *info, struct drm_fb_helper *fb_helpe
        info->var.xoffset = 0;
        info->var.yoffset = 0;
        info->var.activate = FB_ACTIVATE_NOW;
-       info->var.height = -1;
-       info->var.width = -1;
 
        switch (fb->format->depth) {
        case 8:
@@ -1831,12 +1943,11 @@ void drm_fb_helper_fill_var(struct fb_info *info, struct drm_fb_helper *fb_helpe
 EXPORT_SYMBOL(drm_fb_helper_fill_var);
 
 static int drm_fb_helper_probe_connector_modes(struct drm_fb_helper *fb_helper,
-                                              uint32_t maxX,
-                                              uint32_t maxY)
+                                               uint32_t maxX,
+                                               uint32_t maxY)
 {
        struct drm_connector *connector;
-       int count = 0;
-       int i;
+       int i, count = 0;
 
        drm_fb_helper_for_each_connector(fb_helper, i) {
                connector = fb_helper->connector_info[i]->connector;
@@ -2234,11 +2345,8 @@ static void drm_setup_crtcs(struct drm_fb_helper *fb_helper,
        int i;
 
        DRM_DEBUG_KMS("\n");
-       if (drm_fb_helper_probe_connector_modes(fb_helper, width, height) == 0)
-               DRM_DEBUG_KMS("No connectors reported connected with modes\n");
-
        /* prevent concurrent modification of connector_count by hotplug */
-       lockdep_assert_held(&fb_helper->dev->mode_config.mutex);
+       lockdep_assert_held(&fb_helper->lock);
 
        crtcs = kcalloc(fb_helper->connector_count,
                        sizeof(struct drm_fb_helper_crtc *), GFP_KERNEL);
@@ -2253,6 +2361,9 @@ static void drm_setup_crtcs(struct drm_fb_helper *fb_helper,
                goto out;
        }
 
+       mutex_lock(&fb_helper->dev->mode_config.mutex);
+       if (drm_fb_helper_probe_connector_modes(fb_helper, width, height) == 0)
+               DRM_DEBUG_KMS("No connectors reported connected with modes\n");
        drm_enable_connectors(fb_helper, enabled);
 
        if (!(fb_helper->funcs->initial_config &&
@@ -2274,6 +2385,7 @@ static void drm_setup_crtcs(struct drm_fb_helper *fb_helper,
 
                drm_pick_crtcs(fb_helper, crtcs, modes, 0, width, height);
        }
+       mutex_unlock(&fb_helper->dev->mode_config.mutex);
 
        /* need to set the modesets up here for use later */
        /* fill out the connector<->crtc mappings into the modesets */
@@ -2285,9 +2397,9 @@ static void drm_setup_crtcs(struct drm_fb_helper *fb_helper,
                struct drm_display_mode *mode = modes[i];
                struct drm_fb_helper_crtc *fb_crtc = crtcs[i];
                struct drm_fb_offset *offset = &offsets[i];
-               struct drm_mode_set *modeset = &fb_crtc->mode_set;
 
                if (mode && fb_crtc) {
+                       struct drm_mode_set *modeset = &fb_crtc->mode_set;
                        struct drm_connector *connector =
                                fb_helper->connector_info[i]->connector;
 
@@ -2301,7 +2413,6 @@ static void drm_setup_crtcs(struct drm_fb_helper *fb_helper,
                                                           fb_crtc->desired_mode);
                        drm_connector_get(connector);
                        modeset->connectors[modeset->num_connectors++] = connector;
-                       modeset->fb = fb_helper->fb;
                        modeset->x = offset->x;
                        modeset->y = offset->y;
                }
@@ -2313,6 +2424,91 @@ out:
        kfree(enabled);
 }
 
+/*
+ * This is a continuation of drm_setup_crtcs() that sets up anything related
+ * to the framebuffer. During initialization, drm_setup_crtcs() is called before
+ * the framebuffer has been allocated (fb_helper->fb and fb_helper->fbdev).
+ * So, any setup that touches those fields needs to be done here instead of in
+ * drm_setup_crtcs().
+ */
+static void drm_setup_crtcs_fb(struct drm_fb_helper *fb_helper)
+{
+       struct fb_info *info = fb_helper->fbdev;
+       int i;
+
+       for (i = 0; i < fb_helper->crtc_count; i++)
+               if (fb_helper->crtc_info[i].mode_set.num_connectors)
+                       fb_helper->crtc_info[i].mode_set.fb = fb_helper->fb;
+
+       mutex_lock(&fb_helper->dev->mode_config.mutex);
+       drm_fb_helper_for_each_connector(fb_helper, i) {
+               struct drm_connector *connector =
+                                       fb_helper->connector_info[i]->connector;
+
+               /* use first connected connector for the physical dimensions */
+               if (connector->status == connector_status_connected) {
+                       info->var.width = connector->display_info.width_mm;
+                       info->var.height = connector->display_info.height_mm;
+                       break;
+               }
+       }
+       mutex_unlock(&fb_helper->dev->mode_config.mutex);
+}
+
+/* Note: Drops fb_helper->lock before returning. */
+static int
+__drm_fb_helper_initial_config_and_unlock(struct drm_fb_helper *fb_helper,
+                                         int bpp_sel)
+{
+       struct drm_device *dev = fb_helper->dev;
+       struct fb_info *info;
+       unsigned int width, height;
+       int ret;
+
+       width = dev->mode_config.max_width;
+       height = dev->mode_config.max_height;
+
+       drm_setup_crtcs(fb_helper, width, height);
+       ret = drm_fb_helper_single_fb_probe(fb_helper, bpp_sel);
+       if (ret < 0) {
+               if (ret == -EAGAIN) {
+                       fb_helper->preferred_bpp = bpp_sel;
+                       fb_helper->deferred_setup = true;
+                       ret = 0;
+               }
+               mutex_unlock(&fb_helper->lock);
+
+               return ret;
+       }
+       drm_setup_crtcs_fb(fb_helper);
+
+       fb_helper->deferred_setup = false;
+
+       info = fb_helper->fbdev;
+       info->var.pixclock = 0;
+
+       /* Need to drop locks to avoid recursive deadlock in
+        * register_framebuffer. This is ok because the only thing left to do is
+        * register the fbdev emulation instance in kernel_fb_helper_list. */
+       mutex_unlock(&fb_helper->lock);
+
+       ret = register_framebuffer(info);
+       if (ret < 0)
+               return ret;
+
+       dev_info(dev->dev, "fb%d: %s frame buffer device\n",
+                info->node, info->fix.id);
+
+       mutex_lock(&kernel_fb_helper_lock);
+       if (list_empty(&kernel_fb_helper_list))
+               register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
+
+       list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list);
+       mutex_unlock(&kernel_fb_helper_lock);
+
+       return 0;
+}
+
 /**
  * drm_fb_helper_initial_config - setup a sane initial connector configuration
  * @fb_helper: fb_helper device struct
@@ -2357,39 +2553,15 @@ out:
  */
 int drm_fb_helper_initial_config(struct drm_fb_helper *fb_helper, int bpp_sel)
 {
-       struct drm_device *dev = fb_helper->dev;
-       struct fb_info *info;
        int ret;
 
        if (!drm_fbdev_emulation)
                return 0;
 
-       mutex_lock(&dev->mode_config.mutex);
-       drm_setup_crtcs(fb_helper,
-                       dev->mode_config.max_width,
-                       dev->mode_config.max_height);
-       ret = drm_fb_helper_single_fb_probe(fb_helper, bpp_sel);
-       mutex_unlock(&dev->mode_config.mutex);
-       if (ret)
-               return ret;
+       mutex_lock(&fb_helper->lock);
+       ret = __drm_fb_helper_initial_config_and_unlock(fb_helper, bpp_sel);
 
-       info = fb_helper->fbdev;
-       info->var.pixclock = 0;
-       ret = register_framebuffer(info);
-       if (ret < 0)
-               return ret;
-
-       dev_info(dev->dev, "fb%d: %s frame buffer device\n",
-                info->node, info->fix.id);
-
-       mutex_lock(&kernel_fb_helper_lock);
-       if (list_empty(&kernel_fb_helper_list))
-               register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
-
-       list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list);
-       mutex_unlock(&kernel_fb_helper_lock);
-
-       return 0;
+       return ret;
 }
 EXPORT_SYMBOL(drm_fb_helper_initial_config);
 
@@ -2416,22 +2588,29 @@ EXPORT_SYMBOL(drm_fb_helper_initial_config);
  */
 int drm_fb_helper_hotplug_event(struct drm_fb_helper *fb_helper)
 {
-       struct drm_device *dev = fb_helper->dev;
+       int err = 0;
 
        if (!drm_fbdev_emulation)
                return 0;
 
-       mutex_lock(&dev->mode_config.mutex);
+       mutex_lock(&fb_helper->lock);
+       if (fb_helper->deferred_setup) {
+               err = __drm_fb_helper_initial_config_and_unlock(fb_helper,
+                               fb_helper->preferred_bpp);
+               return err;
+       }
+
        if (!fb_helper->fb || !drm_fb_helper_is_bound(fb_helper)) {
                fb_helper->delayed_hotplug = true;
-               mutex_unlock(&dev->mode_config.mutex);
-               return 0;
+               mutex_unlock(&fb_helper->lock);
+               return err;
        }
+
        DRM_DEBUG_KMS("\n");
 
        drm_setup_crtcs(fb_helper, fb_helper->fb->width, fb_helper->fb->height);
-
-       mutex_unlock(&dev->mode_config.mutex);
+       drm_setup_crtcs_fb(fb_helper);
+       mutex_unlock(&fb_helper->lock);
 
        drm_fb_helper_set_par(fb_helper->fbdev);