| /* |
| * Copyright (C) 2011-2013 Intel Corporation |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a |
| * copy of this software and associated documentation files (the "Software"), |
| * to deal in the Software without restriction, including without limitation |
| * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| * and/or sell copies of the Software, and to permit persons to whom the |
| * Software is furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice (including the next |
| * paragraph) shall be included in all copies or substantial portions of the |
| * Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| * SOFTWARE. |
| */ |
| |
| #include <linux/errno.h> |
| #include <linux/export.h> |
| #include <linux/kernel.h> |
| |
| #include <drm/drm_mode.h> |
| #include <drm/drm_print.h> |
| #include <drm/drm_rect.h> |
| |
| /** |
| * drm_rect_intersect - intersect two rectangles |
| * @r1: first rectangle |
| * @r2: second rectangle |
| * |
| * Calculate the intersection of rectangles @r1 and @r2. |
| * @r1 will be overwritten with the intersection. |
| * |
| * RETURNS: |
| * %true if rectangle @r1 is still visible after the operation, |
| * %false otherwise. |
| */ |
| bool drm_rect_intersect(struct drm_rect *r1, const struct drm_rect *r2) |
| { |
| r1->x1 = max(r1->x1, r2->x1); |
| r1->y1 = max(r1->y1, r2->y1); |
| r1->x2 = min(r1->x2, r2->x2); |
| r1->y2 = min(r1->y2, r2->y2); |
| |
| return drm_rect_visible(r1); |
| } |
| EXPORT_SYMBOL(drm_rect_intersect); |
| |
| static u32 clip_scaled(int src, int dst, int *clip) |
| { |
| u64 tmp; |
| |
| if (dst == 0) |
| return 0; |
| |
| /* Only clip what we have. Keeps the result bounded. */ |
| *clip = min(*clip, dst); |
| |
| tmp = mul_u32_u32(src, dst - *clip); |
| |
| /* |
| * Round toward 1.0 when clipping so that we don't accidentally |
| * change upscaling to downscaling or vice versa. |
| */ |
| if (src < (dst << 16)) |
| return DIV_ROUND_UP_ULL(tmp, dst); |
| else |
| return DIV_ROUND_DOWN_ULL(tmp, dst); |
| } |
| |
| /** |
| * drm_rect_clip_scaled - perform a scaled clip operation |
| * @src: source window rectangle |
| * @dst: destination window rectangle |
| * @clip: clip rectangle |
| * |
| * Clip rectangle @dst by rectangle @clip. Clip rectangle @src by |
| * the corresponding amounts, retaining the vertical and horizontal scaling |
| * factors from @src to @dst. |
| * |
| * RETURNS: |
| * %true if rectangle @dst is still visible after being clipped, |
| * %false otherwise. |
| */ |
| bool drm_rect_clip_scaled(struct drm_rect *src, struct drm_rect *dst, |
| const struct drm_rect *clip) |
| { |
| int diff; |
| |
| diff = clip->x1 - dst->x1; |
| if (diff > 0) { |
| u32 new_src_w = clip_scaled(drm_rect_width(src), |
| drm_rect_width(dst), &diff); |
| |
| src->x1 = src->x2 - new_src_w; |
| dst->x1 += diff; |
| } |
| diff = clip->y1 - dst->y1; |
| if (diff > 0) { |
| u32 new_src_h = clip_scaled(drm_rect_height(src), |
| drm_rect_height(dst), &diff); |
| |
| src->y1 = src->y2 - new_src_h; |
| dst->y1 += diff; |
| } |
| diff = dst->x2 - clip->x2; |
| if (diff > 0) { |
| u32 new_src_w = clip_scaled(drm_rect_width(src), |
| drm_rect_width(dst), &diff); |
| |
| src->x2 = src->x1 + new_src_w; |
| dst->x2 -= diff; |
| } |
| diff = dst->y2 - clip->y2; |
| if (diff > 0) { |
| u32 new_src_h = clip_scaled(drm_rect_height(src), |
| drm_rect_height(dst), &diff); |
| |
| src->y2 = src->y1 + new_src_h; |
| dst->y2 -= diff; |
| } |
| |
| return drm_rect_visible(dst); |
| } |
| EXPORT_SYMBOL(drm_rect_clip_scaled); |
| |
| static int drm_calc_scale(int src, int dst) |
| { |
| int scale = 0; |
| |
| if (WARN_ON(src < 0 || dst < 0)) |
| return -EINVAL; |
| |
| if (dst == 0) |
| return 0; |
| |
| if (src > (dst << 16)) |
| return DIV_ROUND_UP(src, dst); |
| else |
| scale = src / dst; |
| |
| return scale; |
| } |
| |
| /** |
| * drm_rect_calc_hscale - calculate the horizontal scaling factor |
| * @src: source window rectangle |
| * @dst: destination window rectangle |
| * @min_hscale: minimum allowed horizontal scaling factor |
| * @max_hscale: maximum allowed horizontal scaling factor |
| * |
| * Calculate the horizontal scaling factor as |
| * (@src width) / (@dst width). |
| * |
| * If the scale is below 1 << 16, round down. If the scale is above |
| * 1 << 16, round up. This will calculate the scale with the most |
| * pessimistic limit calculation. |
| * |
| * RETURNS: |
| * The horizontal scaling factor, or errno of out of limits. |
| */ |
| int drm_rect_calc_hscale(const struct drm_rect *src, |
| const struct drm_rect *dst, |
| int min_hscale, int max_hscale) |
| { |
| int src_w = drm_rect_width(src); |
| int dst_w = drm_rect_width(dst); |
| int hscale = drm_calc_scale(src_w, dst_w); |
| |
| if (hscale < 0 || dst_w == 0) |
| return hscale; |
| |
| if (hscale < min_hscale || hscale > max_hscale) |
| return -ERANGE; |
| |
| return hscale; |
| } |
| EXPORT_SYMBOL(drm_rect_calc_hscale); |
| |
| /** |
| * drm_rect_calc_vscale - calculate the vertical scaling factor |
| * @src: source window rectangle |
| * @dst: destination window rectangle |
| * @min_vscale: minimum allowed vertical scaling factor |
| * @max_vscale: maximum allowed vertical scaling factor |
| * |
| * Calculate the vertical scaling factor as |
| * (@src height) / (@dst height). |
| * |
| * If the scale is below 1 << 16, round down. If the scale is above |
| * 1 << 16, round up. This will calculate the scale with the most |
| * pessimistic limit calculation. |
| * |
| * RETURNS: |
| * The vertical scaling factor, or errno of out of limits. |
| */ |
| int drm_rect_calc_vscale(const struct drm_rect *src, |
| const struct drm_rect *dst, |
| int min_vscale, int max_vscale) |
| { |
| int src_h = drm_rect_height(src); |
| int dst_h = drm_rect_height(dst); |
| int vscale = drm_calc_scale(src_h, dst_h); |
| |
| if (vscale < 0 || dst_h == 0) |
| return vscale; |
| |
| if (vscale < min_vscale || vscale > max_vscale) |
| return -ERANGE; |
| |
| return vscale; |
| } |
| EXPORT_SYMBOL(drm_rect_calc_vscale); |
| |
| /** |
| * drm_rect_debug_print - print the rectangle information |
| * @prefix: prefix string |
| * @r: rectangle to print |
| * @fixed_point: rectangle is in 16.16 fixed point format |
| */ |
| void drm_rect_debug_print(const char *prefix, const struct drm_rect *r, bool fixed_point) |
| { |
| if (fixed_point) |
| DRM_DEBUG_KMS("%s" DRM_RECT_FP_FMT "\n", prefix, DRM_RECT_FP_ARG(r)); |
| else |
| DRM_DEBUG_KMS("%s" DRM_RECT_FMT "\n", prefix, DRM_RECT_ARG(r)); |
| } |
| EXPORT_SYMBOL(drm_rect_debug_print); |
| |
| /** |
| * drm_rect_rotate - Rotate the rectangle |
| * @r: rectangle to be rotated |
| * @width: Width of the coordinate space |
| * @height: Height of the coordinate space |
| * @rotation: Transformation to be applied |
| * |
| * Apply @rotation to the coordinates of rectangle @r. |
| * |
| * @width and @height combined with @rotation define |
| * the location of the new origin. |
| * |
| * @width correcsponds to the horizontal and @height |
| * to the vertical axis of the untransformed coordinate |
| * space. |
| */ |
| void drm_rect_rotate(struct drm_rect *r, |
| int width, int height, |
| unsigned int rotation) |
| { |
| struct drm_rect tmp; |
| |
| if (rotation & (DRM_MODE_REFLECT_X | DRM_MODE_REFLECT_Y)) { |
| tmp = *r; |
| |
| if (rotation & DRM_MODE_REFLECT_X) { |
| r->x1 = width - tmp.x2; |
| r->x2 = width - tmp.x1; |
| } |
| |
| if (rotation & DRM_MODE_REFLECT_Y) { |
| r->y1 = height - tmp.y2; |
| r->y2 = height - tmp.y1; |
| } |
| } |
| |
| switch (rotation & DRM_MODE_ROTATE_MASK) { |
| case DRM_MODE_ROTATE_0: |
| break; |
| case DRM_MODE_ROTATE_90: |
| tmp = *r; |
| r->x1 = tmp.y1; |
| r->x2 = tmp.y2; |
| r->y1 = width - tmp.x2; |
| r->y2 = width - tmp.x1; |
| break; |
| case DRM_MODE_ROTATE_180: |
| tmp = *r; |
| r->x1 = width - tmp.x2; |
| r->x2 = width - tmp.x1; |
| r->y1 = height - tmp.y2; |
| r->y2 = height - tmp.y1; |
| break; |
| case DRM_MODE_ROTATE_270: |
| tmp = *r; |
| r->x1 = height - tmp.y2; |
| r->x2 = height - tmp.y1; |
| r->y1 = tmp.x1; |
| r->y2 = tmp.x2; |
| break; |
| default: |
| break; |
| } |
| } |
| EXPORT_SYMBOL(drm_rect_rotate); |
| |
| /** |
| * drm_rect_rotate_inv - Inverse rotate the rectangle |
| * @r: rectangle to be rotated |
| * @width: Width of the coordinate space |
| * @height: Height of the coordinate space |
| * @rotation: Transformation whose inverse is to be applied |
| * |
| * Apply the inverse of @rotation to the coordinates |
| * of rectangle @r. |
| * |
| * @width and @height combined with @rotation define |
| * the location of the new origin. |
| * |
| * @width correcsponds to the horizontal and @height |
| * to the vertical axis of the original untransformed |
| * coordinate space, so that you never have to flip |
| * them when doing a rotatation and its inverse. |
| * That is, if you do :: |
| * |
| * drm_rect_rotate(&r, width, height, rotation); |
| * drm_rect_rotate_inv(&r, width, height, rotation); |
| * |
| * you will always get back the original rectangle. |
| */ |
| void drm_rect_rotate_inv(struct drm_rect *r, |
| int width, int height, |
| unsigned int rotation) |
| { |
| struct drm_rect tmp; |
| |
| switch (rotation & DRM_MODE_ROTATE_MASK) { |
| case DRM_MODE_ROTATE_0: |
| break; |
| case DRM_MODE_ROTATE_90: |
| tmp = *r; |
| r->x1 = width - tmp.y2; |
| r->x2 = width - tmp.y1; |
| r->y1 = tmp.x1; |
| r->y2 = tmp.x2; |
| break; |
| case DRM_MODE_ROTATE_180: |
| tmp = *r; |
| r->x1 = width - tmp.x2; |
| r->x2 = width - tmp.x1; |
| r->y1 = height - tmp.y2; |
| r->y2 = height - tmp.y1; |
| break; |
| case DRM_MODE_ROTATE_270: |
| tmp = *r; |
| r->x1 = tmp.y1; |
| r->x2 = tmp.y2; |
| r->y1 = height - tmp.x2; |
| r->y2 = height - tmp.x1; |
| break; |
| default: |
| break; |
| } |
| |
| if (rotation & (DRM_MODE_REFLECT_X | DRM_MODE_REFLECT_Y)) { |
| tmp = *r; |
| |
| if (rotation & DRM_MODE_REFLECT_X) { |
| r->x1 = width - tmp.x2; |
| r->x2 = width - tmp.x1; |
| } |
| |
| if (rotation & DRM_MODE_REFLECT_Y) { |
| r->y1 = height - tmp.y2; |
| r->y2 = height - tmp.y1; |
| } |
| } |
| } |
| EXPORT_SYMBOL(drm_rect_rotate_inv); |