1 /* 2 * Copyright (C) 2011-2013 Intel Corporation 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 (including the next 12 * paragraph) shall be included in all copies or substantial portions of the 13 * Software. 14 * 15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 20 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 21 * SOFTWARE. 22 */ 23 24 #include <linux/errno.h> 25 #include <linux/export.h> 26 #include <linux/kernel.h> 27 #include <drm/drmP.h> 28 #include <drm/drm_rect.h> 29 30 /** 31 * drm_rect_intersect - intersect two rectangles 32 * @r1: first rectangle 33 * @r2: second rectangle 34 * 35 * Calculate the intersection of rectangles @r1 and @r2. 36 * @r1 will be overwritten with the intersection. 37 * 38 * RETURNS: 39 * %true if rectangle @r1 is still visible after the operation, 40 * %false otherwise. 41 */ 42 bool drm_rect_intersect(struct drm_rect *r1, const struct drm_rect *r2) 43 { 44 r1->x1 = max(r1->x1, r2->x1); 45 r1->y1 = max(r1->y1, r2->y1); 46 r1->x2 = min(r1->x2, r2->x2); 47 r1->y2 = min(r1->y2, r2->y2); 48 49 return drm_rect_visible(r1); 50 } 51 EXPORT_SYMBOL(drm_rect_intersect); 52 53 /** 54 * drm_rect_clip_scaled - perform a scaled clip operation 55 * @src: source window rectangle 56 * @dst: destination window rectangle 57 * @clip: clip rectangle 58 * @hscale: horizontal scaling factor 59 * @vscale: vertical scaling factor 60 * 61 * Clip rectangle @dst by rectangle @clip. Clip rectangle @src by the 62 * same amounts multiplied by @hscale and @vscale. 63 * 64 * RETURNS: 65 * %true if rectangle @dst is still visible after being clipped, 66 * %false otherwise 67 */ 68 bool drm_rect_clip_scaled(struct drm_rect *src, struct drm_rect *dst, 69 const struct drm_rect *clip, 70 int hscale, int vscale) 71 { 72 int diff; 73 74 diff = clip->x1 - dst->x1; 75 if (diff > 0) { 76 int64_t tmp = src->x1 + (int64_t) diff * hscale; 77 src->x1 = clamp_t(int64_t, tmp, INT_MIN, INT_MAX); 78 } 79 diff = clip->y1 - dst->y1; 80 if (diff > 0) { 81 int64_t tmp = src->y1 + (int64_t) diff * vscale; 82 src->y1 = clamp_t(int64_t, tmp, INT_MIN, INT_MAX); 83 } 84 diff = dst->x2 - clip->x2; 85 if (diff > 0) { 86 int64_t tmp = src->x2 - (int64_t) diff * hscale; 87 src->x2 = clamp_t(int64_t, tmp, INT_MIN, INT_MAX); 88 } 89 diff = dst->y2 - clip->y2; 90 if (diff > 0) { 91 int64_t tmp = src->y2 - (int64_t) diff * vscale; 92 src->y2 = clamp_t(int64_t, tmp, INT_MIN, INT_MAX); 93 } 94 95 return drm_rect_intersect(dst, clip); 96 } 97 EXPORT_SYMBOL(drm_rect_clip_scaled); 98 99 static int drm_calc_scale(int src, int dst) 100 { 101 int scale = 0; 102 103 if (src < 0 || dst < 0) 104 return -EINVAL; 105 106 if (dst == 0) 107 return 0; 108 109 scale = src / dst; 110 111 return scale; 112 } 113 114 /** 115 * drm_rect_calc_hscale - calculate the horizontal scaling factor 116 * @src: source window rectangle 117 * @dst: destination window rectangle 118 * @min_hscale: minimum allowed horizontal scaling factor 119 * @max_hscale: maximum allowed horizontal scaling factor 120 * 121 * Calculate the horizontal scaling factor as 122 * (@src width) / (@dst width). 123 * 124 * RETURNS: 125 * The horizontal scaling factor, or errno of out of limits. 126 */ 127 int drm_rect_calc_hscale(const struct drm_rect *src, 128 const struct drm_rect *dst, 129 int min_hscale, int max_hscale) 130 { 131 int src_w = drm_rect_width(src); 132 int dst_w = drm_rect_width(dst); 133 int hscale = drm_calc_scale(src_w, dst_w); 134 135 if (hscale < 0 || dst_w == 0) 136 return hscale; 137 138 if (hscale < min_hscale || hscale > max_hscale) 139 return -ERANGE; 140 141 return hscale; 142 } 143 EXPORT_SYMBOL(drm_rect_calc_hscale); 144 145 /** 146 * drm_rect_calc_vscale - calculate the vertical scaling factor 147 * @src: source window rectangle 148 * @dst: destination window rectangle 149 * @min_vscale: minimum allowed vertical scaling factor 150 * @max_vscale: maximum allowed vertical scaling factor 151 * 152 * Calculate the vertical scaling factor as 153 * (@src height) / (@dst height). 154 * 155 * RETURNS: 156 * The vertical scaling factor, or errno of out of limits. 157 */ 158 int drm_rect_calc_vscale(const struct drm_rect *src, 159 const struct drm_rect *dst, 160 int min_vscale, int max_vscale) 161 { 162 int src_h = drm_rect_height(src); 163 int dst_h = drm_rect_height(dst); 164 int vscale = drm_calc_scale(src_h, dst_h); 165 166 if (vscale < 0 || dst_h == 0) 167 return vscale; 168 169 if (vscale < min_vscale || vscale > max_vscale) 170 return -ERANGE; 171 172 return vscale; 173 } 174 EXPORT_SYMBOL(drm_rect_calc_vscale); 175 176 /** 177 * drm_calc_hscale_relaxed - calculate the horizontal scaling factor 178 * @src: source window rectangle 179 * @dst: destination window rectangle 180 * @min_hscale: minimum allowed horizontal scaling factor 181 * @max_hscale: maximum allowed horizontal scaling factor 182 * 183 * Calculate the horizontal scaling factor as 184 * (@src width) / (@dst width). 185 * 186 * If the calculated scaling factor is below @min_vscale, 187 * decrease the height of rectangle @dst to compensate. 188 * 189 * If the calculated scaling factor is above @max_vscale, 190 * decrease the height of rectangle @src to compensate. 191 * 192 * RETURNS: 193 * The horizontal scaling factor. 194 */ 195 int drm_rect_calc_hscale_relaxed(struct drm_rect *src, 196 struct drm_rect *dst, 197 int min_hscale, int max_hscale) 198 { 199 int src_w = drm_rect_width(src); 200 int dst_w = drm_rect_width(dst); 201 int hscale = drm_calc_scale(src_w, dst_w); 202 203 if (hscale < 0 || dst_w == 0) 204 return hscale; 205 206 if (hscale < min_hscale) { 207 int max_dst_w = src_w / min_hscale; 208 209 drm_rect_adjust_size(dst, max_dst_w - dst_w, 0); 210 211 return min_hscale; 212 } 213 214 if (hscale > max_hscale) { 215 int max_src_w = dst_w * max_hscale; 216 217 drm_rect_adjust_size(src, max_src_w - src_w, 0); 218 219 return max_hscale; 220 } 221 222 return hscale; 223 } 224 EXPORT_SYMBOL(drm_rect_calc_hscale_relaxed); 225 226 /** 227 * drm_rect_calc_vscale_relaxed - calculate the vertical scaling factor 228 * @src: source window rectangle 229 * @dst: destination window rectangle 230 * @min_vscale: minimum allowed vertical scaling factor 231 * @max_vscale: maximum allowed vertical scaling factor 232 * 233 * Calculate the vertical scaling factor as 234 * (@src height) / (@dst height). 235 * 236 * If the calculated scaling factor is below @min_vscale, 237 * decrease the height of rectangle @dst to compensate. 238 * 239 * If the calculated scaling factor is above @max_vscale, 240 * decrease the height of rectangle @src to compensate. 241 * 242 * RETURNS: 243 * The vertical scaling factor. 244 */ 245 int drm_rect_calc_vscale_relaxed(struct drm_rect *src, 246 struct drm_rect *dst, 247 int min_vscale, int max_vscale) 248 { 249 int src_h = drm_rect_height(src); 250 int dst_h = drm_rect_height(dst); 251 int vscale = drm_calc_scale(src_h, dst_h); 252 253 if (vscale < 0 || dst_h == 0) 254 return vscale; 255 256 if (vscale < min_vscale) { 257 int max_dst_h = src_h / min_vscale; 258 259 drm_rect_adjust_size(dst, 0, max_dst_h - dst_h); 260 261 return min_vscale; 262 } 263 264 if (vscale > max_vscale) { 265 int max_src_h = dst_h * max_vscale; 266 267 drm_rect_adjust_size(src, 0, max_src_h - src_h); 268 269 return max_vscale; 270 } 271 272 return vscale; 273 } 274 EXPORT_SYMBOL(drm_rect_calc_vscale_relaxed); 275 276 /** 277 * drm_rect_debug_print - print the rectangle information 278 * @r: rectangle to print 279 * @fixed_point: rectangle is in 16.16 fixed point format 280 */ 281 void drm_rect_debug_print(const struct drm_rect *r, bool fixed_point) 282 { 283 int w = drm_rect_width(r); 284 int h = drm_rect_height(r); 285 286 if (fixed_point) 287 DRM_DEBUG_KMS("%d.%06ux%d.%06u%+d.%06u%+d.%06u\n", 288 w >> 16, ((w & 0xffff) * 15625) >> 10, 289 h >> 16, ((h & 0xffff) * 15625) >> 10, 290 r->x1 >> 16, ((r->x1 & 0xffff) * 15625) >> 10, 291 r->y1 >> 16, ((r->y1 & 0xffff) * 15625) >> 10); 292 else 293 DRM_DEBUG_KMS("%dx%d%+d%+d\n", w, h, r->x1, r->y1); 294 } 295 EXPORT_SYMBOL(drm_rect_debug_print); 296 297 /** 298 * drm_rect_rotate - Rotate the rectangle 299 * @r: rectangle to be rotated 300 * @width: Width of the coordinate space 301 * @height: Height of the coordinate space 302 * @rotation: Transformation to be applied 303 * 304 * Apply @rotation to the coordinates of rectangle @r. 305 * 306 * @width and @height combined with @rotation define 307 * the location of the new origin. 308 * 309 * @width correcsponds to the horizontal and @height 310 * to the vertical axis of the untransformed coordinate 311 * space. 312 */ 313 void drm_rect_rotate(struct drm_rect *r, 314 int width, int height, 315 unsigned int rotation) 316 { 317 struct drm_rect tmp; 318 319 if (rotation & (BIT(DRM_REFLECT_X) | BIT(DRM_REFLECT_Y))) { 320 tmp = *r; 321 322 if (rotation & BIT(DRM_REFLECT_X)) { 323 r->x1 = width - tmp.x2; 324 r->x2 = width - tmp.x1; 325 } 326 327 if (rotation & BIT(DRM_REFLECT_Y)) { 328 r->y1 = height - tmp.y2; 329 r->y2 = height - tmp.y1; 330 } 331 } 332 333 switch (rotation & 0xf) { 334 case BIT(DRM_ROTATE_0): 335 break; 336 case BIT(DRM_ROTATE_90): 337 tmp = *r; 338 r->x1 = tmp.y1; 339 r->x2 = tmp.y2; 340 r->y1 = width - tmp.x2; 341 r->y2 = width - tmp.x1; 342 break; 343 case BIT(DRM_ROTATE_180): 344 tmp = *r; 345 r->x1 = width - tmp.x2; 346 r->x2 = width - tmp.x1; 347 r->y1 = height - tmp.y2; 348 r->y2 = height - tmp.y1; 349 break; 350 case BIT(DRM_ROTATE_270): 351 tmp = *r; 352 r->x1 = height - tmp.y2; 353 r->x2 = height - tmp.y1; 354 r->y1 = tmp.x1; 355 r->y2 = tmp.x2; 356 break; 357 default: 358 break; 359 } 360 } 361 EXPORT_SYMBOL(drm_rect_rotate); 362 363 /** 364 * drm_rect_rotate_inv - Inverse rotate the rectangle 365 * @r: rectangle to be rotated 366 * @width: Width of the coordinate space 367 * @height: Height of the coordinate space 368 * @rotation: Transformation whose inverse is to be applied 369 * 370 * Apply the inverse of @rotation to the coordinates 371 * of rectangle @r. 372 * 373 * @width and @height combined with @rotation define 374 * the location of the new origin. 375 * 376 * @width correcsponds to the horizontal and @height 377 * to the vertical axis of the original untransformed 378 * coordinate space, so that you never have to flip 379 * them when doing a rotatation and its inverse. 380 * That is, if you do: 381 * 382 * drm_rotate(&r, width, height, rotation); 383 * drm_rotate_inv(&r, width, height, rotation); 384 * 385 * you will always get back the original rectangle. 386 */ 387 void drm_rect_rotate_inv(struct drm_rect *r, 388 int width, int height, 389 unsigned int rotation) 390 { 391 struct drm_rect tmp; 392 393 switch (rotation & 0xf) { 394 case BIT(DRM_ROTATE_0): 395 break; 396 case BIT(DRM_ROTATE_90): 397 tmp = *r; 398 r->x1 = width - tmp.y2; 399 r->x2 = width - tmp.y1; 400 r->y1 = tmp.x1; 401 r->y2 = tmp.x2; 402 break; 403 case BIT(DRM_ROTATE_180): 404 tmp = *r; 405 r->x1 = width - tmp.x2; 406 r->x2 = width - tmp.x1; 407 r->y1 = height - tmp.y2; 408 r->y2 = height - tmp.y1; 409 break; 410 case BIT(DRM_ROTATE_270): 411 tmp = *r; 412 r->x1 = tmp.y1; 413 r->x2 = tmp.y2; 414 r->y1 = height - tmp.x2; 415 r->y2 = height - tmp.x1; 416 break; 417 default: 418 break; 419 } 420 421 if (rotation & (BIT(DRM_REFLECT_X) | BIT(DRM_REFLECT_Y))) { 422 tmp = *r; 423 424 if (rotation & BIT(DRM_REFLECT_X)) { 425 r->x1 = width - tmp.x2; 426 r->x2 = width - tmp.x1; 427 } 428 429 if (rotation & BIT(DRM_REFLECT_Y)) { 430 r->y1 = height - tmp.y2; 431 r->y2 = height - tmp.y1; 432 } 433 } 434 } 435 EXPORT_SYMBOL(drm_rect_rotate_inv); 436