Branch to BusPal vs keyboard function depending on Wormhole->enumerationMode

This commit is contained in:
László Monda
2017-05-01 19:26:38 +02:00
parent 8675effabc
commit d1d847ff57
9 changed files with 78 additions and 67 deletions

View File

@@ -5,13 +5,13 @@ wormhole_t *Wormhole NO_INIT_GCC;
void* getSP(void)
{
void *sp;
// __asm__ __volatile__ ("mov %0, sp" : "=r"(sp));
__asm__ __volatile__ ("mrs %0, msp" : "=r"(sp));
__asm__ __volatile__ ("mov %0, sp" : "=r"(sp));
// __asm__ __volatile__ ("mrs %0, msp" : "=r"(sp));
return sp;
}
void __attribute__ ((__section__ (".init3"), __naked__)) move_sp(void) {
void* SP = getSP();
// SP -= sizeof(wormhole_t);
SP -= sizeof(wormhole_t);
Wormhole = (wormhole_t*)(SP + 1);
}