@/******************************************************************************
@ *
@ * Copyright (C) 2015 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.
@ *
@ *****************************************************************************
@ * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore
@*/
.text
.p2align 2
@/*****************************************************************************
@* *
@* Function Name : IH264D_CXA8_YUV420toYUV420SP_UV() *
@* *
@* Description : This function conversts the image from YUV420P color *
@* space to 420SP color space(UV interleaved). *
@* *
@* Arguments : R0 pu1_y *
@* R1 pu1_u *
@* R2 pu1_v *
@* R3 pu1_dest_y *
@* [R13 #40] pu1_dest_uv *
@* [R13 #44] u2_height *
@* [R13 #48] u2_width *
@* [R13 #52] u2_stridey *
@* [R13 #56] u2_strideu *
@* [R13 #60] u2_stridev *
@* [R13 #64] u2_dest_stride_y *
@* [R13 #68] u2_dest_stride_uv *
@* [R13 #72] convert_uv_only *
@* *
@* Values Returned : None *
@* *
@* Register Usage : R0 - R14 *
@* *
@* Stack Usage : 40 Bytes *
@* *
@* Interruptibility : Interruptible *
@* *
@* Known Limitations *
@* Assumptions: Image Width: Assumed to be multiple of 16 and *
@* greater than or equal to 16 *
@* Image Height: Assumed to be even. *
@* *
@* Revision History : *
@* DD MM YYYY Author(s) Changes (Describe the changes made) *
@* 07 06 2010 Varshita Draft *
@* 07 06 2010 Naveen Kr T Completed *
@* *
@*****************************************************************************/
.global ih264e_fmt_conv_420p_to_420sp_a9q
ih264e_fmt_conv_420p_to_420sp_a9q:
@// push the registers on the stack
stmfd sp!, {r4-r12, lr}
ldr r4, [sp, #72] @// Load convert_uv_only
cmp r4, #1
beq yuv420sp_uv_chroma
@/* Do the preprocessing before the main loops start */
@// Load the parameters from stack
ldr r4, [sp, #44] @// Load u2_height from stack
ldr r5, [sp, #48] @// Load u2_width from stack
ldr r7, [sp, #52] @// Load u2_stridey from stack
ldr r8, [sp, #64] @// Load u2_dest_stride_y from stack
sub r7, r7, r5 @// Source increment
sub r8, r8, r5 @// Destination increment
yuv420sp_uv_row_loop_y:
mov r6, r5
yuv420sp_uv_col_loop_y:
pld [r0, #128]
vld1.8 {d0, d1}, [r0]!
vst1.8 {d0, d1}, [r3]!
sub r6, r6, #16
cmp r6, #15
bgt yuv420sp_uv_col_loop_y
cmp r6, #0
beq yuv420sp_uv_row_loop_end_y
@//If non-multiple of 16, then go back by few bytes to ensure 16 bytes can be read
@//Ex if width is 162, above loop will process 160 pixels. And
@//Both source and destination will point to 146th pixel and then 16 bytes will be read
@// and written using VLD1 and VST1
rsb r6, r6, #16
sub r0, r0, r6
sub r3, r3, r6
vld1.8 {d0, d1}, [r0]!
vst1.8 {d0, d1}, [r3]!
yuv420sp_uv_row_loop_end_y:
add r0, r0, r7
add r3, r3, r8
subs r4, r4, #1
bgt yuv420sp_uv_row_loop_y
yuv420sp_uv_chroma:
ldr r3, [sp, #40] @// Load pu1_dest_uv from stack
ldr r4, [sp, #44] @// Load u2_height from stack
ldr r5, [sp, #48] @// Load u2_width from stack
ldr r7, [sp, #56] @// Load u2_strideu from stack
ldr r8, [sp, #68] @// Load u2_dest_stride_uv from stack
sub r7, r7, r5, lsr #1 @// Source increment
sub r8, r8, r5 @// Destination increment
mov r5, r5, lsr #1
mov r4, r4, lsr #1
ldr r3, [sp, #40] @// Load pu1_dest_uv from stack
yuv420sp_uv_row_loop_uv:
mov r6, r5
yuv420sp_uv_col_loop_uv:
pld [r1, #128]
pld [r2, #128]
vld1.8 d0, [r1]!
vld1.8 d1, [r2]!
vst2.8 {d0, d1}, [r3]!
sub r6, r6, #8
cmp r6, #7
bgt yuv420sp_uv_col_loop_uv
cmp r6, #0
beq yuv420sp_uv_row_loop_end_uv
@//If non-multiple of 16, then go back by few bytes to ensure 16 bytes can be read
@//Ex if width is 162, above loop will process 160 pixels. And
@//Both source and destination will point to 146th pixel and then 16 bytes will be read
@// and written using VLD1 and VST1
rsb r6, r6, #8
sub r1, r1, r6
sub r2, r2, r6
sub r3, r3, r6, lsl #1
vld1.8 d0, [r1]!
vld1.8 d1, [r2]!
vst2.8 {d0, d1}, [r3]!
yuv420sp_uv_row_loop_end_uv:
add r1, r1, r7
add r2, r2, r7
add r3, r3, r8
subs r4, r4, #1
bgt yuv420sp_uv_row_loop_uv
@//POP THE REGISTERS
ldmfd sp!, {r4-r12, pc}
@ /**
@ *******************************************************************************
@ *
@ * @brief ih264e_fmt_conv_422i_to_420sp_a9q
@ * Function used from format conversion or frame copy
@ *
@ *
@ *
@ *Inputs : r0 - pu1_y - UWORD8 pointer to y plane.
@ * r1 - pu1_u - UWORD8 pointer to u plane.
@ * r2 - pu1_v - UWORD8 pointer to u plane.
@ * r3 - pu2_yuv422i - UWORD16 pointer to yuv422iimage.
@ * stack + 40 - u4_width - Width of the Y plane.
@ * 44 - u4_height - Height of the Y plane.
@ * 48 - u4_stride_y - Stride in pixels of Y plane.
@ * 52 - u4_stride_u - Stride in pixels of U plane.
@ * 56 - u4_stride_v - Stride in pixels of V plane.
@ * 60 - u4_stride_yuv422i- Stride in pixels of yuv422i image.
@ *
@ * @par Description
@ * Function used from copying or converting a reference frame to display buffer
@ * in non shared mode
@ *
@ * @param[in] pu1_y_dst
@ * Output Y pointer
@ *
@ * @param[in] pu1_u_dst
@ * Output U/UV pointer ( UV is interleaved in the same format as that of input)
@ *
@ * @param[in] pu1_v_dst
@ * Output V pointer ( used in 420P output case)
@ *
@ * @param[in] u4_dst_y_strd
@ * Stride of destination Y buffer
@ *
@ * @param[in] u4_dst_u_strd
@ * Stride of destination U/V buffer
@ *
@ *
@ * @param[in] blocking
@ * To indicate whether format conversion should wait till frame is reconstructed
@ * and then return after complete copy is done. To be set to 1 when called at the
@ * end of frame processing and set to 0 when called between frame processing modules
@ * in order to utilize available MCPS
@ *
@ * @returns Error from IH264E_ERROR_T
@ *
@ * @remarks
@ * Assumes that the stride of U and V buffers are same.
@ * This is correct in most cases
@ * If a case comes where this is not true we need to modify the fmt conversion funcnions called inside also
@ * Since we read 4 pixels ata time the width should be aligned to 4
@ * In assembly width should be aligned to 16 and height to 2.
@ *
@ *
@ * Revision History :
@ * DD MM YYYY Author(s) Changes (Describe the changes made)
@ * 07 06 2010 Harinarayanan K K Adapeted to 422p
@ *
@ *******************************************************************************
@ */
@//`
@*/
.global ih264e_fmt_conv_422i_to_420sp_a9q
ih264e_fmt_conv_422i_to_420sp_a9q:
stmfd sp!, {r4-r12, lr} @// Back the register which are used
@/* Do the preprocessing before the main loops start */
@// Load the parameters from stack
ldr r4, [sp, #48] @// Load u4_stride_y from stack
ldr r5, [sp, #60] @// Load u4_stride_yuv422i from stack
add r6, r0, r4 @// pu1_y_nxt_row = pu1_y + u4_stride_y
ldr r7, [sp, #40] @// Load u4_width from stack
add r8, r3, r5, lsl #1 @// pu2_yuv422i_nxt_row = pu2_yuv422i_y + u4_stride_yuv422i(2 Bytes for each pixel)
ldr r9, [sp, #52] @// Load u4_stride_u from stack
sub r12, r4, r7 @// u2_offset1 = u4_stride_y - u4_width
@LDR r10,[sp,#56] ;// Load u4_stride_v from stack
sub r14, r5, r7 @// u2_offset_yuv422i = u4_stride_yuv422i - u4_width
ldr r11, [sp, #44] @// Load u4_height from stack
sub r9, r9, r7 @// u2_offset2 = u4_stride_u - u4_width >> 1
@ SUB r10,r10,r7,ASR #1 ;// u2_offset3 = u4_stride_v - u4_width >> 1
mov r14, r14, lsl #1 @// u2_offset_yuv422i = u2_offset_yuv422i * 2
mov r11, r11, asr #1 @// u4_width = u4_width / 2 (u4_width >> 1)
add r4, r12, r4 @// u2_offset1 = u2_offset1 + u4_stride_y
add r5, r14, r5, lsl #1 @// u2_offset_yuv422i = u2_offset_yuv422i + u4_stride_yuv422i
@// Register Assignment
@// pu1_y - r0
@// pu1_y_nxt_row - r6
@// pu1_u - r1
@// pu1_v - r2
@// pu2_yuv422i - r3
@// pu2_yuv422i_nxt_row - r8
@// u2_offset1 - r4
@// u2_offset2 - r9
@// u2_offset3 - r10
@// u2_offset_yuv422i - r5
@// u4_width / 16 - r7
@// u4_height / 2 - r11
@// inner loop count - r12
yuv422i_to_420sp_height_loop:
mov r12, r7 @// Inner loop count = u4_width / 16
yuv422i_to_420sp_width_loop:
vld4.8 {d0, d1, d2, d3}, [r3]! @// Load the 16 elements of row 1
vld4.8 {d4, d5, d6, d7}, [r8]! @// Load the 16 elements of row 2
sub r12, r12, #16
vrhadd.u8 d0, d0, d4
vrhadd.u8 d2, d2, d6
vst2.8 {d1, d3}, [r0]! @// Store the 16 elements of row1 Y
vst2.8 {d5, d7}, [r6]! @// Store the 16 elements of row2 Y
vst2.8 {d0, d2}, [r1]! @// Store the 8 elements of row1/2 U
cmp r12, #15
bgt yuv422i_to_420sp_width_loop
cmp r12, #0
beq yuv422i_to_420sp_row_loop_end
@//If non-multiple of 16, then go back by few bytes to ensure 16 bytes can be read
@//Ex if width is 162, above loop will process 160 pixels. And
@//Both source and destination will point to 146th pixel and then 16 bytes will be read
@// and written using VLD1 and VST1
rsb r12, r12, #16
sub r3, r3, r12, lsl #1
sub r8, r8, r12, lsl #1
sub r0, r0, r12
sub r6, r6, r12
sub r1, r1, r12
vld4.8 {d0, d1, d2, d3}, [r3]! @// Load the 16 elements of row 1
vld4.8 {d4, d5, d6, d7}, [r8]! @// Load the 16 elements of row 2
vrhadd.u8 d0, d0, d4
vrhadd.u8 d2, d2, d6
vst2.8 {d1, d3}, [r0]! @// Store the 16 elements of row1 Y
vst2.8 {d5, d7}, [r6]! @// Store the 16 elements of row2 Y
vst2.8 {d0, d2}, [r1]! @// Store the 8 elements of row1/2 U
yuv422i_to_420sp_row_loop_end:
@// Update the buffer pointer so that they will refer to next pair of rows
add r0, r0, r4 @// pu1_y = pu1_y + u2_offset1
add r6, r6, r4 @// pu1_y_nxt_row = pu1_y_nxt_row + u2_offset1
add r1, r1, r9 @// pu1_u = pu1_u + u2_offset2
subs r11, r11, #1
add r3, r3, r5 @// pu2_yuv422i = pu2_yuv422i + u2_offset_yuv422i
add r8, r8, r5 @// pu2_yuv422i_nxt_row = pu2_yuv422i_nxt_row + u2_offset_yuv422i
bgt yuv422i_to_420sp_height_loop
ldmfd sp!, {r4-r12, pc} @// Restore the register which are used