summaryrefslogtreecommitdiff
path: root/src/flash_button.s
blob: 9b702e4f67916cbd99891553e8bbc36b10b96199 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
/*
 * flash_button.s
 *
 * Copyright © 2018 Thomas White <taw@bitwiz.org.uk>
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 */

.include "swi_numbers.h"

.global flash_button

flash_button:
	MOV	R0, #0			@ Get GPLEV0
	SWI	OS_GetGPIO
	TST	R0, #1<<17		@ Check GPIO 17
	BLNE	flash_leds
	B	flash_button

flash_leds:
	STMDB	R13!, {LR}

	MOV	R2, #5			@ Number of times to flash

1:
	MOV	R0, #0			@ Flash first set of GPIOs

	MOV	R1, #1<<16
	SWI	OS_ClearGPIO
	MOV	R1, #1<<18
	SWI	OS_SetGPIO

	BL	pause

	MOV	R1, #1<<18
	SWI	OS_ClearGPIO
	MOV	R1, #1<<16
	SWI	OS_SetGPIO

	BL	pause

	SUBS	R2, R2, #1
	BNE	1b

	MOV	R1, #1<<18
	ORR	R1, #1<<16
	SWI	OS_ClearGPIO

	LDMIA	R13!, {PC}

pause:
	MOV	R1, #0x3f000
1:
	SUBS	R1, R1, #1
	BNE	1b
	MOV	PC, LR