1 /*
2 * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are
6 * met:
7 *   * Redistributions of source code must retain the above copyright
8 *     notice, this list of conditions and the following disclaimer.
9 *   * Redistributions in binary form must reproduce the above
10 *     copyright notice, this list of conditions and the following
11 *     disclaimer in the documentation and/or other materials provided
12 *     with the distribution.
13 *   * Neither the name of The Linux Foundation nor the names of its
14 *     contributors may be used to endorse or promote products derived
15 *     from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
18 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
20 * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
21 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
24 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
25 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
26 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
27 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29 
30 #include <math.h>
31 #include <utils/rect.h>
32 #include <utils/constants.h>
33 #include <algorithm>
34 
35 #define __CLASS__ "RectUtils"
36 
37 namespace sdm {
38 
IsValid(const LayerRect & rect)39 bool IsValid(const LayerRect &rect) {
40   return ((rect.bottom > rect.top) && (rect.right > rect.left));
41 }
42 
IsCongruent(const LayerRect & rect1,const LayerRect & rect2)43 bool IsCongruent(const LayerRect &rect1, const LayerRect &rect2) {
44   return ((rect1.left == rect2.left) &&
45           (rect1.top == rect2.top) &&
46           (rect1.right == rect2.right) &&
47           (rect1.bottom == rect2.bottom));
48 }
49 
LogI(DebugTag debug_tag,const char * prefix,const LayerRect & roi)50 void LogI(DebugTag debug_tag, const char *prefix, const LayerRect &roi) {
51   DLOGI_IF(debug_tag, "%s: left = %.0f, top = %.0f, right = %.0f, bottom = %.0f",
52            prefix, roi.left, roi.top, roi.right, roi.bottom);
53 }
54 
Log(DebugTag debug_tag,const char * prefix,const LayerRect & roi)55 void Log(DebugTag debug_tag, const char *prefix, const LayerRect &roi) {
56   DLOGV_IF(debug_tag, "%s: left = %.0f, top = %.0f, right = %.0f, bottom = %.0f",
57            prefix, roi.left, roi.top, roi.right, roi.bottom);
58 }
59 
Normalize(const uint32_t & align_x,const uint32_t & align_y,LayerRect * rect)60 void Normalize(const uint32_t &align_x, const uint32_t &align_y, LayerRect *rect) {
61     rect->left = ROUND_UP_ALIGN_UP(rect->left, align_x);
62     rect->right = ROUND_UP_ALIGN_DOWN(rect->right, align_x);
63     rect->top = ROUND_UP_ALIGN_UP(rect->top, align_y);
64     rect->bottom = ROUND_UP_ALIGN_DOWN(rect->bottom, align_y);
65 }
66 
Intersection(const LayerRect & rect1,const LayerRect & rect2)67 LayerRect Intersection(const LayerRect &rect1, const LayerRect &rect2) {
68   LayerRect res;
69 
70   if (!IsValid(rect1) || !IsValid(rect2)) {
71     return LayerRect();
72   }
73 
74   res.left = std::max(rect1.left, rect2.left);
75   res.top = std::max(rect1.top, rect2.top);
76   res.right = std::min(rect1.right, rect2.right);
77   res.bottom = std::min(rect1.bottom, rect2.bottom);
78 
79   if (!IsValid(res)) {
80     return LayerRect();
81   }
82 
83   return res;
84 }
85 
Reposition(const LayerRect & rect,const int & x_offset,const int & y_offset)86 LayerRect Reposition(const LayerRect &rect, const int &x_offset, const int &y_offset) {
87   LayerRect res;
88 
89   if (!IsValid(rect)) {
90     return LayerRect();
91   }
92 
93   res.left = rect.left + FLOAT(x_offset);
94   res.top = rect.top + FLOAT(y_offset);
95   res.right = rect.right + FLOAT(x_offset);
96   res.bottom = rect.bottom + FLOAT(y_offset);
97 
98   return res;
99 }
100 
101 // Is rect2 completely inside rect1?
Contains(const LayerRect & rect1,const LayerRect & rect2)102 bool Contains(const LayerRect &rect1, const LayerRect &rect2) {
103   if (!IsValid(rect1) || !IsValid(rect2)) {
104     return false;
105   }
106   return (rect1.top <= rect2.top && rect1.bottom >= rect2.bottom &&
107           rect1.left <= rect2.left && rect1.right >= rect2.right);
108 }
109 
110 // subtracts 2 rects iff result of subtraction is 2 rects.
Subtract(const LayerRect & rect1,const LayerRect & rect2,LayerRect * res)111 void Subtract(const LayerRect &rect1, const LayerRect &rect2, LayerRect *res) {
112   if (!res) {
113     return;
114   }
115   if (!IsValid(rect1) || !IsValid(rect2)) {
116     return;
117   }
118 
119   if (rect1.left != rect2.left || rect1.right != rect2.right) {
120     return;
121   }
122   res[0].left = rect1.left;
123   res[0].right = rect1.right;
124   if (rect1.top < rect2.top) {
125     res[0].top = rect1.top;
126     res[0].bottom = rect2.top;
127   } else {
128     res[0].top = rect2.top;
129     res[0].bottom = rect1.top;
130   }
131   res[1].left = rect1.left;
132   res[1].right = rect1.right;
133   if (rect1.bottom < rect2.bottom) {
134     res[1].top = rect1.bottom;
135     res[1].bottom = rect2.bottom;
136   } else {
137     res[1].top = rect2.bottom;
138     res[1].bottom = rect1.bottom;
139   }
140 }
141 
142 // Not a geometrical rect deduction. Deducts rect2 from rect1 only if it results a single rect
Subtract(const LayerRect & rect1,const LayerRect & rect2)143 LayerRect Subtract(const LayerRect &rect1, const LayerRect &rect2) {
144   LayerRect res;
145 
146   res = rect1;
147 
148   if ((rect1.left == rect2.left) && (rect1.right == rect2.right)) {
149     if ((rect1.top == rect2.top) && (rect2.bottom <= rect1.bottom)) {
150       res.top = rect2.bottom;
151     } else if ((rect1.bottom == rect2.bottom) && (rect2.top >= rect1.top)) {
152       res.bottom = rect2.top;
153     }
154   } else if ((rect1.top == rect2.top) && (rect1.bottom == rect2.bottom)) {
155     if ((rect1.left == rect2.left) && (rect2.right <= rect1.right)) {
156       res.left = rect2.right;
157     } else if ((rect1.right == rect2.right) && (rect2.left >= rect1.left)) {
158       res.right = rect2.left;
159     }
160   }
161 
162   return res;
163 }
164 
Union(const LayerRect & rect1,const LayerRect & rect2)165 LayerRect Union(const LayerRect &rect1, const LayerRect &rect2) {
166   LayerRect res;
167 
168   if (!IsValid(rect1) && !IsValid(rect2)) {
169     return LayerRect();
170   }
171 
172   if (!IsValid(rect1)) {
173     return rect2;
174   }
175 
176   if (!IsValid(rect2)) {
177     return rect1;
178   }
179 
180   res.left = std::min(rect1.left, rect2.left);
181   res.top = std::min(rect1.top, rect2.top);
182   res.right = std::max(rect1.right, rect2.right);
183   res.bottom = std::max(rect1.bottom, rect2.bottom);
184 
185   return res;
186 }
187 
SplitLeftRight(const LayerRect & in_rect,uint32_t split_count,uint32_t align_x,bool flip_horizontal,LayerRect * out_rects)188 void SplitLeftRight(const LayerRect &in_rect, uint32_t split_count, uint32_t align_x,
189                     bool flip_horizontal, LayerRect *out_rects) {
190   LayerRect rect_temp = in_rect;
191 
192   uint32_t split_width = UINT32(rect_temp.right - rect_temp.left) / split_count;
193   float aligned_width = FLOAT(CeilToMultipleOf(split_width, align_x));
194 
195   for (uint32_t count = 0; count < split_count; count++) {
196     float aligned_right = rect_temp.left + aligned_width;
197     out_rects[count].left = rect_temp.left;
198     out_rects[count].right = std::min(rect_temp.right, aligned_right);
199     out_rects[count].top = rect_temp.top;
200     out_rects[count].bottom = rect_temp.bottom;
201 
202     rect_temp.left = out_rects[count].right;
203 
204     Log(kTagRotator, "SplitLeftRight", out_rects[count]);
205   }
206 
207   // If we have a horizontal flip, then we should be splitting the source from right to left
208   // to ensure that the right split will have an aligned width that matches the alignment on the
209   // destination.
210   if (flip_horizontal && split_count > 1) {
211     out_rects[0].right = out_rects[0].left + (out_rects[1].right - out_rects[1].left);
212     out_rects[1].left = out_rects[0].right;
213     Log(kTagRotator, "Adjusted Left", out_rects[0]);
214     Log(kTagRotator, "Adjusted Right", out_rects[1]);
215   }
216 }
217 
SplitTopBottom(const LayerRect & in_rect,uint32_t split_count,uint32_t align_y,bool flip_horizontal,LayerRect * out_rects)218 void SplitTopBottom(const LayerRect &in_rect, uint32_t split_count, uint32_t align_y,
219                     bool flip_horizontal, LayerRect *out_rects) {
220   LayerRect rect_temp = in_rect;
221 
222   uint32_t split_height = UINT32(rect_temp.bottom - rect_temp.top) / split_count;
223   float aligned_height = FLOAT(CeilToMultipleOf(split_height, align_y));
224 
225   for (uint32_t count = 0; count < split_count; count++) {
226     float aligned_bottom = rect_temp.top + aligned_height;
227     out_rects[count].top = rect_temp.top;
228     out_rects[count].bottom = std::min(rect_temp.bottom, aligned_bottom);
229     out_rects[count].left = rect_temp.left;
230     out_rects[count].right = rect_temp.right;
231 
232     rect_temp.top = out_rects[count].bottom;
233 
234     Log(kTagRotator, "SplitTopBottom", out_rects[count]);
235   }
236 
237   // If we have a horizontal flip, then we should be splitting the destination from bottom to top
238   // to ensure that the bottom split's y-offset is aligned correctly after we swap the destinations
239   // while accounting for the flip.
240   if (flip_horizontal && split_count > 1) {
241     out_rects[0].bottom = out_rects[0].top + (out_rects[1].bottom - out_rects[1].top);
242     out_rects[1].top = out_rects[0].bottom;
243     Log(kTagRotator, "Adjusted Top", out_rects[0]);
244     Log(kTagRotator, "Adjusted Bottom", out_rects[1]);
245   }
246 }
247 
MapRect(const LayerRect & src_domain,const LayerRect & dst_domain,const LayerRect & in_rect,LayerRect * out_rect)248 void MapRect(const LayerRect &src_domain, const LayerRect &dst_domain, const LayerRect &in_rect,
249              LayerRect *out_rect) {
250   if (!IsValid(src_domain) || !IsValid(dst_domain) || !IsValid(in_rect)) {
251     return;
252   }
253 
254   int x_offset = INT(src_domain.left);
255   int y_offset = INT(src_domain.top);
256 
257   LayerRect modified_in_rect = Reposition(in_rect, -x_offset, -y_offset);
258   double src_domain_width = DOUBLE(src_domain.right - src_domain.left);
259   double src_domain_height = DOUBLE(src_domain.bottom - src_domain.top);
260   double dst_domain_width = DOUBLE(dst_domain.right - dst_domain.left);
261   double dst_domain_height = DOUBLE(dst_domain.bottom - dst_domain.top);
262 
263   double width_ratio = DOUBLE(dst_domain_width / src_domain_width);
264   double height_ratio = DOUBLE(dst_domain_height / src_domain_height);
265 
266   // using floorf for all since ceilf on float will round to next int value.
267   out_rect->left = floor(dst_domain.left + (width_ratio * modified_in_rect.left));
268   out_rect->top = floor(dst_domain.top + (height_ratio * modified_in_rect.top));
269   out_rect->right = floor(dst_domain.left + (width_ratio * modified_in_rect.right));
270   out_rect->bottom = floor(dst_domain.top + (height_ratio * modified_in_rect.bottom));
271 }
272 
TransformHV(const LayerRect & src_domain,const LayerRect & in_rect,const LayerTransform & transform,LayerRect * out_rect)273 void TransformHV(const LayerRect &src_domain, const LayerRect &in_rect,
274                  const LayerTransform &transform, LayerRect *out_rect) {
275   if (!IsValid(src_domain) || !IsValid(in_rect)) {
276     return;
277   }
278 
279   float in_width = in_rect.right - in_rect.left;
280   float in_height = in_rect.bottom - in_rect.top;
281   float x_offset = in_rect.left - src_domain.left;
282   float y_offset = in_rect.top - src_domain.top;
283   *out_rect = in_rect;
284 
285   if (transform.flip_horizontal) {
286     out_rect->right = src_domain.right - x_offset;
287     out_rect->left = out_rect->right - in_width;
288   }
289 
290   if (transform.flip_vertical) {
291     out_rect->bottom = src_domain.bottom - y_offset;
292     out_rect->top = out_rect->bottom - in_height;
293   }
294 }
295 
GetOrientation(const LayerRect & in_rect)296 RectOrientation GetOrientation(const LayerRect &in_rect) {
297   if (!IsValid(in_rect)) {
298     return kOrientationUnknown;
299   }
300 
301   float input_width = in_rect.right - in_rect.left;
302   float input_height = in_rect.bottom - in_rect.top;
303 
304   if (input_width < input_height) {
305     return kOrientationPortrait;
306   }
307 
308   return kOrientationLandscape;
309 }
310 
GetCropAndDestination(const LayerRect & crop,const LayerRect & dst,const bool rotated90,float * crop_width,float * crop_height,float * dst_width,float * dst_height)311 DisplayError GetCropAndDestination(const LayerRect &crop, const LayerRect &dst,
312                                    const bool rotated90, float *crop_width,
313                                    float *crop_height, float *dst_width,
314                                    float *dst_height) {
315   if (!IsValid(crop)) {
316     Log(kTagResources, "Invalid crop rect", crop);
317     return kErrorNotSupported;
318   }
319 
320   if (!IsValid(dst)) {
321     Log(kTagResources, "Invalid dst rect", dst);
322     return kErrorNotSupported;
323   }
324 
325   *crop_width = crop.right - crop.left;
326   *crop_height = crop.bottom - crop.top;
327   if (rotated90) {
328     std::swap(*crop_width, *crop_height);
329   }
330 
331   *dst_width = dst.right - dst.left;
332   *dst_height = dst.bottom - dst.top;
333 
334   return kErrorNone;
335 }
336 
GetScaleFactor(const LayerRect & crop,const LayerRect & dst,bool rotated90,float * scale_x,float * scale_y)337 DisplayError GetScaleFactor(const LayerRect &crop, const LayerRect &dst,
338                             bool rotated90, float *scale_x, float *scale_y) {
339   float crop_width = 1.0f, crop_height = 1.0f, dst_width = 1.0f, dst_height = 1.0f;
340 
341   DisplayError error = GetCropAndDestination(crop, dst, rotated90, &crop_width, &crop_height,
342                                              &dst_width, &dst_height);
343   if (error != kErrorNone) {
344     return error;
345   }
346 
347   *scale_x = crop_width / dst_width;
348   *scale_y = crop_height / dst_height;
349 
350   return kErrorNone;
351 }
352 
353 }  // namespace sdm
354 
355