drivers/gpu/drm/tinydrm/core/tinydrm-pipe.c

   1 /*
   2  * Copyright (C) 2016 Noralf Trønnes
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  */
   9
  10 #include <drm/drm_atomic_helper.h>
  11 #include <drm/drm_crtc_helper.h>
  12 #include <drm/drm_modes.h>
  13 #include <drm/tinydrm/tinydrm.h>
  14
  15 struct tinydrm_connector {
  16         struct drm_connector base;
  17         const struct drm_display_mode *mode;
  18 };
  19
  20 static inline struct tinydrm_connector *
  21 to_tinydrm_connector(struct drm_connector *connector)
  22 {
  23         return container_of(connector, struct tinydrm_connector, base);
  24 }
  25
  26 static int tinydrm_connector_get_modes(struct drm_connector *connector)
  27 {
  28         struct tinydrm_connector *tconn = to_tinydrm_connector(connector);
  29         struct drm_display_mode *mode;
  30
  31         mode = drm_mode_duplicate(connector->dev, tconn->mode);
  32         if (!mode) {
  33                 DRM_ERROR("Failed to duplicate mode\n");
  34                 return 0;
  35         }
  36
  37         if (mode->name[0] == '\0')
  38                 drm_mode_set_name(mode);
  39
  40         mode->type |= DRM_MODE_TYPE_PREFERRED;
  41         drm_mode_probed_add(connector, mode);
  42
  43         if (mode->width_mm) {
  44                 connector->display_info.width_mm = mode->width_mm;
  45                 connector->display_info.height_mm = mode->height_mm;
  46         }
  47
  48         return 1;
  49 }
  50
  51 static const struct drm_connector_helper_funcs tinydrm_connector_hfuncs = {
  52         .get_modes = tinydrm_connector_get_modes,
  53         .best_encoder = drm_atomic_helper_best_encoder,
  54 };
  55
  56 static enum drm_connector_status
  57 tinydrm_connector_detect(struct drm_connector *connector, bool force)
  58 {
  59         if (drm_device_is_unplugged(connector->dev))
  60                 return connector_status_disconnected;
  61
  62         return connector->status;
  63 }
  64
  65 static void tinydrm_connector_destroy(struct drm_connector *connector)
  66 {
  67         struct tinydrm_connector *tconn = to_tinydrm_connector(connector);
  68
  69         drm_connector_cleanup(connector);
  70         kfree(tconn);
  71 }
  72
  73 static const struct drm_connector_funcs tinydrm_connector_funcs = {
  74         .dpms = drm_atomic_helper_connector_dpms,
  75         .reset = drm_atomic_helper_connector_reset,
  76         .detect = tinydrm_connector_detect,
  77         .fill_modes = drm_helper_probe_single_connector_modes,
  78         .destroy = tinydrm_connector_destroy,
  79         .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  80         .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  81 };
  82
  83 struct drm_connector *
  84 tinydrm_connector_create(struct drm_device *drm,
  85                          const struct drm_display_mode *mode,
  86                          int connector_type)
  87 {
  88         struct tinydrm_connector *tconn;
  89         struct drm_connector *connector;
  90         int ret;
  91
  92         tconn = kzalloc(sizeof(*tconn), GFP_KERNEL);
  93         if (!tconn)
  94                 return ERR_PTR(-ENOMEM);
  95
  96         tconn->mode = mode;
  97         connector = &tconn->base;
  98
  99         drm_connector_helper_add(connector, &tinydrm_connector_hfuncs);
 100         ret = drm_connector_init(drm, connector, &tinydrm_connector_funcs,
 101                                  connector_type);
 102         if (ret) {
 103                 kfree(tconn);
 104                 return ERR_PTR(ret);
 105         }
 106
 107         connector->status = connector_status_connected;
 108
 109         return connector;
 110 }
 111
 112 /**
 113  * tinydrm_display_pipe_update - Display pipe update helper
 114  * @pipe: Simple display pipe
 115  * @old_state: Old plane state
 116  *
 117  * This function does a full framebuffer flush if the plane framebuffer
 118  * has changed. It also handles vblank events. Drivers can use this as their
 119  * &drm_simple_display_pipe_funcs->update callback.
 120  */
 121 void tinydrm_display_pipe_update(struct drm_simple_display_pipe *pipe,
 122                                  struct drm_plane_state *old_state)
 123 {
 124         struct tinydrm_device *tdev = pipe_to_tinydrm(pipe);
 125         struct drm_framebuffer *fb = pipe->plane.state->fb;
 126         struct drm_crtc *crtc = &tdev->pipe.crtc;
 127
 128         if (fb && (fb != old_state->fb)) {
 129                 pipe->plane.fb = fb;
 130                 if (fb->funcs->dirty)
 131                         fb->funcs->dirty(fb, NULL, 0, 0, NULL, 0);
 132         }
 133
 134         if (crtc->state->event) {
 135                 spin_lock_irq(&crtc->dev->event_lock);
 136                 drm_crtc_send_vblank_event(crtc, crtc->state->event);
 137                 spin_unlock_irq(&crtc->dev->event_lock);
 138                 crtc->state->event = NULL;
 139         }
 140 }
 141 EXPORT_SYMBOL(tinydrm_display_pipe_update);
 142
 143 /**
 144  * tinydrm_display_pipe_prepare_fb - Display pipe prepare_fb helper
 145  * @pipe: Simple display pipe
 146  * @plane_state: Plane state
 147  *
 148  * This function uses drm_fb_cma_prepare_fb() to check if the plane FB has an
 149  * dma-buf attached, extracts the exclusive fence and attaches it to plane
 150  * state for the atomic helper to wait on. Drivers can use this as their
 151  * &drm_simple_display_pipe_funcs->prepare_fb callback.
 152  */
 153 int tinydrm_display_pipe_prepare_fb(struct drm_simple_display_pipe *pipe,
 154                                     struct drm_plane_state *plane_state)
 155 {
 156         return drm_fb_cma_prepare_fb(&pipe->plane, plane_state);
 157 }
 158 EXPORT_SYMBOL(tinydrm_display_pipe_prepare_fb);
 159
 160 static int tinydrm_rotate_mode(struct drm_display_mode *mode,
 161                                unsigned int rotation)
 162 {
 163         if (rotation == 0 || rotation == 180) {
 164                 return 0;
 165         } else if (rotation == 90 || rotation == 270) {
 166                 swap(mode->hdisplay, mode->vdisplay);
 167                 swap(mode->hsync_start, mode->vsync_start);
 168                 swap(mode->hsync_end, mode->vsync_end);
 169                 swap(mode->htotal, mode->vtotal);
 170                 swap(mode->width_mm, mode->height_mm);
 171                 return 0;
 172         } else {
 173                 return -EINVAL;
 174         }
 175 }
 176
 177 /**
 178  * tinydrm_display_pipe_init - Initialize display pipe
 179  * @tdev: tinydrm device
 180  * @funcs: Display pipe functions
 181  * @connector_type: Connector type
 182  * @formats: Array of supported formats (DRM_FORMAT\_\*)
 183  * @format_count: Number of elements in @formats
 184  * @mode: Supported mode
 185  * @rotation: Initial @mode rotation in degrees Counter Clock Wise
 186  *
 187  * This function sets up a &drm_simple_display_pipe with a &drm_connector that
 188  * has one fixed &drm_display_mode which is rotated according to @rotation.
 189  *
 190  * Returns:
 191  * Zero on success, negative error code on failure.
 192  */
 193 int
 194 tinydrm_display_pipe_init(struct tinydrm_device *tdev,
 195                           const struct drm_simple_display_pipe_funcs *funcs,
 196                           int connector_type,
 197                           const uint32_t *formats,
 198                           unsigned int format_count,
 199                           const struct drm_display_mode *mode,
 200                           unsigned int rotation)
 201 {
 202         struct drm_device *drm = tdev->drm;
 203         struct drm_display_mode *mode_copy;
 204         struct drm_connector *connector;
 205         int ret;
 206
 207         mode_copy = devm_kmalloc(drm->dev, sizeof(*mode_copy), GFP_KERNEL);
 208         if (!mode_copy)
 209                 return -ENOMEM;
 210
 211         *mode_copy = *mode;
 212         ret = tinydrm_rotate_mode(mode_copy, rotation);
 213         if (ret) {
 214                 DRM_ERROR("Illegal rotation value %u\n", rotation);
 215                 return -EINVAL;
 216         }
 217
 218         drm->mode_config.min_width = mode_copy->hdisplay;
 219         drm->mode_config.max_width = mode_copy->hdisplay;
 220         drm->mode_config.min_height = mode_copy->vdisplay;
 221         drm->mode_config.max_height = mode_copy->vdisplay;
 222
 223         connector = tinydrm_connector_create(drm, mode_copy, connector_type);
 224         if (IS_ERR(connector))
 225                 return PTR_ERR(connector);
 226
 227         ret = drm_simple_display_pipe_init(drm, &tdev->pipe, funcs, formats,
 228                                            format_count, connector);
 229         if (ret)
 230                 return ret;
 231
 232         return 0;
 233 }
 234 EXPORT_SYMBOL(tinydrm_display_pipe_init);