Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2011 Samsung Electronics Co.Ltd |
| 3 | * Authors: Joonyoung Shim <jy0922.shim@samsung.com> |
| 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify it |
| 6 | * under the terms of the GNU General Public License as published by the |
| 7 | * Free Software Foundation; either version 2 of the License, or (at your |
| 8 | * option) any later version. |
| 9 | * |
| 10 | */ |
| 11 | |
| 12 | #include "drmP.h" |
| 13 | |
| 14 | #include "exynos_drm.h" |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 15 | #include "exynos_drm_drv.h" |
| 16 | #include "exynos_drm_encoder.h" |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 17 | #include "exynos_drm_fb.h" |
| 18 | #include "exynos_drm_gem.h" |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 19 | |
Joonyoung Shim | fdc575e | 2012-06-27 14:27:03 +0900 | [diff] [blame] | 20 | #define to_exynos_plane(x) container_of(x, struct exynos_plane, base) |
| 21 | |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 22 | struct exynos_plane { |
| 23 | struct drm_plane base; |
| 24 | struct exynos_drm_overlay overlay; |
| 25 | bool enabled; |
| 26 | }; |
| 27 | |
Eunchul Kim | ba3849d | 2012-03-16 18:47:15 +0900 | [diff] [blame] | 28 | static const uint32_t formats[] = { |
| 29 | DRM_FORMAT_XRGB8888, |
Seung-Woo Kim | 6b1c762 | 2012-04-05 11:21:09 +0900 | [diff] [blame] | 30 | DRM_FORMAT_ARGB8888, |
| 31 | DRM_FORMAT_NV12, |
| 32 | DRM_FORMAT_NV12M, |
| 33 | DRM_FORMAT_NV12MT, |
Eunchul Kim | ba3849d | 2012-03-16 18:47:15 +0900 | [diff] [blame] | 34 | }; |
| 35 | |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 36 | int exynos_plane_mode_set(struct drm_plane *plane, struct drm_crtc *crtc, |
| 37 | struct drm_framebuffer *fb, int crtc_x, int crtc_y, |
| 38 | unsigned int crtc_w, unsigned int crtc_h, |
| 39 | uint32_t src_x, uint32_t src_y, |
| 40 | uint32_t src_w, uint32_t src_h) |
| 41 | { |
| 42 | struct exynos_plane *exynos_plane = to_exynos_plane(plane); |
| 43 | struct exynos_drm_overlay *overlay = &exynos_plane->overlay; |
| 44 | unsigned int actual_w; |
| 45 | unsigned int actual_h; |
| 46 | int nr; |
| 47 | int i; |
| 48 | |
| 49 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 50 | |
| 51 | nr = exynos_drm_format_num_buffers(fb->pixel_format); |
| 52 | for (i = 0; i < nr; i++) { |
| 53 | struct exynos_drm_gem_buf *buffer = exynos_drm_fb_buffer(fb, i); |
| 54 | |
| 55 | if (!buffer) { |
| 56 | DRM_LOG_KMS("buffer is null\n"); |
| 57 | return -EFAULT; |
| 58 | } |
| 59 | |
| 60 | overlay->dma_addr[i] = buffer->dma_addr; |
| 61 | overlay->vaddr[i] = buffer->kvaddr; |
| 62 | |
| 63 | DRM_DEBUG_KMS("buffer: %d, vaddr = 0x%lx, dma_addr = 0x%lx\n", |
| 64 | i, (unsigned long)overlay->vaddr[i], |
| 65 | (unsigned long)overlay->dma_addr[i]); |
| 66 | } |
| 67 | |
| 68 | actual_w = min((unsigned)(crtc->mode.hdisplay - crtc_x), crtc_w); |
| 69 | actual_h = min((unsigned)(crtc->mode.vdisplay - crtc_y), crtc_h); |
| 70 | |
| 71 | /* set drm framebuffer data. */ |
| 72 | overlay->fb_x = src_x; |
| 73 | overlay->fb_y = src_y; |
| 74 | overlay->fb_width = fb->width; |
| 75 | overlay->fb_height = fb->height; |
| 76 | overlay->src_width = src_w; |
| 77 | overlay->src_height = src_h; |
| 78 | overlay->bpp = fb->bits_per_pixel; |
| 79 | overlay->pitch = fb->pitches[0]; |
| 80 | overlay->pixel_format = fb->pixel_format; |
| 81 | |
| 82 | /* set overlay range to be displayed. */ |
| 83 | overlay->crtc_x = crtc_x; |
| 84 | overlay->crtc_y = crtc_y; |
| 85 | overlay->crtc_width = actual_w; |
| 86 | overlay->crtc_height = actual_h; |
| 87 | |
| 88 | /* set drm mode data. */ |
| 89 | overlay->mode_width = crtc->mode.hdisplay; |
| 90 | overlay->mode_height = crtc->mode.vdisplay; |
| 91 | overlay->refresh = crtc->mode.vrefresh; |
| 92 | overlay->scan_flag = crtc->mode.flags; |
| 93 | |
| 94 | DRM_DEBUG_KMS("overlay : offset_x/y(%d,%d), width/height(%d,%d)", |
| 95 | overlay->crtc_x, overlay->crtc_y, |
| 96 | overlay->crtc_width, overlay->crtc_height); |
| 97 | |
| 98 | exynos_drm_fn_encoder(crtc, overlay, exynos_drm_encoder_plane_mode_set); |
| 99 | |
| 100 | return 0; |
| 101 | } |
| 102 | |
| 103 | void exynos_plane_commit(struct drm_plane *plane) |
| 104 | { |
| 105 | struct exynos_plane *exynos_plane = to_exynos_plane(plane); |
| 106 | struct exynos_drm_overlay *overlay = &exynos_plane->overlay; |
| 107 | |
| 108 | exynos_drm_fn_encoder(plane->crtc, &overlay->zpos, |
| 109 | exynos_drm_encoder_plane_commit); |
| 110 | |
| 111 | exynos_plane->enabled = true; |
| 112 | } |
| 113 | |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 114 | static int |
| 115 | exynos_update_plane(struct drm_plane *plane, struct drm_crtc *crtc, |
| 116 | struct drm_framebuffer *fb, int crtc_x, int crtc_y, |
| 117 | unsigned int crtc_w, unsigned int crtc_h, |
| 118 | uint32_t src_x, uint32_t src_y, |
| 119 | uint32_t src_w, uint32_t src_h) |
| 120 | { |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 121 | int ret; |
| 122 | |
| 123 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 124 | |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 125 | ret = exynos_plane_mode_set(plane, crtc, fb, crtc_x, crtc_y, |
| 126 | crtc_w, crtc_h, src_x >> 16, src_y >> 16, |
| 127 | src_w >> 16, src_h >> 16); |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 128 | if (ret < 0) |
| 129 | return ret; |
| 130 | |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 131 | plane->crtc = crtc; |
| 132 | plane->fb = crtc->fb; |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 133 | |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 134 | exynos_plane_commit(plane); |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 135 | |
| 136 | return 0; |
| 137 | } |
| 138 | |
| 139 | static int exynos_disable_plane(struct drm_plane *plane) |
| 140 | { |
Joonyoung Shim | fdc575e | 2012-06-27 14:27:03 +0900 | [diff] [blame] | 141 | struct exynos_plane *exynos_plane = to_exynos_plane(plane); |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 142 | struct exynos_drm_overlay *overlay = &exynos_plane->overlay; |
| 143 | |
| 144 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 145 | |
| 146 | if (!exynos_plane->enabled) |
| 147 | return 0; |
| 148 | |
| 149 | exynos_drm_fn_encoder(plane->crtc, &overlay->zpos, |
Joonyoung Shim | 4070d21 | 2012-06-27 14:27:05 +0900 | [diff] [blame] | 150 | exynos_drm_encoder_plane_disable); |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 151 | |
| 152 | exynos_plane->enabled = false; |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 153 | |
| 154 | return 0; |
| 155 | } |
| 156 | |
| 157 | static void exynos_plane_destroy(struct drm_plane *plane) |
| 158 | { |
Joonyoung Shim | fdc575e | 2012-06-27 14:27:03 +0900 | [diff] [blame] | 159 | struct exynos_plane *exynos_plane = to_exynos_plane(plane); |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 160 | |
| 161 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 162 | |
| 163 | exynos_disable_plane(plane); |
| 164 | drm_plane_cleanup(plane); |
| 165 | kfree(exynos_plane); |
| 166 | } |
| 167 | |
Joonyoung Shim | 00ae67c | 2012-06-27 14:27:06 +0900 | [diff] [blame] | 168 | static int exynos_plane_set_property(struct drm_plane *plane, |
| 169 | struct drm_property *property, |
| 170 | uint64_t val) |
| 171 | { |
| 172 | struct drm_device *dev = plane->dev; |
| 173 | struct exynos_plane *exynos_plane = to_exynos_plane(plane); |
| 174 | struct exynos_drm_private *dev_priv = dev->dev_private; |
| 175 | |
| 176 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 177 | |
| 178 | if (property == dev_priv->plane_zpos_property) { |
| 179 | exynos_plane->overlay.zpos = val; |
| 180 | return 0; |
| 181 | } |
| 182 | |
| 183 | return -EINVAL; |
| 184 | } |
| 185 | |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 186 | static struct drm_plane_funcs exynos_plane_funcs = { |
| 187 | .update_plane = exynos_update_plane, |
| 188 | .disable_plane = exynos_disable_plane, |
| 189 | .destroy = exynos_plane_destroy, |
Joonyoung Shim | 00ae67c | 2012-06-27 14:27:06 +0900 | [diff] [blame] | 190 | .set_property = exynos_plane_set_property, |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 191 | }; |
| 192 | |
Joonyoung Shim | 00ae67c | 2012-06-27 14:27:06 +0900 | [diff] [blame] | 193 | static void exynos_plane_attach_zpos_property(struct drm_plane *plane) |
| 194 | { |
| 195 | struct drm_device *dev = plane->dev; |
| 196 | struct exynos_drm_private *dev_priv = dev->dev_private; |
| 197 | struct drm_property *prop; |
| 198 | |
| 199 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 200 | |
| 201 | prop = dev_priv->plane_zpos_property; |
| 202 | if (!prop) { |
| 203 | prop = drm_property_create_range(dev, 0, "zpos", 0, |
| 204 | MAX_PLANE - 1); |
| 205 | if (!prop) |
| 206 | return; |
| 207 | |
| 208 | dev_priv->plane_zpos_property = prop; |
| 209 | } |
| 210 | |
| 211 | drm_object_attach_property(&plane->base, prop, 0); |
| 212 | } |
| 213 | |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 214 | struct drm_plane *exynos_plane_init(struct drm_device *dev, |
| 215 | unsigned int possible_crtcs, bool priv) |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 216 | { |
| 217 | struct exynos_plane *exynos_plane; |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 218 | int err; |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 219 | |
Joonyoung Shim | 00ae67c | 2012-06-27 14:27:06 +0900 | [diff] [blame] | 220 | DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); |
| 221 | |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 222 | exynos_plane = kzalloc(sizeof(struct exynos_plane), GFP_KERNEL); |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 223 | if (!exynos_plane) { |
| 224 | DRM_ERROR("failed to allocate plane\n"); |
| 225 | return NULL; |
| 226 | } |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 227 | |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 228 | err = drm_plane_init(dev, &exynos_plane->base, possible_crtcs, |
Eunchul Kim | ba3849d | 2012-03-16 18:47:15 +0900 | [diff] [blame] | 229 | &exynos_plane_funcs, formats, ARRAY_SIZE(formats), |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 230 | priv); |
| 231 | if (err) { |
| 232 | DRM_ERROR("failed to initialize plane\n"); |
| 233 | kfree(exynos_plane); |
| 234 | return NULL; |
| 235 | } |
| 236 | |
Joonyoung Shim | 00ae67c | 2012-06-27 14:27:06 +0900 | [diff] [blame] | 237 | if (priv) |
| 238 | exynos_plane->overlay.zpos = DEFAULT_ZPOS; |
| 239 | else |
| 240 | exynos_plane_attach_zpos_property(&exynos_plane->base); |
| 241 | |
Joonyoung Shim | b5d2eb3 | 2012-06-27 14:27:04 +0900 | [diff] [blame] | 242 | return &exynos_plane->base; |
Joonyoung Shim | 864ee9e | 2011-12-08 17:54:07 +0900 | [diff] [blame] | 243 | } |