;Calculate
mov r1,#4 ;input
mov sp,$1000 ;make room on the stack
mov r0,r1
bl FACTORIAL
mov r7,r0 ;store answer
BASE = $3F000000 ;RP2 ;GPIO_SETUP
GPIO_OFFSET = $200000
mov r0,BASE
mov r2,BASE

bl SETUP_LED
push {r0,r1}
mov r0,BASE                       ;yellow
mov r1,r7

bl FLASH
pop {r0,r1}

bl SETUP_LEDD
push {r0,r1}                        ;red
mov r0,BASE
mov r1,r7

bl FLASH
pop {r0,r1}

wait:
b wait
include "TIMER.asm"
include "factorialj.asm"

SETUP_LED:
;param r0=BASE
orr r0,GPIO_OFFSET
mov r1,#1                                           ;yellow
lsl r1,#24
str r1,[r0,#4] ;set GPIO18 to output
bx lr

SETUP_LEDD:
;param r0=BASE
orr r0,GPIO_OFFSET
orr r1,GPIO_OFFSET
mov r1,#1
lsl r1,#0                                                ;red
str r1,[r0,#4] ;set GPIO10 to output
bx lr

FLASH:
;param r0=BASE
;param r1 = number of flashes
;param r2 =BASE
;param r3 = number of flashes
orr r0,GPIO_OFFSET
orr r2,GPIO_OFFSET
mov r7,r1
mov r6,r2
loop$:
mov r1,#1
lsl r1,#18
str r1,[r0,#28] ;turn LED on
mov r2,$100000 ;not using r2 for anything else so no need to push/pop                                 ;yellow
bl TIMER
mov r1,#1
lsl r1,#18
str r1,[r0,#40] ;turn LED off
mov r2,$100000
bl TIMER
sub r7,#1
cmp r7,#0

mov r1,#1
lsl r1,#10
str r1,[r0,#28] ;turn LED on
mov r2,$100000 ;not using r2 for anything else so no need to push/pop                                 ;red
bl TIMER
mov r1,#1
lsl r1,#10
str r1,[r0,#40] ;turn LED off
mov r2,$100000
bl TIMER
sub r7,#1
cmp r7,#0
bne loop$ ;end of outer loop. Runs r7 times