17c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi/* 27c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * Copyright (C) 2011 The Android Open Source Project 37c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * 47c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * Licensed under the Apache License, Version 2.0 (the "License"); 57c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * you may not use this file except in compliance with the License. 67c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * You may obtain a copy of the License at 77c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * 87c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * http://www.apache.org/licenses/LICENSE-2.0 97c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * 107c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * Unless required by applicable law or agreed to in writing, software 117c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * distributed under the License is distributed on an "AS IS" BASIS, 127c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 137c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * See the License for the specific language governing permissions and 147c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi * limitations under the License. 157c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi */ 167c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi#include "M4VIFI_FiltersAPI.h" 177c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 187c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi#include "M4VIFI_Defines.h" 197c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 207c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi#include "M4VIFI_Clip.h" 217c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 227c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi/*************************************************************************** 237c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiProto: 247c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiM4VIFI_UInt8 M4VIFI_RGB888toYUV420(void *pUserData, M4VIFI_ImagePlane *PlaneIn, 257c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_ImagePlane PlaneOut[3]); 267c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiPurpose: filling of the YUV420 plane from a BGR24 plane 277c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiAbstract: Loop on each row ( 2 rows by 2 rows ) 287c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi Loop on each column ( 2 col by 2 col ) 297c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi Get 4 BGR samples from input data and build 4 output Y samples and 307c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi each single U & V data 317c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi end loop on col 327c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi end loop on row 337c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 347c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiIn: RGB24 plane 357c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiInOut: none 367c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiOut: array of 3 M4VIFI_ImagePlane structures 377c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiModified: ML: RGB function modified to BGR. 387c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi***************************************************************************/ 397c9d8018755adf1857571125ba1b3598c96ea506Dharmaray KundargiM4VIFI_UInt8 M4VIFI_RGB888toYUV420(void *pUserData, M4VIFI_ImagePlane *PlaneIn, 407c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_ImagePlane PlaneOut[3]) 417c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi{ 427c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt32 u32_width, u32_height; 437c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt32 u32_stride_Y, u32_stride2_Y, u32_stride_U, u32_stride_V, u32_stride_rgb,\ 447c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_2rgb; 457c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt32 u32_col, u32_row; 467c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 477c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_r00, i32_r01, i32_r10, i32_r11; 487c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_g00, i32_g01, i32_g10, i32_g11; 497c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_b00, i32_b01, i32_b10, i32_b11; 507c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_y00, i32_y01, i32_y10, i32_y11; 517c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_u00, i32_u01, i32_u10, i32_u11; 527c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_Int32 i32_v00, i32_v01, i32_v10, i32_v11; 537c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt8 *pu8_yn, *pu8_ys, *pu8_u, *pu8_v; 547c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt8 *pu8_y_data, *pu8_u_data, *pu8_v_data; 557c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi M4VIFI_UInt8 *pu8_rgbn_data, *pu8_rgbn; 567c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 577c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* check sizes */ 587c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi if( (PlaneIn->u_height != PlaneOut[0].u_height) || 597c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi (PlaneOut[0].u_height != (PlaneOut[1].u_height<<1)) || 607c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi (PlaneOut[0].u_height != (PlaneOut[2].u_height<<1))) 617c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi return M4VIFI_ILLEGAL_FRAME_HEIGHT; 627c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 637c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi if( (PlaneIn->u_width != PlaneOut[0].u_width) || 647c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi (PlaneOut[0].u_width != (PlaneOut[1].u_width<<1)) || 657c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi (PlaneOut[0].u_width != (PlaneOut[2].u_width<<1))) 667c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi return M4VIFI_ILLEGAL_FRAME_WIDTH; 677c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 687c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 697c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* set the pointer to the beginning of the output data buffers */ 707c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_y_data = PlaneOut[0].pac_data + PlaneOut[0].u_topleft; 717c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_u_data = PlaneOut[1].pac_data + PlaneOut[1].u_topleft; 727c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_v_data = PlaneOut[2].pac_data + PlaneOut[2].u_topleft; 737c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 747c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* idem for input buffer */ 757c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_rgbn_data = PlaneIn->pac_data + PlaneIn->u_topleft; 767c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 777c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* get the size of the output image */ 787c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_width = PlaneOut[0].u_width; 797c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_height = PlaneOut[0].u_height; 807c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 817c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* set the size of the memory jumps corresponding to row jump in each output plane */ 827c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_Y = PlaneOut[0].u_stride; 837c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride2_Y= u32_stride_Y << 1; 847c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_U = PlaneOut[1].u_stride; 857c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_V = PlaneOut[2].u_stride; 867c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 877c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* idem for input plane */ 887c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_rgb = PlaneIn->u_stride; 897c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi u32_stride_2rgb = u32_stride_rgb << 1; 907c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 917c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* loop on each row of the output image, input coordinates are estimated from output ones */ 927c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* two YUV rows are computed at each pass */ 937c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi for (u32_row = u32_height ;u32_row != 0; u32_row -=2) 947c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi { 957c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* update working pointers */ 967c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_yn = pu8_y_data; 977c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_ys = pu8_yn + u32_stride_Y; 987c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 997c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_u = pu8_u_data; 1007c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_v = pu8_v_data; 1017c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1027c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_rgbn= pu8_rgbn_data; 1037c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1047c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* loop on each column of the output image*/ 1057c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi for (u32_col = u32_width; u32_col != 0 ; u32_col -=2) 1067c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi { 1077c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi /* get RGB samples of 4 pixels */ 1087c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi GET_RGB24(i32_r00, i32_g00, i32_b00, pu8_rgbn, 0); 1097c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi GET_RGB24(i32_r10, i32_g10, i32_b10, pu8_rgbn, CST_RGB_24_SIZE); 1107c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi GET_RGB24(i32_r01, i32_g01, i32_b01, pu8_rgbn, u32_stride_rgb); 1117c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi GET_RGB24(i32_r11, i32_g11, i32_b11, pu8_rgbn, u32_stride_rgb + CST_RGB_24_SIZE); 1127c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1137c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_u00 = U24(i32_r00, i32_g00, i32_b00); 1147c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_v00 = V24(i32_r00, i32_g00, i32_b00); 1157c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_y00 = Y24(i32_r00, i32_g00, i32_b00); /* matrix luminance */ 1167c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_yn[0]= (M4VIFI_UInt8)i32_y00; 1177c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1187c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_u10 = U24(i32_r10, i32_g10, i32_b10); 1197c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_v10 = V24(i32_r10, i32_g10, i32_b10); 1207c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_y10 = Y24(i32_r10, i32_g10, i32_b10); 1217c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_yn[1]= (M4VIFI_UInt8)i32_y10; 1227c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1237c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_u01 = U24(i32_r01, i32_g01, i32_b01); 1247c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_v01 = V24(i32_r01, i32_g01, i32_b01); 1257c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_y01 = Y24(i32_r01, i32_g01, i32_b01); 1267c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_ys[0]= (M4VIFI_UInt8)i32_y01; 1277c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1287c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_u11 = U24(i32_r11, i32_g11, i32_b11); 1297c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_v11 = V24(i32_r11, i32_g11, i32_b11); 1307c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi i32_y11 = Y24(i32_r11, i32_g11, i32_b11); 1317c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_ys[1] = (M4VIFI_UInt8)i32_y11; 1327c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1337c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi *pu8_u = (M4VIFI_UInt8)((i32_u00 + i32_u01 + i32_u10 + i32_u11 + 2) >> 2); 1347c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi *pu8_v = (M4VIFI_UInt8)((i32_v00 + i32_v01 + i32_v10 + i32_v11 + 2) >> 2); 1357c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1367c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_rgbn += (CST_RGB_24_SIZE<<1); 1377c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_yn += 2; 1387c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_ys += 2; 1397c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1407c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_u ++; 1417c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_v ++; 1427c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi } /* end of horizontal scanning */ 1437c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1447c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_y_data += u32_stride2_Y; 1457c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_u_data += u32_stride_U; 1467c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_v_data += u32_stride_V; 1477c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi pu8_rgbn_data += u32_stride_2rgb; 1487c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1497c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1507c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi } /* End of vertical scanning */ 1517c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi 1527c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi return M4VIFI_OK; 1537c9d8018755adf1857571125ba1b3598c96ea506Dharmaray Kundargi} 154