platform_system_core/libpixelflinger/col32cb16blend.S

79 lines
3.0 KiB
ArmAsm

/* libs/pixelflinger/col32cb16blend.S
**
** (C) COPYRIGHT 2009 ARM Limited.
**
** 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.
**
*/
.text
.align
.global scanline_col32cb16blend_arm
//
// This function alpha blends a fixed color into a destination scanline, using
// the formula:
//
// d = s + (((a + (a >> 7)) * d) >> 8)
//
// where d is the destination pixel,
// s is the source color,
// a is the alpha channel of the source color.
//
// r0 = destination buffer pointer
// r1 = color value
// r2 = count
scanline_col32cb16blend_arm:
push {r4-r10, lr} // stack ARM regs
mov r5, r1, lsr #24 // shift down alpha
mov r9, #0xff // create mask
add r5, r5, r5, lsr #7 // add in top bit
rsb r5, r5, #256 // invert alpha
and r10, r1, #0xff // extract red
and r12, r9, r1, lsr #8 // extract green
and r4, r9, r1, lsr #16 // extract blue
mov r10, r10, lsl #5 // prescale red
mov r12, r12, lsl #6 // prescale green
mov r4, r4, lsl #5 // prescale blue
mov r9, r9, lsr #2 // create dest green mask
1:
ldrh r8, [r0] // load dest pixel
subs r2, r2, #1 // decrement loop counter
mov r6, r8, lsr #11 // extract dest red
and r7, r9, r8, lsr #5 // extract dest green
and r8, r8, #0x1f // extract dest blue
smlabb r6, r6, r5, r10 // dest red * alpha + src red
smlabb r7, r7, r5, r12 // dest green * alpha + src green
smlabb r8, r8, r5, r4 // dest blue * alpha + src blue
mov r6, r6, lsr #8 // shift down red
mov r7, r7, lsr #8 // shift down green
mov r6, r6, lsl #11 // shift red into 565
orr r6, r7, lsl #5 // shift green into 565
orr r6, r8, lsr #8 // shift blue into 565
strh r6, [r0], #2 // store pixel to dest, update ptr
bne 1b // if count != 0, loop
pop {r4-r10, pc} // return