diff options
Diffstat (limited to 'lib')
-rw-r--r-- | lib/util.c | 11 | ||||
-rw-r--r-- | lib/util.h | 1 |
2 files changed, 12 insertions, 0 deletions
@@ -37,6 +37,17 @@ void cpu_init(void) CPU_PRESCALE(0); } +void jtag_disable(void) +{ + uint8_t tempreg; + __asm __volatile("in %[tempreg], %[mcucr]" "\n\t" + "ori %[tempreg], %[jtd]" "\n\t" + "out %[mcucr], %[tempreg]" "\n\t" + "out %[mcucr], %[tempreg]" + : [tempreg] "=d" (tempreg) + : [mcucr] "I" (_SFR_IO_ADDR(MCUCR)), [jtd] "M" (_BV(JTD))); +} + #if defined(__BOARD_teensy1__) #define BOOTLOADER_VEC 0x3E00 #elif defined(__BOARD_teensy2__) @@ -24,6 +24,7 @@ #define SPREADAVR_util_h_INCLUDED void cpu_init(void); +void jtag_disable(void); void reset2bootloader(void); #endif |