kernel/drivers/gpu/drm/nouveau/dispnv04/overlay.c

   1 /*
   2  * Copyright 2013 Ilia Mirkin
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17  * THE AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  18  * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF
  19  * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  20  * SOFTWARE.
  21  *
  22  * Implementation based on the pre-KMS implementation in xf86-video-nouveau,
  23  * written by Arthur Huillet.
  24  */
  25
  26 #include <drm/drmP.h>
  27 #include <drm/drm_crtc.h>
  28 #include <drm/drm_fourcc.h>
  29
  30 #include "nouveau_drm.h"
  31
  32 #include "nouveau_bo.h"
  33 #include "nouveau_connector.h"
  34 #include "nouveau_display.h"
  35 #include "nvreg.h"
  36
  37
  38 struct nouveau_plane {
  39         struct drm_plane base;
  40         bool flip;
  41         struct nouveau_bo *cur;
  42
  43         struct {
  44                 struct drm_property *colorkey;
  45                 struct drm_property *contrast;
  46                 struct drm_property *brightness;
  47                 struct drm_property *hue;
  48                 struct drm_property *saturation;
  49                 struct drm_property *iturbt_709;
  50         } props;
  51
  52         int colorkey;
  53         int contrast;
  54         int brightness;
  55         int hue;
  56         int saturation;
  57         int iturbt_709;
  58
  59         void (*set_params)(struct nouveau_plane *);
  60 };
  61
  62 static uint32_t formats[] = {
  63         DRM_FORMAT_YUYV,
  64         DRM_FORMAT_UYVY,
  65         DRM_FORMAT_NV12,
  66 };
  67
  68 /* Sine can be approximated with
  69  * http://en.wikipedia.org/wiki/Bhaskara_I's_sine_approximation_formula
  70  * sin(x degrees) ~= 4 x (180 - x) / (40500 - x (180 - x) )
  71  * Note that this only works for the range [0, 180].
  72  * Also note that sin(x) == -sin(x - 180)
  73  */
  74 static inline int
  75 sin_mul(int degrees, int factor)
  76 {
  77         if (degrees > 180) {
  78                 degrees -= 180;
  79                 factor *= -1;
  80         }
  81         return factor * 4 * degrees * (180 - degrees) /
  82                 (40500 - degrees * (180 - degrees));
  83 }
  84
  85 /* cos(x) = sin(x + 90) */
  86 static inline int
  87 cos_mul(int degrees, int factor)
  88 {
  89         return sin_mul((degrees + 90) % 360, factor);
  90 }
  91
  92 static int
  93 nv10_update_plane(struct drm_plane *plane, struct drm_crtc *crtc,
  94                   struct drm_framebuffer *fb, int crtc_x, int crtc_y,
  95                   unsigned int crtc_w, unsigned int crtc_h,
  96                   uint32_t src_x, uint32_t src_y,
  97                   uint32_t src_w, uint32_t src_h)
  98 {
  99         struct nouveau_drm *drm = nouveau_drm(plane->dev);
 100         struct nvif_object *dev = &drm->device.object;
 101         struct nouveau_plane *nv_plane =
 102                 container_of(plane, struct nouveau_plane, base);
 103         struct nouveau_framebuffer *nv_fb = nouveau_framebuffer(fb);
 104         struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
 105         struct nouveau_bo *cur = nv_plane->cur;
 106         bool flip = nv_plane->flip;
 107         int soff = NV_PCRTC0_SIZE * nv_crtc->index;
 108         int soff2 = NV_PCRTC0_SIZE * !nv_crtc->index;
 109         int format, ret;
 110
 111         /* Source parameters given in 16.16 fixed point, ignore fractional. */
 112         src_x >>= 16;
 113         src_y >>= 16;
 114         src_w >>= 16;
 115         src_h >>= 16;
 116
 117         format = ALIGN(src_w * 4, 0x100);
 118
 119         if (format > 0xffff)
 120                 return -ERANGE;
 121
 122         if (drm->device.info.chipset >= 0x30) {
 123                 if (crtc_w < (src_w >> 1) || crtc_h < (src_h >> 1))
 124                         return -ERANGE;
 125         } else {
 126                 if (crtc_w < (src_w >> 3) || crtc_h < (src_h >> 3))
 127                         return -ERANGE;
 128         }
 129
 130         ret = nouveau_bo_pin(nv_fb->nvbo, TTM_PL_FLAG_VRAM, false);
 131         if (ret)
 132                 return ret;
 133
 134         nv_plane->cur = nv_fb->nvbo;
 135
 136         nvif_mask(dev, NV_PCRTC_ENGINE_CTRL + soff, NV_CRTC_FSEL_OVERLAY, NV_CRTC_FSEL_OVERLAY);
 137         nvif_mask(dev, NV_PCRTC_ENGINE_CTRL + soff2, NV_CRTC_FSEL_OVERLAY, 0);
 138
 139         nvif_wr32(dev, NV_PVIDEO_BASE(flip), 0);
 140         nvif_wr32(dev, NV_PVIDEO_OFFSET_BUFF(flip), nv_fb->nvbo->bo.offset);
 141         nvif_wr32(dev, NV_PVIDEO_SIZE_IN(flip), src_h << 16 | src_w);
 142         nvif_wr32(dev, NV_PVIDEO_POINT_IN(flip), src_y << 16 | src_x);
 143         nvif_wr32(dev, NV_PVIDEO_DS_DX(flip), (src_w << 20) / crtc_w);
 144         nvif_wr32(dev, NV_PVIDEO_DT_DY(flip), (src_h << 20) / crtc_h);
 145         nvif_wr32(dev, NV_PVIDEO_POINT_OUT(flip), crtc_y << 16 | crtc_x);
 146         nvif_wr32(dev, NV_PVIDEO_SIZE_OUT(flip), crtc_h << 16 | crtc_w);
 147
 148         if (fb->pixel_format != DRM_FORMAT_UYVY)
 149                 format |= NV_PVIDEO_FORMAT_COLOR_LE_CR8YB8CB8YA8;
 150         if (fb->pixel_format == DRM_FORMAT_NV12)
 151                 format |= NV_PVIDEO_FORMAT_PLANAR;
 152         if (nv_plane->iturbt_709)
 153                 format |= NV_PVIDEO_FORMAT_MATRIX_ITURBT709;
 154         if (nv_plane->colorkey & (1 << 24))
 155                 format |= NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY;
 156
 157         if (fb->pixel_format == DRM_FORMAT_NV12) {
 158                 nvif_wr32(dev, NV_PVIDEO_UVPLANE_BASE(flip), 0);
 159                 nvif_wr32(dev, NV_PVIDEO_UVPLANE_OFFSET_BUFF(flip),
 160                         nv_fb->nvbo->bo.offset + fb->offsets[1]);
 161         }
 162         nvif_wr32(dev, NV_PVIDEO_FORMAT(flip), format);
 163         nvif_wr32(dev, NV_PVIDEO_STOP, 0);
 164         /* TODO: wait for vblank? */
 165         nvif_wr32(dev, NV_PVIDEO_BUFFER, flip ? 0x10 : 0x1);
 166         nv_plane->flip = !flip;
 167
 168         if (cur)
 169                 nouveau_bo_unpin(cur);
 170
 171         return 0;
 172 }
 173
 174 static int
 175 nv10_disable_plane(struct drm_plane *plane)
 176 {
 177         struct nvif_object *dev = &nouveau_drm(plane->dev)->device.object;
 178         struct nouveau_plane *nv_plane =
 179                 container_of(plane, struct nouveau_plane, base);
 180
 181         nvif_wr32(dev, NV_PVIDEO_STOP, 1);
 182         if (nv_plane->cur) {
 183                 nouveau_bo_unpin(nv_plane->cur);
 184                 nv_plane->cur = NULL;
 185         }
 186
 187         return 0;
 188 }
 189
 190 static void
 191 nv_destroy_plane(struct drm_plane *plane)
 192 {
 193         plane->funcs->disable_plane(plane);
 194         drm_plane_cleanup(plane);
 195         kfree(plane);
 196 }
 197
 198 static void
 199 nv10_set_params(struct nouveau_plane *plane)
 200 {
 201         struct nvif_object *dev = &nouveau_drm(plane->base.dev)->device.object;
 202         u32 luma = (plane->brightness - 512) << 16 | plane->contrast;
 203         u32 chroma = ((sin_mul(plane->hue, plane->saturation) & 0xffff) << 16) |
 204                 (cos_mul(plane->hue, plane->saturation) & 0xffff);
 205         u32 format = 0;
 206
 207         nvif_wr32(dev, NV_PVIDEO_LUMINANCE(0), luma);
 208         nvif_wr32(dev, NV_PVIDEO_LUMINANCE(1), luma);
 209         nvif_wr32(dev, NV_PVIDEO_CHROMINANCE(0), chroma);
 210         nvif_wr32(dev, NV_PVIDEO_CHROMINANCE(1), chroma);
 211         nvif_wr32(dev, NV_PVIDEO_COLOR_KEY, plane->colorkey & 0xffffff);
 212
 213         if (plane->cur) {
 214                 if (plane->iturbt_709)
 215                         format |= NV_PVIDEO_FORMAT_MATRIX_ITURBT709;
 216                 if (plane->colorkey & (1 << 24))
 217                         format |= NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY;
 218                 nvif_mask(dev, NV_PVIDEO_FORMAT(plane->flip),
 219                         NV_PVIDEO_FORMAT_MATRIX_ITURBT709 |
 220                         NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY,
 221                         format);
 222         }
 223 }
 224
 225 static int
 226 nv_set_property(struct drm_plane *plane,
 227                 struct drm_property *property,
 228                 uint64_t value)
 229 {
 230         struct nouveau_plane *nv_plane =
 231                 container_of(plane, struct nouveau_plane, base);
 232
 233         if (property == nv_plane->props.colorkey)
 234                 nv_plane->colorkey = value;
 235         else if (property == nv_plane->props.contrast)
 236                 nv_plane->contrast = value;
 237         else if (property == nv_plane->props.brightness)
 238                 nv_plane->brightness = value;
 239         else if (property == nv_plane->props.hue)
 240                 nv_plane->hue = value;
 241         else if (property == nv_plane->props.saturation)
 242                 nv_plane->saturation = value;
 243         else if (property == nv_plane->props.iturbt_709)
 244                 nv_plane->iturbt_709 = value;
 245         else
 246                 return -EINVAL;
 247
 248         if (nv_plane->set_params)
 249                 nv_plane->set_params(nv_plane);
 250         return 0;
 251 }
 252
 253 static const struct drm_plane_funcs nv10_plane_funcs = {
 254         .update_plane = nv10_update_plane,
 255         .disable_plane = nv10_disable_plane,
 256         .set_property = nv_set_property,
 257         .destroy = nv_destroy_plane,
 258 };
 259
 260 static void
 261 nv10_overlay_init(struct drm_device *device)
 262 {
 263         struct nouveau_drm *drm = nouveau_drm(device);
 264         struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL);
 265         unsigned int num_formats = ARRAY_SIZE(formats);
 266         int ret;
 267
 268         if (!plane)
 269                 return;
 270
 271         switch (drm->device.info.chipset) {
 272         case 0x10:
 273         case 0x11:
 274         case 0x15:
 275         case 0x1a:
 276         case 0x20:
 277                 num_formats = 2;
 278                 break;
 279         }
 280
 281         ret = drm_plane_init(device, &plane->base, 3 /* both crtc's */,
 282                              &nv10_plane_funcs,
 283                              formats, num_formats, false);
 284         if (ret)
 285                 goto err;
 286
 287         /* Set up the plane properties */
 288         plane->props.colorkey = drm_property_create_range(
 289                         device, 0, "colorkey", 0, 0x01ffffff);
 290         plane->props.contrast = drm_property_create_range(
 291                         device, 0, "contrast", 0, 8192 - 1);
 292         plane->props.brightness = drm_property_create_range(
 293                         device, 0, "brightness", 0, 1024);
 294         plane->props.hue = drm_property_create_range(
 295                         device, 0, "hue", 0, 359);
 296         plane->props.saturation = drm_property_create_range(
 297                         device, 0, "saturation", 0, 8192 - 1);
 298         plane->props.iturbt_709 = drm_property_create_range(
 299                         device, 0, "iturbt_709", 0, 1);
 300         if (!plane->props.colorkey ||
 301             !plane->props.contrast ||
 302             !plane->props.brightness ||
 303             !plane->props.hue ||
 304             !plane->props.saturation ||
 305             !plane->props.iturbt_709)
 306                 goto cleanup;
 307
 308         plane->colorkey = 0;
 309         drm_object_attach_property(&plane->base.base,
 310                                    plane->props.colorkey, plane->colorkey);
 311
 312         plane->contrast = 0x1000;
 313         drm_object_attach_property(&plane->base.base,
 314                                    plane->props.contrast, plane->contrast);
 315
 316         plane->brightness = 512;
 317         drm_object_attach_property(&plane->base.base,
 318                                    plane->props.brightness, plane->brightness);
 319
 320         plane->hue = 0;
 321         drm_object_attach_property(&plane->base.base,
 322                                    plane->props.hue, plane->hue);
 323
 324         plane->saturation = 0x1000;
 325         drm_object_attach_property(&plane->base.base,
 326                                    plane->props.saturation, plane->saturation);
 327
 328         plane->iturbt_709 = 0;
 329         drm_object_attach_property(&plane->base.base,
 330                                    plane->props.iturbt_709, plane->iturbt_709);
 331
 332         plane->set_params = nv10_set_params;
 333         nv10_set_params(plane);
 334         nv10_disable_plane(&plane->base);
 335         return;
 336 cleanup:
 337         drm_plane_cleanup(&plane->base);
 338 err:
 339         kfree(plane);
 340         NV_ERROR(drm, "Failed to create plane\n");
 341 }
 342
 343 static int
 344 nv04_update_plane(struct drm_plane *plane, struct drm_crtc *crtc,
 345                   struct drm_framebuffer *fb, int crtc_x, int crtc_y,
 346                   unsigned int crtc_w, unsigned int crtc_h,
 347                   uint32_t src_x, uint32_t src_y,
 348                   uint32_t src_w, uint32_t src_h)
 349 {
 350         struct nvif_object *dev = &nouveau_drm(plane->dev)->device.object;
 351         struct nouveau_plane *nv_plane =
 352                 container_of(plane, struct nouveau_plane, base);
 353         struct nouveau_framebuffer *nv_fb = nouveau_framebuffer(fb);
 354         struct nouveau_bo *cur = nv_plane->cur;
 355         uint32_t overlay = 1;
 356         int brightness = (nv_plane->brightness - 512) * 62 / 512;
 357         int pitch, ret, i;
 358
 359         /* Source parameters given in 16.16 fixed point, ignore fractional. */
 360         src_x >>= 16;
 361         src_y >>= 16;
 362         src_w >>= 16;
 363         src_h >>= 16;
 364
 365         pitch = ALIGN(src_w * 4, 0x100);
 366
 367         if (pitch > 0xffff)
 368                 return -ERANGE;
 369
 370         /* TODO: Compute an offset? Not sure how to do this for YUYV. */
 371         if (src_x != 0 || src_y != 0)
 372                 return -ERANGE;
 373
 374         if (crtc_w < src_w || crtc_h < src_h)
 375                 return -ERANGE;
 376
 377         ret = nouveau_bo_pin(nv_fb->nvbo, TTM_PL_FLAG_VRAM, false);
 378         if (ret)
 379                 return ret;
 380
 381         nv_plane->cur = nv_fb->nvbo;
 382
 383         nvif_wr32(dev, NV_PVIDEO_OE_STATE, 0);
 384         nvif_wr32(dev, NV_PVIDEO_SU_STATE, 0);
 385         nvif_wr32(dev, NV_PVIDEO_RM_STATE, 0);
 386
 387         for (i = 0; i < 2; i++) {
 388                 nvif_wr32(dev, NV_PVIDEO_BUFF0_START_ADDRESS + 4 * i,
 389                         nv_fb->nvbo->bo.offset);
 390                 nvif_wr32(dev, NV_PVIDEO_BUFF0_PITCH_LENGTH + 4 * i, pitch);
 391                 nvif_wr32(dev, NV_PVIDEO_BUFF0_OFFSET + 4 * i, 0);
 392         }
 393         nvif_wr32(dev, NV_PVIDEO_WINDOW_START, crtc_y << 16 | crtc_x);
 394         nvif_wr32(dev, NV_PVIDEO_WINDOW_SIZE, crtc_h << 16 | crtc_w);
 395         nvif_wr32(dev, NV_PVIDEO_STEP_SIZE,
 396                 (uint32_t)(((src_h - 1) << 11) / (crtc_h - 1)) << 16 | (uint32_t)(((src_w - 1) << 11) / (crtc_w - 1)));
 397
 398         /* It should be possible to convert hue/contrast to this */
 399         nvif_wr32(dev, NV_PVIDEO_RED_CSC_OFFSET, 0x69 - brightness);
 400         nvif_wr32(dev, NV_PVIDEO_GREEN_CSC_OFFSET, 0x3e + brightness);
 401         nvif_wr32(dev, NV_PVIDEO_BLUE_CSC_OFFSET, 0x89 - brightness);
 402         nvif_wr32(dev, NV_PVIDEO_CSC_ADJUST, 0);
 403
 404         nvif_wr32(dev, NV_PVIDEO_CONTROL_Y, 0x001); /* (BLUR_ON, LINE_HALF) */
 405         nvif_wr32(dev, NV_PVIDEO_CONTROL_X, 0x111); /* (WEIGHT_HEAVY, SHARPENING_ON, SMOOTHING_ON) */
 406
 407         nvif_wr32(dev, NV_PVIDEO_FIFO_BURST_LENGTH, 0x03);
 408         nvif_wr32(dev, NV_PVIDEO_FIFO_THRES_SIZE, 0x38);
 409
 410         nvif_wr32(dev, NV_PVIDEO_KEY, nv_plane->colorkey);
 411
 412         if (nv_plane->colorkey & (1 << 24))
 413                 overlay |= 0x10;
 414         if (fb->pixel_format == DRM_FORMAT_YUYV)
 415                 overlay |= 0x100;
 416
 417         nvif_wr32(dev, NV_PVIDEO_OVERLAY, overlay);
 418
 419         nvif_wr32(dev, NV_PVIDEO_SU_STATE, nvif_rd32(dev, NV_PVIDEO_SU_STATE) ^ (1 << 16));
 420
 421         if (cur)
 422                 nouveau_bo_unpin(cur);
 423
 424         return 0;
 425 }
 426
 427 static int
 428 nv04_disable_plane(struct drm_plane *plane)
 429 {
 430         struct nvif_object *dev = &nouveau_drm(plane->dev)->device.object;
 431         struct nouveau_plane *nv_plane =
 432                 container_of(plane, struct nouveau_plane, base);
 433
 434         nvif_mask(dev, NV_PVIDEO_OVERLAY, 1, 0);
 435         nvif_wr32(dev, NV_PVIDEO_OE_STATE, 0);
 436         nvif_wr32(dev, NV_PVIDEO_SU_STATE, 0);
 437         nvif_wr32(dev, NV_PVIDEO_RM_STATE, 0);
 438         if (nv_plane->cur) {
 439                 nouveau_bo_unpin(nv_plane->cur);
 440                 nv_plane->cur = NULL;
 441         }
 442
 443         return 0;
 444 }
 445
 446 static const struct drm_plane_funcs nv04_plane_funcs = {
 447         .update_plane = nv04_update_plane,
 448         .disable_plane = nv04_disable_plane,
 449         .set_property = nv_set_property,
 450         .destroy = nv_destroy_plane,
 451 };
 452
 453 static void
 454 nv04_overlay_init(struct drm_device *device)
 455 {
 456         struct nouveau_drm *drm = nouveau_drm(device);
 457         struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL);
 458         int ret;
 459
 460         if (!plane)
 461                 return;
 462
 463         ret = drm_plane_init(device, &plane->base, 1 /* single crtc */,
 464                              &nv04_plane_funcs,
 465                              formats, 2, false);
 466         if (ret)
 467                 goto err;
 468
 469         /* Set up the plane properties */
 470         plane->props.colorkey = drm_property_create_range(
 471                         device, 0, "colorkey", 0, 0x01ffffff);
 472         plane->props.brightness = drm_property_create_range(
 473                         device, 0, "brightness", 0, 1024);
 474         if (!plane->props.colorkey ||
 475             !plane->props.brightness)
 476                 goto cleanup;
 477
 478         plane->colorkey = 0;
 479         drm_object_attach_property(&plane->base.base,
 480                                    plane->props.colorkey, plane->colorkey);
 481
 482         plane->brightness = 512;
 483         drm_object_attach_property(&plane->base.base,
 484                                    plane->props.brightness, plane->brightness);
 485
 486         nv04_disable_plane(&plane->base);
 487         return;
 488 cleanup:
 489         drm_plane_cleanup(&plane->base);
 490 err:
 491         kfree(plane);
 492         NV_ERROR(drm, "Failed to create plane\n");
 493 }
 494
 495 void
 496 nouveau_overlay_init(struct drm_device *device)
 497 {
 498         struct nvif_device *dev = &nouveau_drm(device)->device;
 499         if (dev->info.chipset < 0x10)
 500                 nv04_overlay_init(device);
 501         else if (dev->info.chipset <= 0x40)
 502                 nv10_overlay_init(device);
 503 }