| /* |
| * Copyright (C) 2011 The Android Open Source Project |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| /** |
| ****************************************************************************** |
| * @file M4VIFI_ResizeRGB565toRGB565.c |
| * @brief Contain video library function |
| * @note This file has a Resize filter function |
| * Generic resizing of RGB565 (Planar) image |
| ****************************************************************************** |
| */ |
| /* Prototypes of functions, and type definitions */ |
| #include "M4VIFI_FiltersAPI.h" |
| /* Macro definitions */ |
| #include "M4VIFI_Defines.h" |
| /* Clip table declaration */ |
| #include "M4VIFI_Clip.h" |
| |
| /** |
| *********************************************************************************************** |
| * M4VIFI_UInt8 M4VIFI_ResizeBilinearRGB565toRGB565(void *pUserData, M4VIFI_ImagePlane *pPlaneIn, |
| * M4VIFI_ImagePlane *pPlaneOut) |
| * @brief Resizes RGB565 Planar plane. |
| * @param pUserData: (IN) User Data |
| * @param pPlaneIn: (IN) Pointer to RGB565 (Planar) plane buffer |
| * @param pPlaneOut: (OUT) Pointer to RGB565 (Planar) plane |
| * @return M4VIFI_OK: there is no error |
| * @return M4VIFI_ILLEGAL_FRAME_HEIGHT: Error in height |
| * @return M4VIFI_ILLEGAL_FRAME_WIDTH: Error in width |
| *********************************************************************************************** |
| */ |
| M4VIFI_UInt8 M4VIFI_ResizeBilinearRGB565toRGB565(void *pUserData, |
| M4VIFI_ImagePlane *pPlaneIn, |
| M4VIFI_ImagePlane *pPlaneOut) |
| { |
| M4VIFI_UInt16 *pu16_data_in; |
| M4VIFI_UInt16 *pu16_data_out; |
| M4VIFI_UInt32 u32_width_in, u32_width_out, u32_height_in, u32_height_out; |
| M4VIFI_UInt32 u32_stride_in, u32_stride_out; |
| M4VIFI_UInt32 u32_x_inc, u32_y_inc; |
| M4VIFI_UInt32 u32_x_accum, u32_y_accum, u32_x_accum_start; |
| M4VIFI_UInt32 u32_width, u32_height; |
| M4VIFI_UInt32 u32_y_frac; |
| M4VIFI_UInt32 u32_x_frac; |
| M4VIFI_UInt32 u32_Rtemp_value,u32_Gtemp_value,u32_Btemp_value; |
| M4VIFI_UInt16 *pu16_src_top; |
| M4VIFI_UInt16 *pu16_src_bottom; |
| M4VIFI_UInt32 i32_b00, i32_g00, i32_r00; |
| M4VIFI_UInt32 i32_b01, i32_g01, i32_r01; |
| M4VIFI_UInt32 i32_b02, i32_g02, i32_r02; |
| M4VIFI_UInt32 i32_b03, i32_g03, i32_r03; |
| M4VIFI_UInt8 count_trans=0; |
| |
| /* Check for the RGB width and height are even */ |
| if ((IS_EVEN(pPlaneIn->u_height) == FALSE) || |
| (IS_EVEN(pPlaneOut->u_height) == FALSE)) { |
| return M4VIFI_ILLEGAL_FRAME_HEIGHT; |
| } |
| |
| if ((IS_EVEN(pPlaneIn->u_width) == FALSE) || |
| (IS_EVEN(pPlaneOut->u_width) == FALSE)) { |
| return M4VIFI_ILLEGAL_FRAME_WIDTH; |
| } |
| |
| /* Set the working pointers at the beginning of the input/output data field */ |
| pu16_data_in = (M4VIFI_UInt16*)(pPlaneIn->pac_data + pPlaneIn->u_topleft); |
| pu16_data_out = (M4VIFI_UInt16*)(pPlaneOut->pac_data + pPlaneOut->u_topleft); |
| |
| /* Get the memory jump corresponding to a row jump */ |
| u32_stride_in = pPlaneIn->u_stride; |
| u32_stride_out = pPlaneOut->u_stride; |
| |
| /* Set the bounds of the active image */ |
| u32_width_in = pPlaneIn->u_width; |
| u32_height_in = pPlaneIn->u_height; |
| |
| u32_width_out = pPlaneOut->u_width; |
| u32_height_out = pPlaneOut->u_height; |
| |
| /* Compute horizontal ratio between src and destination width.*/ |
| if (u32_width_out >= u32_width_in) { |
| u32_x_inc = ((u32_width_in-1) * MAX_SHORT) / (u32_width_out-1); |
| } else { |
| u32_x_inc = (u32_width_in * MAX_SHORT) / (u32_width_out); |
| } |
| |
| /* Compute vertical ratio between src and destination height.*/ |
| if (u32_height_out >= u32_height_in) { |
| u32_y_inc = ((u32_height_in - 1) * MAX_SHORT) / (u32_height_out-1); |
| } else { |
| u32_y_inc = (u32_height_in * MAX_SHORT) / (u32_height_out); |
| } |
| |
| /* |
| Calculate initial accumulator value : u32_y_accum_start. |
| u32_y_accum_start is coded on 15 bits, and represents a value between 0 and 0.5 |
| */ |
| if (u32_y_inc >= MAX_SHORT) { |
| /* |
| Keep the fractional part, integer part is coded |
| on the 16 high bits and the fractionnal on the 15 low bits |
| */ |
| u32_y_accum = u32_y_inc & 0xffff; |
| |
| if (!u32_y_accum) |
| { |
| u32_y_accum = MAX_SHORT; |
| } |
| |
| u32_y_accum >>= 1; |
| } else { |
| u32_y_accum = 0; |
| } |
| |
| /* |
| Calculate initial accumulator value : u32_x_accum_start. |
| u32_x_accum_start is coded on 15 bits, and represents a value between 0 and 0.5 |
| */ |
| if (u32_x_inc >= MAX_SHORT) { |
| u32_x_accum_start = u32_x_inc & 0xffff; |
| |
| if (!u32_x_accum_start) { |
| u32_x_accum_start = MAX_SHORT; |
| } |
| |
| u32_x_accum_start >>= 1; |
| } else { |
| u32_x_accum_start = 0; |
| } |
| |
| u32_height = u32_height_out; |
| |
| /* |
| Bilinear interpolation linearly interpolates along each row, and then uses that |
| result in a linear interpolation donw each column. Each estimated pixel in the |
| output image is a weighted combination of its four neighbours according to the formula: |
| F(p',q')=f(p,q)R(-a)R(b)+f(p,q-1)R(-a)R(b-1)+f(p+1,q)R(1-a)R(b)+f(p+&,q+1)R(1-a)R(b-1) |
| with R(x) = / x+1 -1 =< x =< 0 \ 1-x 0 =< x =< 1 and a (resp. b)weighting coefficient |
| is the distance from the nearest neighbor in the p (resp. q) direction |
| */ |
| |
| do { /* Scan all the row */ |
| |
| /* Vertical weight factor */ |
| u32_y_frac = (u32_y_accum>>12)&15; |
| |
| /* Reinit accumulator */ |
| u32_x_accum = u32_x_accum_start; |
| |
| u32_width = u32_width_out; |
| |
| do { /* Scan along each row */ |
| pu16_src_top = pu16_data_in + (u32_x_accum >> 16); |
| pu16_src_bottom = pu16_src_top + (u32_stride_in>>1); |
| u32_x_frac = (u32_x_accum >> 12)&15; /* Horizontal weight factor */ |
| |
| /* Weighted combination */ |
| if ((u32_height == 1) && (u32_height_in == u32_height_out)) { |
| GET_RGB565(i32_b00,i32_g00,i32_r00,(M4VIFI_UInt16)pu16_src_top[0]); |
| GET_RGB565(i32_b01,i32_g01,i32_r01,(M4VIFI_UInt16)pu16_src_top[1]); |
| GET_RGB565(i32_b02,i32_g02,i32_r02,(M4VIFI_UInt16)pu16_src_top[0]); |
| GET_RGB565(i32_b03,i32_g03,i32_r03,(M4VIFI_UInt16)pu16_src_top[1]); |
| } else { |
| GET_RGB565(i32_b00,i32_g00,i32_r00,(M4VIFI_UInt16)pu16_src_top[0]); |
| GET_RGB565(i32_b01,i32_g01,i32_r01,(M4VIFI_UInt16)pu16_src_top[1]); |
| GET_RGB565(i32_b02,i32_g02,i32_r02,(M4VIFI_UInt16)pu16_src_bottom[0]); |
| GET_RGB565(i32_b03,i32_g03,i32_r03,(M4VIFI_UInt16)pu16_src_bottom[1]); |
| |
| } |
| |
| /* Solution to avoid green effects due to transparency */ |
| count_trans = 0; |
| |
| /* If RGB is transparent color (0, 63, 0), we transform it to white (31,63,31) */ |
| if (i32_b00 == 0 && i32_g00 == 63 && i32_r00 == 0) |
| { |
| i32_b00 = 31; |
| i32_r00 = 31; |
| count_trans++; |
| } |
| if (i32_b01 == 0 && i32_g01 == 63 && i32_r01 == 0) |
| { |
| i32_b01 = 31; |
| i32_r01 = 31; |
| count_trans++; |
| } |
| if (i32_b02 == 0 && i32_g02 == 63 && i32_r02 == 0) |
| { |
| i32_b02 = 31; |
| i32_r02 = 31; |
| count_trans++; |
| } |
| if (i32_b03 == 0 && i32_g03 == 63 && i32_r03 == 0) |
| { |
| i32_b03 = 31; |
| i32_r03 = 31; |
| count_trans++; |
| } |
| |
| if (count_trans > 2) { |
| /* pixel is transparent */ |
| u32_Rtemp_value = 0; |
| u32_Gtemp_value = 63; |
| u32_Btemp_value = 0; |
| } else { |
| u32_Rtemp_value = (M4VIFI_UInt8)(((i32_r00*(16-u32_x_frac) + |
| i32_r01*u32_x_frac)*(16-u32_y_frac) + |
| (i32_r02*(16-u32_x_frac) + |
| i32_r03*u32_x_frac)*u32_y_frac )>>8); |
| |
| u32_Gtemp_value = (M4VIFI_UInt8)(((i32_g00*(16-u32_x_frac) + |
| i32_g01*u32_x_frac)*(16-u32_y_frac) + |
| (i32_g02*(16-u32_x_frac) + |
| i32_g03*u32_x_frac)*u32_y_frac )>>8); |
| |
| u32_Btemp_value = (M4VIFI_UInt8)(((i32_b00*(16-u32_x_frac) + |
| i32_b01*u32_x_frac)*(16-u32_y_frac) + |
| (i32_b02*(16-u32_x_frac) + |
| i32_b03*u32_x_frac)*u32_y_frac )>>8); |
| } |
| |
| *pu16_data_out++ = (M4VIFI_UInt16)( (((u32_Gtemp_value & 0x38) >> 3) | (u32_Btemp_value << 3)) |\ |
| ( (((u32_Gtemp_value & 0x7) << 5 ) | u32_Rtemp_value)<<8 )); |
| |
| /* Update horizontal accumulator */ |
| u32_x_accum += u32_x_inc; |
| |
| } while(--u32_width); |
| |
| |
| /* Update vertical accumulator */ |
| u32_y_accum += u32_y_inc; |
| if (u32_y_accum>>16) { |
| pu16_data_in = pu16_data_in + (u32_y_accum >> 16) * (u32_stride_in>>1); |
| u32_y_accum &= 0xffff; |
| } |
| |
| } while(--u32_height); |
| |
| return M4VIFI_OK; |
| } |
| |
