kopia lustrzana https://github.com/hoglet67/RGBtoHDMI
238 wiersze
8.3 KiB
ArmAsm
238 wiersze
8.3 KiB
ArmAsm
#include "rpi-base.h"
|
|
#include "defs.h"
|
|
|
|
#include "macros.S"
|
|
|
|
.text
|
|
|
|
.global capture_line_half_even_4bpp
|
|
.global capture_line_half_even_8bpp
|
|
.global capture_line_half_odd_4bpp
|
|
.global capture_line_half_odd_8bpp
|
|
|
|
|
|
// The capture line function is provided the following:
|
|
// r0 = pointer to current line in frame buffer
|
|
// r1 = number of complete psync cycles to capture (=param_chars_per_line)
|
|
// r2 = frame buffer line pitch in bytes (=param_fb_pitch)
|
|
// r3 = flags register
|
|
// r4 = GPLEV0 constant
|
|
// r5 = line number count down to 0 (initial value =param_nlines)
|
|
// r6 = scan line count modulo 10
|
|
// r7 = number of psyncs to skip
|
|
// r8 = frame buffer height (=param_fb_height)
|
|
//
|
|
// All registers are available as scratch registers (i.e. nothing needs to be preserved)
|
|
.align 6
|
|
b preload_capture_line_half_even_4bpp
|
|
capture_line_half_even_4bpp:
|
|
push {lr}
|
|
cmp r1, #400/8 //sanity check on buffer size as only capturing half of pixels so width >400 will never finish
|
|
movgt r1, r1, lsr#1
|
|
SKIP_PSYNC
|
|
mov r1, r1, lsr #1
|
|
capture_half_4bppe:
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_LOW_BITS // input in r8, result in r10, corrupts r9
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_HIGH_BITS // input in r8, result in r9/r10
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_LOW_BITS // input in r8, result in r10, corrupts r9
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_HIGH_BITS // input in r8, result in r9/r10
|
|
|
|
|
|
and r9, r11, #0x00000007
|
|
mov r12, r9, lsl#4
|
|
and r9, r11, #0x00000700
|
|
orr r12, r12, r9, lsr #8
|
|
and r9, r11, #0x00070000
|
|
orr r12, r12, r9, lsr #4
|
|
and r9, r11, #0x07000000
|
|
orr r12, r12, r9, lsr #16
|
|
|
|
and r9, r10, #0x00000007
|
|
orr r12, r12, r9, lsl#20
|
|
and r9, r10, #0x00000700
|
|
orr r12, r12, r9, lsl #8
|
|
and r9, r10, #0x00070000
|
|
orr r12, r12, r9, lsl #12
|
|
and r9, r10, #0x07000000
|
|
orr r10, r12, r9
|
|
|
|
|
|
WRITE_WORD
|
|
|
|
subs r1, r1, #1
|
|
bne capture_half_4bppe
|
|
pop {r0, pc}
|
|
|
|
preload_capture_line_half_even_4bpp:
|
|
SETUP_DUMMY_PARAMETERS
|
|
b capture_line_half_even_4bpp
|
|
|
|
.ltorg
|
|
|
|
// *** 8 bit ***
|
|
|
|
.align 6
|
|
b preload_capture_line_half_even_8bpp
|
|
capture_line_half_even_8bpp:
|
|
push {lr}
|
|
cmp r1, #400/8 //sanity check on buffer size as only capturing half of pixels so width >400 will never finish
|
|
movgt r1, r1, lsr#1
|
|
bic r3, #MASKDUP_PALETTE_HIGH_NIBBLE
|
|
SKIP_PSYNC
|
|
mov r1, r1, lsr #1
|
|
capture_half_8bppe:
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r10, corrupts r9
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r9/r10
|
|
|
|
|
|
and r9, r11, #0x00000700
|
|
mov r12, r9, lsr#8
|
|
and r9, r11, #0x07000000
|
|
orr r12, r12, r9, lsr #16
|
|
and r9, r10, #0x00000700
|
|
orr r12, r12, r9, lsl#8
|
|
and r9, r10, #0x07000000
|
|
orr r7, r12, r9
|
|
|
|
|
|
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r10, corrupts r9
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r9/r10
|
|
|
|
and r9, r11, #0x00000700
|
|
mov r12, r9, lsr#8
|
|
and r9, r11, #0x07000000
|
|
orr r12, r12, r9, lsr #16
|
|
and r9, r10, #0x00000700
|
|
orr r12, r12, r9, lsl#8
|
|
and r9, r10, #0x07000000
|
|
orr r10, r12, r9
|
|
|
|
|
|
mov r9, r7
|
|
WRITE_WORDS_8BPP
|
|
subs r1, r1, #1
|
|
bne capture_half_8bppe
|
|
pop {r0, pc}
|
|
|
|
preload_capture_line_half_even_8bpp:
|
|
SETUP_DUMMY_PARAMETERS
|
|
b capture_line_half_even_8bpp
|
|
|
|
|
|
.align 6
|
|
b preload_capture_line_half_odd_4bpp
|
|
capture_line_half_odd_4bpp:
|
|
push {lr}
|
|
cmp r1, #400/8 //sanity check on buffer size as only capturing half of pixels so width >400 will never finish
|
|
movgt r1, r1, lsr#1
|
|
SKIP_PSYNC
|
|
mov r1, r1, lsr #1
|
|
capture_half_4bppo:
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_LOW_BITS // input in r8, result in r10, corrupts r9
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_HIGH_BITS // input in r8, result in r9/r10
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_LOW_BITS // input in r8, result in r10, corrupts r9
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_HIGH_BITS // input in r8, result in r9/r10
|
|
|
|
|
|
and r9, r11, #0x00000070
|
|
mov r12, r9
|
|
and r9, r11, #0x00007000
|
|
orr r12, r12, r9, lsr #12
|
|
and r9, r11, #0x00700000
|
|
orr r12, r12, r9, lsr #8
|
|
and r9, r11, #0x70000000
|
|
orr r12, r12, r9, lsr #20
|
|
|
|
and r9, r10, #0x00000070
|
|
orr r12, r12, r9, lsl#16
|
|
and r9, r10, #0x00007000
|
|
orr r12, r12, r9, lsl #4
|
|
and r9, r10, #0x00700000
|
|
orr r12, r12, r9, lsl #8
|
|
and r9, r10, #0x70000000
|
|
orr r10, r12, r9, lsr #4
|
|
|
|
WRITE_WORD
|
|
|
|
subs r1, r1, #1
|
|
bne capture_half_4bppo
|
|
pop {r0, pc}
|
|
|
|
preload_capture_line_half_odd_4bpp:
|
|
SETUP_DUMMY_PARAMETERS
|
|
b capture_line_half_odd_4bpp
|
|
|
|
.ltorg
|
|
|
|
// *** 8 bit ***
|
|
|
|
.align 6
|
|
b preload_capture_line_half_odd_8bpp
|
|
capture_line_half_odd_8bpp:
|
|
push {lr}
|
|
cmp r1, #400/8 //sanity check on buffer size as only capturing half of pixels so width >400 will never finish
|
|
movgt r1, r1, lsr#1
|
|
bic r3, #MASKDUP_PALETTE_HIGH_NIBBLE
|
|
SKIP_PSYNC
|
|
mov r1, r1, lsr #1
|
|
capture_half_8bppo:
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r10, corrupts r9
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r9/r10
|
|
|
|
and r9, r11, #0x00000007
|
|
mov r12, r9
|
|
and r9, r11, #0x00070000
|
|
orr r12, r12, r9, lsr #8
|
|
and r9, r10, #0x00000007
|
|
orr r12, r12, r9, lsl#16
|
|
and r9, r10, #0x00070000
|
|
orr r7, r12, r9, lsl #8
|
|
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r10, corrupts r9
|
|
mov r11, r10 // save first word
|
|
WAIT_FOR_PSYNC_EDGE // expects GPLEV0 in r4, result in r8
|
|
CAPTURE_BITS_8BPP // input in r8, result in r9/r10
|
|
|
|
and r9, r11, #0x00000007
|
|
mov r12, r9
|
|
and r9, r11, #0x00070000
|
|
orr r12, r12, r9, lsr #8
|
|
and r9, r10, #0x00000007
|
|
orr r12, r12, r9, lsl#16
|
|
and r9, r10, #0x00070000
|
|
orr r10, r12, r9, lsl #8
|
|
|
|
mov r9, r7
|
|
WRITE_WORDS_8BPP
|
|
subs r1, r1, #1
|
|
bne capture_half_8bppo
|
|
pop {r0, pc}
|
|
|
|
preload_capture_line_half_odd_8bpp:
|
|
SETUP_DUMMY_PARAMETERS
|
|
b capture_line_half_odd_8bpp
|
|
|
|
|
|
|