[pcsx_rearmed.git] / frontend / arm_utils.s

/*
 * (C) Gražvydas "notaz" Ignotas, 2010
 *
 * This work is licensed under the terms of any of these licenses
 * (at your option):
 *  - GNU GPL, version 2 or later.
 *  - GNU LGPL, version 2.1 or later.
 * See the COPYING file in the top-level directory.
 */

.text
.align 2

.global bgr555_to_rgb565
bgr555_to_rgb565:
    mov         r3, #0x07c0
    vdup.16     q15, r3
    sub         r2, r2, #64
0:
    vldmia      r1!, {q0-q3}
    vshl.u16    q4, q0, #11
    vshl.u16    q5, q1, #11
    vshl.u16    q6, q2, #11
    vshl.u16    q7, q3, #11
    vsri.u16    q4, q0, #10
    vsri.u16    q5, q1, #10
    vsri.u16    q6, q2, #10
    vsri.u16    q7, q3, #10
    vshl.u16    q0, q0, #1
    vshl.u16    q1, q1, #1
    vshl.u16    q2, q2, #1
    vshl.u16    q3, q3, #1
    vbit        q4, q0, q15
    vbit        q5, q1, q15
    vbit        q6, q2, q15
    vbit        q7, q3, q15
    vstmia      r0!, {q4-q7}
    subs        r2, r2, #64
    bge         0b

    adds        r2, r2, #64
    bxeq        lr

    @ handle the remainder
0:
    vld1.16     {q0}, [r1, :64]!
    vshl.u16    q1, q0, #11
    vshl.u16    q2, q0, #1
    vsri.u16    q1, q0, #10
    vbit        q1, q2, q15
    subs        r2, r2, #16
    vst1.16     {q1}, [r0, :64]!
    bgt         0b

    bx          lr


.global bgr888_to_rgb888
bgr888_to_rgb888:
    @ r2 /= 48
    mov         r2, r2, lsr #4
    movw        r3, #0x5556
    movt        r3, #0x5555
    umull       r12,r2, r3, r2
0:
    vld3.8      {d0-d2}, [r1, :64]!
    vld3.8      {d3-d5}, [r1, :64]!
    vswp        d0, d2
    vswp        d3, d5
    vst3.8      {d0-d2}, [r0, :64]!
    vst3.8      {d3-d5}, [r0, :64]!
    subs        r2, r2, #1
    bne         0b

    bx          lr


.global bgr888_to_rgb565
bgr888_to_rgb565:
    @ r2 /= 48
    mov         r2, r2, lsr #4
    movw        r3, #0x5556
    movt        r3, #0x5555
    umull       r12,r2, r3, r2

    mov         r3, #0x07e0
    vdup.16     q15, r3
0:
    vld3.8      {d1-d3}, [r1, :64]!
    vld3.8      {d5-d7}, [r1, :64]!

    vshll.u8    q8, d2, #3      @ g
    vshll.u8    q9, d6, #3
    vshr.u8     d0, d3, #3      @ b
    vshr.u8     d4, d7, #3
    vzip.8      d0, d1          @ rb
    vzip.8      d4, d5
    vbit        q0, q8, q15
    vbit        q2, q9, q15

    vstmia      r0!, {d0,d1}
    vstmia      r0!, {d4,d5}
    subs        r2, r2, #1
    bne         0b

    bx          lr


@ vim:filetype=armasm
Commit	Line	Data
a327967e	1	/*
	2	* (C) Gražvydas "notaz" Ignotas, 2010
	3	*
69af03a2	4	* This work is licensed under the terms of any of these licenses
	5	* (at your option):
	6	* - GNU GPL, version 2 or later.
	7	* - GNU LGPL, version 2.1 or later.
a327967e	8	* See the COPYING file in the top-level directory.
	9	*/
	10
	11	.text
	12	.align 2
	13
	14	.global bgr555_to_rgb565
	15	bgr555_to_rgb565:
d352cde2	16	mov r3, #0x07c0
a327967e	17	vdup.16 q15, r3
d352cde2	18	sub r2, r2, #64
a327967e	19	0:
a327967e	20	vldmia r1!, {q0-q3}
d352cde2	21	vshl.u16 q4, q0, #11
	22	vshl.u16 q5, q1, #11
	23	vshl.u16 q6, q2, #11
	24	vshl.u16 q7, q3, #11
	25	vsri.u16 q4, q0, #10
	26	vsri.u16 q5, q1, #10
	27	vsri.u16 q6, q2, #10
	28	vsri.u16 q7, q3, #10
a327967e	29	vshl.u16 q0, q0, #1
	30	vshl.u16 q1, q1, #1
	31	vshl.u16 q2, q2, #1
	32	vshl.u16 q3, q3, #1
d352cde2	33	vbit q4, q0, q15
	34	vbit q5, q1, q15
	35	vbit q6, q2, q15
	36	vbit q7, q3, q15
	37	vstmia r0!, {q4-q7}
	38	subs r2, r2, #64
	39	bge 0b
	40
	41	adds r2, r2, #64
	42	bxeq lr
	43
	44	@ handle the remainder
	45	0:
	46	vld1.16 {q0}, [r1, :64]!
	47	vshl.u16 q1, q0, #11
	48	vshl.u16 q2, q0, #1
	49	vsri.u16 q1, q0, #10
	50	vbit q1, q2, q15
	51	subs r2, r2, #16
	52	vst1.16 {q1}, [r0, :64]!
	53	bgt 0b
a327967e	54
	55	bx lr
	56
1972732a	57
	58	.global bgr888_to_rgb888
	59	bgr888_to_rgb888:
	60	@ r2 /= 48
	61	mov r2, r2, lsr #4
	62	movw r3, #0x5556
	63	movt r3, #0x5555
	64	umull r12,r2, r3, r2
	65	0:
	66	vld3.8 {d0-d2}, [r1, :64]!
	67	vld3.8 {d3-d5}, [r1, :64]!
	68	vswp d0, d2
	69	vswp d3, d5
	70	vst3.8 {d0-d2}, [r0, :64]!
	71	vst3.8 {d3-d5}, [r0, :64]!
	72	subs r2, r2, #1
	73	bne 0b
	74
	75	bx lr
	76
	77
f3a63e25	78	.global bgr888_to_rgb565
	79	bgr888_to_rgb565:
	80	@ r2 /= 48
	81	mov r2, r2, lsr #4
	82	movw r3, #0x5556
	83	movt r3, #0x5555
	84	umull r12,r2, r3, r2
	85
	86	mov r3, #0x07e0
	87	vdup.16 q15, r3
	88	0:
	89	vld3.8 {d1-d3}, [r1, :64]!
	90	vld3.8 {d5-d7}, [r1, :64]!
	91
	92	vshll.u8 q8, d2, #3 @ g
	93	vshll.u8 q9, d6, #3
	94	vshr.u8 d0, d3, #3 @ b
	95	vshr.u8 d4, d7, #3
	96	vzip.8 d0, d1 @ rb
	97	vzip.8 d4, d5
	98	vbit q0, q8, q15
	99	vbit q2, q9, q15
	100
	101	vstmia r0!, {d0,d1}
	102	vstmia r0!, {d4,d5}
	103	subs r2, r2, #1
	104	bne 0b
	105
	106	bx lr
	107
	108
a327967e	109	@ vim:filetype=armasm