X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;f=firmware%2Fapps%2Fjtag%2Fjtag430asm.S;h=7e4aabf8895c00a563c62079bcdcdc8a4cff8721;hb=3a05c18969fbbb1337db4f8559483c009c78ea12;hp=5c7caa27f5ff6e667f182861634ff84467a09de9;hpb=1aee2758590886e1d1018c840806195a71e12204;p=goodfet

diff --git a/firmware/apps/jtag/jtag430asm.S b/firmware/apps/jtag/jtag430asm.S
index 5c7caa2..7e4aabf 100644
--- a/firmware/apps/jtag/jtag430asm.S
+++ b/firmware/apps/jtag/jtag430asm.S
@@ -1,16 +1,61 @@
 .globl jtag430_tclk_flashpulses
-.type jtag430_tclk_flashpulses,@function    /* declare main as a function */
+.type jtag430_tclk_flashpulses,@function //for linking
 
+#define _GNU_ASSEMBLER_
+#include "gfports.h"
 
-//! At 3.68MHz, 7 to 14 cycles/loop are allowed for 257 to 475kHz
+//This detects model, chooses appropriate timing.
 jtag430_tclk_flashpulses:
-	mov #0x0031, r14
-pulseloop:	
+	mov &0x0ff0, r14
+	cmp  #0x6cf1, r14	;Is the chip an MSP430F1xx?
+	jz jtag430_tclk_flashpulses_3mhz
+	jmp jtag430_tclk_flashpulses_16mhz
+	
+// At 3.68MHz, 7 to 14 cycles/loop are allowed for 257 to 475kHz.
+// At 16MHz, 33 to 62 cycles/loop are allowed.
+jtag430_tclk_flashpulses_3mhz:
+	mov #P5OUT, r14
+pulseloop3:
 	bis.b #2, @r14		;SETTCLK, 3 cycles
 	sub #1, r15		; 1 cycle
 	;;  1+3+3+1+2=10, within limits
+	nop
+	nop
+	nop			;10+3=13
+	
 	bic.b #2, @r14		;CLRTCLK, 3 cycles
 	tst r15			; 1 cycle
-	jnz pulseloop		; 2 cycles
+	jnz pulseloop3		; 2 cycles
+	ret
+
+jtag430_tclk_flashpulses_16mhz:
+	mov #P5OUT, r14
+pulseloop16:	
+	bis.b #2, @r14		;SETTCLK, 3 cycles
+	sub #1, r15		; 1 cycle
+	;;  1+3+3+1+2=10, beneath limits,
+
+	;; +3+2=5, repeat 8 times to get 10+40=50, within limits
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	push r11		; 3 cycles
+	pop r11			; 2 cycles
+	
+	
+	bic.b #2, @r14		;CLRTCLK, 3 cycles
+	tst r15			; 1 cycle
+	jnz pulseloop16		; 2 cycles
 	ret