35 lines
751 B
ArmAsm
35 lines
751 B
ArmAsm
|
|
||
|
|
.syntax unified
|
||
|
|
.cpu cortex-m0plus
|
||
|
|
.thumb
|
||
|
|
|
||
|
|
#include "pico/asm_helper.S"
|
||
|
|
|
||
|
|
__pre_init __badger_init, 00003
|
||
|
|
|
||
|
|
.section .data.badger_init
|
||
|
|
.global badger_gpio_on_wake
|
||
|
|
.align 4
|
||
|
|
badger_gpio_on_wake:
|
||
|
|
.word 0x00000000
|
||
|
|
|
||
|
|
.section .text
|
||
|
|
.thumb_func
|
||
|
|
__badger_init:
|
||
|
|
// Read GPIO state and store
|
||
|
|
movs r3, 0xd0
|
||
|
|
lsls r3, r3, 24
|
||
|
|
ldr r1, [r3, 4]
|
||
|
|
ldr r2, =badger_gpio_on_wake
|
||
|
|
str r1, [r2]
|
||
|
|
|
||
|
|
// Enable 3v3 pin on the badger
|
||
|
|
ldr r1, =0x40014054 // GPIO control register 10
|
||
|
|
movs r2, 5 // SIO function
|
||
|
|
str r2, [r1] // Set Enable 3v3 to SIO
|
||
|
|
str r2, [r1, 120] // Also set LED (25) to SIO
|
||
|
|
ldr r2, =0x02000400 // Pins 25 and 10
|
||
|
|
str r2, [r3, 36] // Enable pins out
|
||
|
|
str r2, [r3, 20] // Set pins high
|
||
|
|
bx lr
|