2 // YOU MUST COMPILE THIS WITH -O3 OR THE AVR WILL NOT BE ABLE TO KEEP UP!!!!
\r
5 #define F_CPU 12000000
\r
7 #if !defined(__AVR_AT94K__)
\r
8 #error you forgot to put -mmcu=at94k on the command line
\r
11 #include <avr/wdt.h>
\r
12 #include <util/delay.h>
\r
14 #include <avr/interrupt.h>
\r
18 void initUART0(unsigned int baudRate, unsigned int doubleRate) {
\r
19 UBRRHI = (((baudRate) >> 8) & 0x000F);
\r
20 UBRR0 = ((baudRate) & 0x00FF);
\r
21 UCSR0B |= ((1 << RXEN0) | (1 << TXEN0) | (1 << RXCIE0));
\r
24 UCSR0A |= (1 << U2X0);
\r
26 UCSR0A &= ~(1 << U2X0);
\r
29 #define BUFSIZE (1024)
\r
31 long int numread = 0;
\r
32 inline void cts(int c) {
\r
42 static volatile int sending = 0;
\r
43 static volatile int32_t interrupt_count = 0;
\r
45 // RECV //////////////////////////////////////////////////////////////////////////////
\r
47 char read_buf[BUFSIZE];
\r
48 volatile int read_buf_head;
\r
49 volatile int read_buf_tail;
\r
50 char write_buf[BUFSIZE];
\r
51 volatile int write_buf_head;
\r
52 volatile int write_buf_tail;
\r
54 inline int inc(int x) { x++; if (x>=BUFSIZE) x=0; return x; }
\r
55 inline int read_full() { return inc(read_buf_tail)==read_buf_head; }
\r
56 inline int abs(int x) { return x<0 ? -x : x; }
\r
57 inline int read_size() { return read_buf_tail<read_buf_head ? (read_buf_head-read_buf_tail) : (read_buf_tail-read_buf_head); }
\r
58 inline int read_empty() { return read_buf_head==read_buf_tail; }
\r
59 inline int read_nearlyFull() {
\r
60 if (read_buf_tail==read_buf_head) return 0;
\r
61 if (read_buf_tail < read_buf_head) return (read_buf_head-read_buf_tail) < (BUFSIZE/2);
\r
62 return (read_buf_tail-read_buf_head) > (BUFSIZE/2);
\r
65 inline int write_full() { return inc(write_buf_tail)==write_buf_head; }
\r
66 inline int write_empty() { return write_buf_head==write_buf_tail; }
\r
67 inline int write_nearlyFull() {
\r
68 if (write_buf_tail==write_buf_head) return 0;
\r
69 if (write_buf_tail < write_buf_head) return (write_buf_head-write_buf_tail) < (BUFSIZE/2);
\r
70 return (write_buf_tail-write_buf_head) > (BUFSIZE/2);
\r
73 inline char recv() {
\r
76 while(read_empty()) cts(1);
\r
77 ret = read_buf[read_buf_head];
\r
78 read_buf_head = inc(read_buf_head);
\r
79 if (!read_nearlyFull()) cts(1);
\r
80 if (PORTE & (1<<3)) PORTE &= ~(1<<3);
\r
81 else PORTE |= (1<<3);
\r
85 // Interrupt Handlers //////////////////////////////////////////////////////////////////////////////
\r
87 ISR(SIG_UART0_DATA) {
\r
88 if (write_empty()) {
\r
89 UCSR0B &= ~(1 << UDRIE0);
\r
92 char ret = write_buf[write_buf_head];
\r
93 write_buf_head = inc(write_buf_head);
\r
99 while (write_full());
\r
100 write_buf[write_buf_tail] = c;
\r
101 write_buf_tail = inc(write_buf_tail);
\r
102 if (PORTE & (1<<2)) PORTE &= ~(1<<2);
\r
103 else PORTE |= (1<<2);
\r
104 UCSR0B |= (1 << UDRIE0);
\r
108 void fpga_interrupts(int on) {
\r
119 inline void conf(int z, int y, int x, int d) {
\r
126 #define TIMERVAL 100
\r
128 ISR(SIG_FPGA_INTERRUPT0) {
\r
130 fpga_interrupts(1);
\r
134 void die() { cli(); PORTE|=(1<<5); _delay_ms(2000); while(1) { } }
\r
136 ISR(SIG_UART0_RECV) {
\r
137 if (UCSR0A & (1 << FE0)) err = 201;//{ portd(2,0); portd(3,1); die(); } // framing error, lock up with LED=01
\r
138 if ((UCSR0A & (1 << OR0))) err = 202;//{ portd(2,1); portd(3,0); die(); } // overflow; lock up with LED=10
\r
139 if (read_full()) err = 203;//{ portd(2,1); portd(3,1); die(); } // buffer overrun
\r
141 read_buf[read_buf_tail] = UDR0;
\r
142 read_buf_tail = inc(read_buf_tail);
\r
143 if (read_nearlyFull()) cts(0);
\r
148 inline int hex(char c) {
\r
149 if (c >= '0' && c <= '9') return (c - '0');
\r
150 if (c >= 'a' && c <= 'f') return ((c - 'a') + 0xa);
\r
151 if (c >= 'A' && c <= 'F') return ((c - 'A') + 0xa);
\r
156 fpga_interrupts(0);
\r
158 fpga_interrupts(1);
\r
163 DDRE = (1<<7) | (1<<5) | (1<<3) | (1<<2);
\r
168 write_buf_head = 0;
\r
169 write_buf_tail = 0;
\r
170 initUART0(0, 0); //for slow board
\r
191 fpga_interrupts(0);
\r
192 if (flag) {PORTE |= (1<<5);}
\r
209 int32_t local_interrupt_count = interrupt_count;
\r
210 interrupt_count = 0;
\r
211 send((local_interrupt_count >> 24) & 0xff);
\r
212 send((local_interrupt_count >> 16) & 0xff);
\r
213 send((local_interrupt_count >> 8) & 0xff);
\r
214 send((local_interrupt_count >> 0) & 0xff);
\r