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/drm_crtc.h>
27 #include <drm/drm_fourcc.h>
28
29 #include "nouveau_drv.h"
30
31 #include "nouveau_bo.h"
32 #include "nouveau_connector.h"
33 #include "nouveau_display.h"
34 #include "nouveau_gem.h"
35 #include "nvreg.h"
36 #include "disp.h"
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 } props;
50
51 int colorkey;
52 int contrast;
53 int brightness;
54 int hue;
55 int saturation;
56 enum drm_color_encoding color_encoding;
57
58 void (*set_params)(struct nouveau_plane *);
59 };
60
61 static uint32_t formats[] = {
62 DRM_FORMAT_YUYV,
63 DRM_FORMAT_UYVY,
64 DRM_FORMAT_NV12,
65 DRM_FORMAT_NV21,
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
sin_mul(int degrees,int factor)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
cos_mul(int degrees,int factor)87 cos_mul(int degrees, int factor)
88 {
89 return sin_mul((degrees + 90) % 360, factor);
90 }
91
92 static int
verify_scaling(const struct drm_framebuffer * fb,uint8_t shift,uint32_t src_x,uint32_t src_y,uint32_t src_w,uint32_t src_h,uint32_t crtc_w,uint32_t crtc_h)93 verify_scaling(const struct drm_framebuffer *fb, uint8_t shift,
94 uint32_t src_x, uint32_t src_y, uint32_t src_w, uint32_t src_h,
95 uint32_t crtc_w, uint32_t crtc_h)
96 {
97 if (crtc_w < (src_w >> shift) || crtc_h < (src_h >> shift)) {
98 DRM_DEBUG_KMS("Unsuitable framebuffer scaling: %dx%d -> %dx%d\n",
99 src_w, src_h, crtc_w, crtc_h);
100 return -ERANGE;
101 }
102
103 if (src_x != 0 || src_y != 0) {
104 DRM_DEBUG_KMS("Unsuitable framebuffer offset: %d,%d\n",
105 src_x, src_y);
106 return -ERANGE;
107 }
108
109 return 0;
110 }
111
112 static int
nv10_update_plane(struct drm_plane * plane,struct drm_crtc * crtc,struct drm_framebuffer * fb,int crtc_x,int crtc_y,unsigned int crtc_w,unsigned int crtc_h,uint32_t src_x,uint32_t src_y,uint32_t src_w,uint32_t src_h,struct drm_modeset_acquire_ctx * ctx)113 nv10_update_plane(struct drm_plane *plane, struct drm_crtc *crtc,
114 struct drm_framebuffer *fb, int crtc_x, int crtc_y,
115 unsigned int crtc_w, unsigned int crtc_h,
116 uint32_t src_x, uint32_t src_y,
117 uint32_t src_w, uint32_t src_h,
118 struct drm_modeset_acquire_ctx *ctx)
119 {
120 struct nouveau_drm *drm = nouveau_drm(plane->dev);
121 struct nvif_object *dev = &drm->client.device.object;
122 struct nouveau_plane *nv_plane =
123 container_of(plane, struct nouveau_plane, base);
124 struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
125 struct nouveau_bo *cur = nv_plane->cur;
126 struct nouveau_bo *nvbo;
127 bool flip = nv_plane->flip;
128 int soff = NV_PCRTC0_SIZE * nv_crtc->index;
129 int soff2 = NV_PCRTC0_SIZE * !nv_crtc->index;
130 unsigned shift = drm->client.device.info.chipset >= 0x30 ? 1 : 3;
131 unsigned format = 0;
132 int ret;
133
134 /* Source parameters given in 16.16 fixed point, ignore fractional. */
135 src_x >>= 16;
136 src_y >>= 16;
137 src_w >>= 16;
138 src_h >>= 16;
139
140 ret = verify_scaling(fb, shift, 0, 0, src_w, src_h, crtc_w, crtc_h);
141 if (ret)
142 return ret;
143
144 nvbo = nouveau_gem_object(fb->obj[0]);
145 ret = nouveau_bo_pin(nvbo, NOUVEAU_GEM_DOMAIN_VRAM, false);
146 if (ret)
147 return ret;
148
149 nv_plane->cur = nvbo;
150
151 nvif_mask(dev, NV_PCRTC_ENGINE_CTRL + soff, NV_CRTC_FSEL_OVERLAY, NV_CRTC_FSEL_OVERLAY);
152 nvif_mask(dev, NV_PCRTC_ENGINE_CTRL + soff2, NV_CRTC_FSEL_OVERLAY, 0);
153
154 nvif_wr32(dev, NV_PVIDEO_BASE(flip), 0);
155 nvif_wr32(dev, NV_PVIDEO_OFFSET_BUFF(flip), nvbo->offset);
156 nvif_wr32(dev, NV_PVIDEO_SIZE_IN(flip), src_h << 16 | src_w);
157 nvif_wr32(dev, NV_PVIDEO_POINT_IN(flip), src_y << 16 | src_x);
158 nvif_wr32(dev, NV_PVIDEO_DS_DX(flip), (src_w << 20) / crtc_w);
159 nvif_wr32(dev, NV_PVIDEO_DT_DY(flip), (src_h << 20) / crtc_h);
160 nvif_wr32(dev, NV_PVIDEO_POINT_OUT(flip), crtc_y << 16 | crtc_x);
161 nvif_wr32(dev, NV_PVIDEO_SIZE_OUT(flip), crtc_h << 16 | crtc_w);
162
163 if (fb->format->format == DRM_FORMAT_YUYV ||
164 fb->format->format == DRM_FORMAT_NV12)
165 format |= NV_PVIDEO_FORMAT_COLOR_LE_CR8YB8CB8YA8;
166 if (fb->format->format == DRM_FORMAT_NV12 ||
167 fb->format->format == DRM_FORMAT_NV21)
168 format |= NV_PVIDEO_FORMAT_PLANAR;
169 if (nv_plane->color_encoding == DRM_COLOR_YCBCR_BT709)
170 format |= NV_PVIDEO_FORMAT_MATRIX_ITURBT709;
171 if (nv_plane->colorkey & (1 << 24))
172 format |= NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY;
173
174 if (format & NV_PVIDEO_FORMAT_PLANAR) {
175 nvif_wr32(dev, NV_PVIDEO_UVPLANE_BASE(flip), 0);
176 nvif_wr32(dev, NV_PVIDEO_UVPLANE_OFFSET_BUFF(flip),
177 nvbo->offset + fb->offsets[1]);
178 }
179 nvif_wr32(dev, NV_PVIDEO_FORMAT(flip), format | fb->pitches[0]);
180 nvif_wr32(dev, NV_PVIDEO_STOP, 0);
181 /* TODO: wait for vblank? */
182 nvif_wr32(dev, NV_PVIDEO_BUFFER, flip ? 0x10 : 0x1);
183 nv_plane->flip = !flip;
184
185 if (cur)
186 nouveau_bo_unpin(cur);
187
188 return 0;
189 }
190
191 static int
nv10_disable_plane(struct drm_plane * plane,struct drm_modeset_acquire_ctx * ctx)192 nv10_disable_plane(struct drm_plane *plane,
193 struct drm_modeset_acquire_ctx *ctx)
194 {
195 struct nvif_object *dev = &nouveau_drm(plane->dev)->client.device.object;
196 struct nouveau_plane *nv_plane =
197 container_of(plane, struct nouveau_plane, base);
198
199 nvif_wr32(dev, NV_PVIDEO_STOP, 1);
200 if (nv_plane->cur) {
201 nouveau_bo_unpin(nv_plane->cur);
202 nv_plane->cur = NULL;
203 }
204
205 return 0;
206 }
207
208 static void
nv_destroy_plane(struct drm_plane * plane)209 nv_destroy_plane(struct drm_plane *plane)
210 {
211 drm_plane_force_disable(plane);
212 drm_plane_cleanup(plane);
213 kfree(plane);
214 }
215
216 static void
nv10_set_params(struct nouveau_plane * plane)217 nv10_set_params(struct nouveau_plane *plane)
218 {
219 struct nvif_object *dev = &nouveau_drm(plane->base.dev)->client.device.object;
220 u32 luma = (plane->brightness - 512) << 16 | plane->contrast;
221 u32 chroma = ((sin_mul(plane->hue, plane->saturation) & 0xffff) << 16) |
222 (cos_mul(plane->hue, plane->saturation) & 0xffff);
223 u32 format = 0;
224
225 nvif_wr32(dev, NV_PVIDEO_LUMINANCE(0), luma);
226 nvif_wr32(dev, NV_PVIDEO_LUMINANCE(1), luma);
227 nvif_wr32(dev, NV_PVIDEO_CHROMINANCE(0), chroma);
228 nvif_wr32(dev, NV_PVIDEO_CHROMINANCE(1), chroma);
229 nvif_wr32(dev, NV_PVIDEO_COLOR_KEY, plane->colorkey & 0xffffff);
230
231 if (plane->cur) {
232 if (plane->color_encoding == DRM_COLOR_YCBCR_BT709)
233 format |= NV_PVIDEO_FORMAT_MATRIX_ITURBT709;
234 if (plane->colorkey & (1 << 24))
235 format |= NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY;
236 nvif_mask(dev, NV_PVIDEO_FORMAT(plane->flip),
237 NV_PVIDEO_FORMAT_MATRIX_ITURBT709 |
238 NV_PVIDEO_FORMAT_DISPLAY_COLOR_KEY,
239 format);
240 }
241 }
242
243 static int
nv_set_property(struct drm_plane * plane,struct drm_property * property,uint64_t value)244 nv_set_property(struct drm_plane *plane,
245 struct drm_property *property,
246 uint64_t value)
247 {
248 struct nouveau_plane *nv_plane =
249 container_of(plane, struct nouveau_plane, base);
250
251 if (property == nv_plane->props.colorkey)
252 nv_plane->colorkey = value;
253 else if (property == nv_plane->props.contrast)
254 nv_plane->contrast = value;
255 else if (property == nv_plane->props.brightness)
256 nv_plane->brightness = value;
257 else if (property == nv_plane->props.hue)
258 nv_plane->hue = value;
259 else if (property == nv_plane->props.saturation)
260 nv_plane->saturation = value;
261 else if (property == nv_plane->base.color_encoding_property)
262 nv_plane->color_encoding = value;
263 else
264 return -EINVAL;
265
266 if (nv_plane->set_params)
267 nv_plane->set_params(nv_plane);
268 return 0;
269 }
270
271 static const struct drm_plane_funcs nv10_plane_funcs = {
272 .update_plane = nv10_update_plane,
273 .disable_plane = nv10_disable_plane,
274 .set_property = nv_set_property,
275 .destroy = nv_destroy_plane,
276 };
277
278 static void
nv10_overlay_init(struct drm_device * device)279 nv10_overlay_init(struct drm_device *device)
280 {
281 struct nouveau_drm *drm = nouveau_drm(device);
282 struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL);
283 unsigned int num_formats = ARRAY_SIZE(formats);
284 int ret;
285
286 if (!plane)
287 return;
288
289 switch (drm->client.device.info.chipset) {
290 case 0x10:
291 case 0x11:
292 case 0x15:
293 case 0x1a:
294 case 0x20:
295 num_formats = 2;
296 break;
297 }
298
299 ret = drm_universal_plane_init(device, &plane->base, 3 /* both crtc's */,
300 &nv10_plane_funcs,
301 formats, num_formats, NULL,
302 DRM_PLANE_TYPE_OVERLAY, NULL);
303 if (ret)
304 goto err;
305
306 /* Set up the plane properties */
307 plane->props.colorkey = drm_property_create_range(
308 device, 0, "colorkey", 0, 0x01ffffff);
309 plane->props.contrast = drm_property_create_range(
310 device, 0, "contrast", 0, 8192 - 1);
311 plane->props.brightness = drm_property_create_range(
312 device, 0, "brightness", 0, 1024);
313 plane->props.hue = drm_property_create_range(
314 device, 0, "hue", 0, 359);
315 plane->props.saturation = drm_property_create_range(
316 device, 0, "saturation", 0, 8192 - 1);
317 if (!plane->props.colorkey ||
318 !plane->props.contrast ||
319 !plane->props.brightness ||
320 !plane->props.hue ||
321 !plane->props.saturation)
322 goto cleanup;
323
324 plane->colorkey = 0;
325 drm_object_attach_property(&plane->base.base,
326 plane->props.colorkey, plane->colorkey);
327
328 plane->contrast = 0x1000;
329 drm_object_attach_property(&plane->base.base,
330 plane->props.contrast, plane->contrast);
331
332 plane->brightness = 512;
333 drm_object_attach_property(&plane->base.base,
334 plane->props.brightness, plane->brightness);
335
336 plane->hue = 0;
337 drm_object_attach_property(&plane->base.base,
338 plane->props.hue, plane->hue);
339
340 plane->saturation = 0x1000;
341 drm_object_attach_property(&plane->base.base,
342 plane->props.saturation, plane->saturation);
343
344 plane->color_encoding = DRM_COLOR_YCBCR_BT601;
345 drm_plane_create_color_properties(&plane->base,
346 BIT(DRM_COLOR_YCBCR_BT601) |
347 BIT(DRM_COLOR_YCBCR_BT709),
348 BIT(DRM_COLOR_YCBCR_LIMITED_RANGE),
349 DRM_COLOR_YCBCR_BT601,
350 DRM_COLOR_YCBCR_LIMITED_RANGE);
351
352 plane->set_params = nv10_set_params;
353 nv10_set_params(plane);
354 drm_plane_force_disable(&plane->base);
355 return;
356 cleanup:
357 drm_plane_cleanup(&plane->base);
358 err:
359 kfree(plane);
360 NV_ERROR(drm, "Failed to create plane\n");
361 }
362
363 static int
nv04_update_plane(struct drm_plane * plane,struct drm_crtc * crtc,struct drm_framebuffer * fb,int crtc_x,int crtc_y,unsigned int crtc_w,unsigned int crtc_h,uint32_t src_x,uint32_t src_y,uint32_t src_w,uint32_t src_h,struct drm_modeset_acquire_ctx * ctx)364 nv04_update_plane(struct drm_plane *plane, struct drm_crtc *crtc,
365 struct drm_framebuffer *fb, int crtc_x, int crtc_y,
366 unsigned int crtc_w, unsigned int crtc_h,
367 uint32_t src_x, uint32_t src_y,
368 uint32_t src_w, uint32_t src_h,
369 struct drm_modeset_acquire_ctx *ctx)
370 {
371 struct nvif_object *dev = &nouveau_drm(plane->dev)->client.device.object;
372 struct nouveau_plane *nv_plane =
373 container_of(plane, struct nouveau_plane, base);
374 struct nouveau_bo *cur = nv_plane->cur;
375 struct nouveau_bo *nvbo;
376 uint32_t overlay = 1;
377 int brightness = (nv_plane->brightness - 512) * 62 / 512;
378 int ret, i;
379
380 /* Source parameters given in 16.16 fixed point, ignore fractional. */
381 src_x >>= 16;
382 src_y >>= 16;
383 src_w >>= 16;
384 src_h >>= 16;
385
386 ret = verify_scaling(fb, 0, src_x, src_y, src_w, src_h, crtc_w, crtc_h);
387 if (ret)
388 return ret;
389
390 nvbo = nouveau_gem_object(fb->obj[0]);
391 ret = nouveau_bo_pin(nvbo, NOUVEAU_GEM_DOMAIN_VRAM, false);
392 if (ret)
393 return ret;
394
395 nv_plane->cur = nvbo;
396
397 nvif_wr32(dev, NV_PVIDEO_OE_STATE, 0);
398 nvif_wr32(dev, NV_PVIDEO_SU_STATE, 0);
399 nvif_wr32(dev, NV_PVIDEO_RM_STATE, 0);
400
401 for (i = 0; i < 2; i++) {
402 nvif_wr32(dev, NV_PVIDEO_BUFF0_START_ADDRESS + 4 * i,
403 nvbo->offset);
404 nvif_wr32(dev, NV_PVIDEO_BUFF0_PITCH_LENGTH + 4 * i,
405 fb->pitches[0]);
406 nvif_wr32(dev, NV_PVIDEO_BUFF0_OFFSET + 4 * i, 0);
407 }
408 nvif_wr32(dev, NV_PVIDEO_WINDOW_START, crtc_y << 16 | crtc_x);
409 nvif_wr32(dev, NV_PVIDEO_WINDOW_SIZE, crtc_h << 16 | crtc_w);
410 nvif_wr32(dev, NV_PVIDEO_STEP_SIZE,
411 (uint32_t)(((src_h - 1) << 11) / (crtc_h - 1)) << 16 | (uint32_t)(((src_w - 1) << 11) / (crtc_w - 1)));
412
413 /* It should be possible to convert hue/contrast to this */
414 nvif_wr32(dev, NV_PVIDEO_RED_CSC_OFFSET, 0x69 - brightness);
415 nvif_wr32(dev, NV_PVIDEO_GREEN_CSC_OFFSET, 0x3e + brightness);
416 nvif_wr32(dev, NV_PVIDEO_BLUE_CSC_OFFSET, 0x89 - brightness);
417 nvif_wr32(dev, NV_PVIDEO_CSC_ADJUST, 0);
418
419 nvif_wr32(dev, NV_PVIDEO_CONTROL_Y, 0x001); /* (BLUR_ON, LINE_HALF) */
420 nvif_wr32(dev, NV_PVIDEO_CONTROL_X, 0x111); /* (WEIGHT_HEAVY, SHARPENING_ON, SMOOTHING_ON) */
421
422 nvif_wr32(dev, NV_PVIDEO_FIFO_BURST_LENGTH, 0x03);
423 nvif_wr32(dev, NV_PVIDEO_FIFO_THRES_SIZE, 0x38);
424
425 nvif_wr32(dev, NV_PVIDEO_KEY, nv_plane->colorkey);
426
427 if (nv_plane->colorkey & (1 << 24))
428 overlay |= 0x10;
429 if (fb->format->format == DRM_FORMAT_YUYV)
430 overlay |= 0x100;
431
432 nvif_wr32(dev, NV_PVIDEO_OVERLAY, overlay);
433
434 nvif_wr32(dev, NV_PVIDEO_SU_STATE, nvif_rd32(dev, NV_PVIDEO_SU_STATE) ^ (1 << 16));
435
436 if (cur)
437 nouveau_bo_unpin(cur);
438
439 return 0;
440 }
441
442 static int
nv04_disable_plane(struct drm_plane * plane,struct drm_modeset_acquire_ctx * ctx)443 nv04_disable_plane(struct drm_plane *plane,
444 struct drm_modeset_acquire_ctx *ctx)
445 {
446 struct nvif_object *dev = &nouveau_drm(plane->dev)->client.device.object;
447 struct nouveau_plane *nv_plane =
448 container_of(plane, struct nouveau_plane, base);
449
450 nvif_mask(dev, NV_PVIDEO_OVERLAY, 1, 0);
451 nvif_wr32(dev, NV_PVIDEO_OE_STATE, 0);
452 nvif_wr32(dev, NV_PVIDEO_SU_STATE, 0);
453 nvif_wr32(dev, NV_PVIDEO_RM_STATE, 0);
454 if (nv_plane->cur) {
455 nouveau_bo_unpin(nv_plane->cur);
456 nv_plane->cur = NULL;
457 }
458
459 return 0;
460 }
461
462 static const struct drm_plane_funcs nv04_plane_funcs = {
463 .update_plane = nv04_update_plane,
464 .disable_plane = nv04_disable_plane,
465 .set_property = nv_set_property,
466 .destroy = nv_destroy_plane,
467 };
468
469 static void
nv04_overlay_init(struct drm_device * device)470 nv04_overlay_init(struct drm_device *device)
471 {
472 struct nouveau_drm *drm = nouveau_drm(device);
473 struct nouveau_plane *plane = kzalloc(sizeof(struct nouveau_plane), GFP_KERNEL);
474 int ret;
475
476 if (!plane)
477 return;
478
479 ret = drm_universal_plane_init(device, &plane->base, 1 /* single crtc */,
480 &nv04_plane_funcs, formats, 2, NULL,
481 DRM_PLANE_TYPE_OVERLAY, NULL);
482 if (ret)
483 goto err;
484
485 /* Set up the plane properties */
486 plane->props.colorkey = drm_property_create_range(
487 device, 0, "colorkey", 0, 0x01ffffff);
488 plane->props.brightness = drm_property_create_range(
489 device, 0, "brightness", 0, 1024);
490 if (!plane->props.colorkey ||
491 !plane->props.brightness)
492 goto cleanup;
493
494 plane->colorkey = 0;
495 drm_object_attach_property(&plane->base.base,
496 plane->props.colorkey, plane->colorkey);
497
498 plane->brightness = 512;
499 drm_object_attach_property(&plane->base.base,
500 plane->props.brightness, plane->brightness);
501
502 drm_plane_force_disable(&plane->base);
503 return;
504 cleanup:
505 drm_plane_cleanup(&plane->base);
506 err:
507 kfree(plane);
508 NV_ERROR(drm, "Failed to create plane\n");
509 }
510
511 void
nouveau_overlay_init(struct drm_device * device)512 nouveau_overlay_init(struct drm_device *device)
513 {
514 struct nvif_device *dev = &nouveau_drm(device)->client.device;
515 if (dev->info.chipset < 0x10)
516 nv04_overlay_init(device);
517 else if (dev->info.chipset <= 0x40)
518 nv10_overlay_init(device);
519 }
520