Mercurial > avr_jtag
annotate src/avriotools.c @ 4:6b1594fb668f
Improve performance of jtag.c and test it with Python scripts.
- cp_tditdo.py send bits to TDI and hope it will feed back from TDO.
- Expand loops in jtag.c to improve performance.
author | Thinker K.F. Li <thinker@branda.to> |
---|---|
date | Sun, 22 Feb 2009 12:54:45 +0800 |
parents | a0ce8ebf2f18 |
children |
rev | line source |
---|---|
0
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
1 #include "avriotools.h" |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
2 #include <avr/io.h> |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
3 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
4 typedef struct _port_regs { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
5 volatile uint8_t *port, *ddr, *pin; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
6 } port_regs_t; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
7 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
8 static port_regs_t regs[] = { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
9 { &PORTB, &DDRB, &PINB }, |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
10 { &PORTD, &DDRD, &PIND } |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
11 }; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
12 #define NPORTS (sizeof(regs) / sizeof(*regs)) |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
13 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
14 #define ERR -1 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
15 #define OK 0 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
16 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
17 int pin_mode(volatile uint8_t * port, int pin, pin_mode_t mode) { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
18 port_regs_t *preg; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
19 int i; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
20 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
21 for(i = 0; i < NPORTS; i++) { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
22 preg = regs + i; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
23 if(preg->port == port) |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
24 break; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
25 } |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
26 if(i == NPORTS) |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
27 return ERR; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
28 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
29 switch(mode) { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
30 case PM_INPUT: |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
31 *preg->ddr &= ~_BV(pin); |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
32 *preg->port |= _BV(pin); |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
33 break; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
34 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
35 case PM_OUTPUT: |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
36 *preg->ddr |= _BV(pin); |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
37 break; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
38 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
39 default: |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
40 return ERR; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
41 } |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
42 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
43 return OK; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
44 } |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
45 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
46 /* To make setbaud.h no more complaint */ |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
47 #define BAUD 9600 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
48 #include <util/setbaud.h> |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
49 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
50 int uart_init(uint32_t baud) { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
51 unsigned long ubrr_v; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
52 long err; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
53 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
54 if(baud > (F_CPU / 8)) |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
55 return ERR; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
56 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
57 #define F_CPUx2 (F_CPU * 2UL) |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
58 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
59 ubrr_v = (F_CPU + baud * 8UL) / (baud * 16UL) - 1UL; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
60 /* Allow bias of baud rate in 2%, or use U2X clock. |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
61 * ATmega168 divides baud rate generator clock by 2, 8, or 16. |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
62 * Setting U2X bit makes the clock divided by 8 instead of 16. |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
63 * It makes more accurately output and higher max baud rate. |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
64 */ |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
65 err = 16L * 100L * (ubrr_v + 1) * baud - F_CPU * 100L; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
66 if(err > F_CPUx2 || err < -F_CPUx2 || ubrr_v < 2) { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
67 ubrr_v = (F_CPU + baud * 4UL) / (baud * 8UL) - 1UL; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
68 UCSRA |= (1 << U2X); |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
69 } else { |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
70 UCSRA &= ~(1 << U2X); |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
71 } |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
72 |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
73 UBRRH = ubrr_v >> 8; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
74 UBRRL = ubrr_v & 0xff; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
75 return OK; |
a0ce8ebf2f18
LED on PINB0 & PINB1 and UART testing.
Thinker K.F. Li <thinker@branda.to>
parents:
diff
changeset
|
76 } |