timer: Remove trace_flags
[simavr] / simavr / cores / sim_mega128.c
1 /*
2         sim_mega128.c
3
4         Copyright 2008, 2009 Michel Pollet <buserror@gmail.com>
5
6         This file is part of simavr.
7
8         simavr is free software: you can redistribute it and/or modify
9         it under the terms of the GNU General Public License as published by
10         the Free Software Foundation, either version 3 of the License, or
11         (at your option) any later version.
12
13         simavr is distributed in the hope that it will be useful,
14         but WITHOUT ANY WARRANTY; without even the implied warranty of
15         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16         GNU General Public License for more details.
17
18         You should have received a copy of the GNU General Public License
19         along with simavr.  If not, see <http://www.gnu.org/licenses/>.
20  */
21
22 #include <stdio.h>
23 #include "sim_avr.h"
24 #include "sim_core_declare.h"
25 #include "avr_eeprom.h"
26 #include "avr_flash.h"
27 #include "avr_watchdog.h"
28 #include "avr_extint.h"
29 #include "avr_ioport.h"
30 #include "avr_uart.h"
31 #include "avr_adc.h"
32 #include "avr_timer.h"
33 #include "avr_spi.h"
34 #include "avr_twi.h"
35
36 void m128_init(struct avr_t * avr);
37 void m128_reset(struct avr_t * avr);
38
39 #define _AVR_IO_H_
40 #define __ASSEMBLER__
41 #include "avr/iom128.h"
42
43 /*
44  * This is a template for all of the 128 devices, hopefully
45  */
46 const struct mcu_t {
47         avr_t          core;
48         avr_eeprom_t    eeprom;
49         avr_flash_t     selfprog;
50         avr_watchdog_t  watchdog;
51         avr_extint_t    extint;
52         avr_ioport_t    porta, portb, portc, portd, porte, portf, portg;
53         avr_uart_t              uart0,uart1;
54         avr_adc_t               adc;
55         avr_timer_t             timer0,timer1,timer2,timer3;
56         avr_spi_t               spi;
57         avr_twi_t               twi;
58 } mcu_mega128 = {
59         .core = {
60                 .mmcu = "atmega128",
61                 DEFAULT_CORE(4),
62
63                 .init = m128_init,
64                 .reset = m128_reset,
65
66                 .rampz = RAMPZ, // extended program memory access
67         },
68         AVR_EEPROM_DECLARE_NOEEPM(EE_READY_vect),
69         AVR_SELFPROG_DECLARE(SPMCSR, SPMEN, SPM_READY_vect),
70         AVR_WATCHDOG_DECLARE_128(WDTCR, _VECTOR(0)),
71         .extint = {
72                 AVR_EXTINT_DECLARE(0, 'D', PD0),
73                 AVR_EXTINT_DECLARE(1, 'D', PD1),
74                 AVR_EXTINT_DECLARE(2, 'D', PD2),
75                 AVR_EXTINT_DECLARE(3, 'D', PD3),
76                 AVR_EXTINT_DECLARE(4, 'E', PE4),
77                 AVR_EXTINT_DECLARE(5, 'E', PE5),
78                 AVR_EXTINT_DECLARE(6, 'E', PE6),
79                 AVR_EXTINT_DECLARE(7, 'E', PE7),
80         },
81         .porta = {  // no PCINTs in atmega128
82                 .name = 'A', .r_port = PORTA, .r_ddr = DDRA, .r_pin = PINA,
83         },
84         .portb = {
85                 .name = 'B', .r_port = PORTB, .r_ddr = DDRB, .r_pin = PINB,
86         },
87         .portc = {
88                 .name = 'C', .r_port = PORTC, .r_ddr = DDRC, .r_pin = PINC,
89         },
90         .portd = {
91                 .name = 'D', .r_port = PORTD, .r_ddr = DDRD, .r_pin = PIND,
92         },
93         .porte = {
94                 .name = 'E', .r_port = PORTE, .r_ddr = DDRE, .r_pin = PINE,
95         },
96         .portf = {
97                 .name = 'F', .r_port = PORTF, .r_ddr = DDRF, .r_pin = PINF,
98         },
99         .portg = {
100                 .name = 'G', .r_port = PORTG, .r_ddr = DDRG, .r_pin = PING,
101         },
102
103         .uart0 = {
104            // no PRUSART .disabled = AVR_IO_REGBIT(PRR,PRUSART0),
105                 .name = '0',
106                 .r_udr = UDR0,
107
108                 .txen = AVR_IO_REGBIT(UCSR0B, TXEN0),
109                 .rxen = AVR_IO_REGBIT(UCSR0B, RXEN0),
110                 .ucsz = AVR_IO_REGBITS(UCSR0C, UCSZ00, 0x3), // 2 bits
111                 .ucsz2 = AVR_IO_REGBIT(UCSR0B, UCSZ02),         // 1 bits
112
113                 .r_ucsra = UCSR0A,
114                 .r_ucsrb = UCSR0B,
115                 .r_ucsrc = UCSR0C,
116                 .r_ubrrl = UBRR0L,
117                 .r_ubrrh = UBRR0H,
118                 .rxc = {
119                         .enable = AVR_IO_REGBIT(UCSR0B, RXCIE0),
120                         .raised = AVR_IO_REGBIT(UCSR0A, RXC0),
121                         .vector = USART0_RX_vect,
122                 },
123                 .txc = {
124                         .enable = AVR_IO_REGBIT(UCSR0B, TXCIE0),
125                         .raised = AVR_IO_REGBIT(UCSR0A, TXC0),
126                         .vector = USART0_TX_vect,
127                 },
128                 .udrc = {
129                         .enable = AVR_IO_REGBIT(UCSR0B, UDRIE0),
130                         .raised = AVR_IO_REGBIT(UCSR0A, UDRE0),
131                         .vector = USART0_UDRE_vect,
132                 },
133         },
134         .uart1 = {
135            // no PRUSART .disabled = AVR_IO_REGBIT(PRR,PRUSART1),
136                 .name = '1',
137                 .r_udr = UDR1,
138
139                 .txen = AVR_IO_REGBIT(UCSR1B, TXEN1),
140                 .rxen = AVR_IO_REGBIT(UCSR1B, RXEN1),
141                 .ucsz = AVR_IO_REGBITS(UCSR1C, UCSZ10, 0x3), // 2 bits
142                 .ucsz2 = AVR_IO_REGBIT(UCSR1B, UCSZ12),         // 1 bits
143
144                 .r_ucsra = UCSR1A,
145                 .r_ucsrb = UCSR1B,
146                 .r_ucsrc = UCSR1C,
147                 .r_ubrrl = UBRR1L,
148                 .r_ubrrh = UBRR1H,
149                 .rxc = {
150                         .enable = AVR_IO_REGBIT(UCSR1B, RXCIE1),
151                         .raised = AVR_IO_REGBIT(UCSR1A, RXC1),
152                         .vector = USART1_RX_vect,
153                 },
154                 .txc = {
155                         .enable = AVR_IO_REGBIT(UCSR1B, TXCIE1),
156                         .raised = AVR_IO_REGBIT(UCSR1A, TXC1),
157                         .vector = USART1_TX_vect,
158                 },
159                 .udrc = {
160                         .enable = AVR_IO_REGBIT(UCSR1B, UDRIE1),
161                         .raised = AVR_IO_REGBIT(UCSR1A, UDRE1),
162                         .vector = USART1_UDRE_vect,
163                 },
164         },
165         .adc = {
166                 .r_admux = ADMUX,
167                 .mux = { AVR_IO_REGBIT(ADMUX, MUX0), AVR_IO_REGBIT(ADMUX, MUX1),
168                                         AVR_IO_REGBIT(ADMUX, MUX2), AVR_IO_REGBIT(ADMUX, MUX3),
169                                         AVR_IO_REGBIT(ADMUX, MUX4),},
170                 .ref = { AVR_IO_REGBIT(ADMUX, REFS0), AVR_IO_REGBIT(ADMUX, REFS1)},
171                 .ref_values = { [1] = ADC_VREF_AVCC, [3] = ADC_VREF_V256 },
172
173                 .adlar = AVR_IO_REGBIT(ADMUX, ADLAR),
174                 .r_adcsra = ADCSRA,
175                 .aden = AVR_IO_REGBIT(ADCSRA, ADEN),
176                 .adsc = AVR_IO_REGBIT(ADCSRA, ADSC),
177                 // no ADATE .adate = AVR_IO_REGBIT(ADCSRA, ADATE),
178                 .adps = { AVR_IO_REGBIT(ADCSRA, ADPS0), AVR_IO_REGBIT(ADCSRA, ADPS1), AVR_IO_REGBIT(ADCSRA, ADPS2),},
179
180                 .r_adch = ADCH,
181                 .r_adcl = ADCL,
182
183                 //.r_adcsrb = ADCSRB,
184                 // .adts = { AVR_IO_REGBIT(ADCSRB, ADTS0), AVR_IO_REGBIT(ADCSRB, ADTS1), AVR_IO_REGBIT(ADCSRB, ADTS2),},
185
186                 .muxmode = {
187                         [0] = AVR_ADC_SINGLE(0), [1] = AVR_ADC_SINGLE(1),
188                         [2] = AVR_ADC_SINGLE(2), [3] = AVR_ADC_SINGLE(3),
189                         [4] = AVR_ADC_SINGLE(4), [5] = AVR_ADC_SINGLE(5),
190                         [6] = AVR_ADC_SINGLE(6), [7] = AVR_ADC_SINGLE(7),
191
192                         [ 8] = AVR_ADC_DIFF(0, 0,  10), [ 9] = AVR_ADC_DIFF(1, 0,  10),
193                         [10] = AVR_ADC_DIFF(0, 0, 200), [11] = AVR_ADC_DIFF(1, 0, 200),
194                         [12] = AVR_ADC_DIFF(2, 2,  10), [13] = AVR_ADC_DIFF(3, 2,  10),
195                         [14] = AVR_ADC_DIFF(2, 2, 200), [15] = AVR_ADC_DIFF(3, 2, 200),
196
197                         [16] = AVR_ADC_DIFF(0, 1,   1), [17] = AVR_ADC_DIFF(1, 1,   1),
198                         [18] = AVR_ADC_DIFF(2, 1,   1), [19] = AVR_ADC_DIFF(3, 1,   1),
199                         [20] = AVR_ADC_DIFF(4, 1,   1), [21] = AVR_ADC_DIFF(5, 1,   1),
200                         [22] = AVR_ADC_DIFF(6, 1,   1), [23] = AVR_ADC_DIFF(7, 1,   1),
201
202                         [24] = AVR_ADC_DIFF(0, 2,   1), [25] = AVR_ADC_DIFF(1, 2,   1),
203                         [26] = AVR_ADC_DIFF(2, 2,   1), [27] = AVR_ADC_DIFF(3, 2,   1),
204                         [28] = AVR_ADC_DIFF(4, 2,   1), [29] = AVR_ADC_DIFF(5, 2,   1),
205
206                         [30] = AVR_ADC_REF(1230),       // 1.1V
207                         [31] = AVR_ADC_REF(0),          // GND
208                 },
209
210                 .adc = {
211                         .enable = AVR_IO_REGBIT(ADCSRA, ADIE),
212                         .raised = AVR_IO_REGBIT(ADCSRA, ADIF),
213                         .vector = ADC_vect,
214                 },
215         },
216         .timer0 = {
217                 .name = '0',
218                 .wgm = { AVR_IO_REGBIT(TCCR0, WGM00), AVR_IO_REGBIT(TCCR0, WGM01) },
219                 .wgm_op = {
220                         [0] = AVR_TIMER_WGM_NORMAL8(),
221                         // PHASE CORRECT 
222                         [2] = AVR_TIMER_WGM_CTC(),
223                         [3] = AVR_TIMER_WGM_FASTPWM8(),
224                 },
225                 .cs = { AVR_IO_REGBIT(TCCR0, CS00), AVR_IO_REGBIT(TCCR0, CS01), AVR_IO_REGBIT(TCCR0, CS02) },
226                 //              .cs_div = { 0, 0, 3 /* 8 */, 6 /* 64 */, 8 /* 256 */, 10 /* 1024 */ },
227                 .cs_div = { 0, 0, 3 /* 8 */, 5 /* 32 */, 6 /* 64 */, 7 /* 128 */, 8 /* 256 */, 10 /* 1024 */},
228
229                 // asynchronous timer source bit.. if set, use 32khz frequency
230                 .as2 = AVR_IO_REGBIT(ASSR, AS0),
231                 
232                 .r_tcnt = TCNT0,
233
234                 .overflow = {
235                         .enable = AVR_IO_REGBIT(TIMSK, TOIE0),
236                         .raised = AVR_IO_REGBIT(TIFR, TOV0),
237                         .vector = TIMER0_OVF_vect,
238                 },
239                 .comp = {
240                         [AVR_TIMER_COMPA] = {
241                                 .r_ocr = OCR0,
242                                 .com = AVR_IO_REGBITS(TCCR0, COM00, 0x3),
243                                 .com_pin = AVR_IO_REGBIT(PORTB, PB4),
244                                 .interrupt = {
245                                         .enable = AVR_IO_REGBIT(TIMSK, OCIE0),
246                                         .raised = AVR_IO_REGBIT(TIFR, OCF0),
247                                         .vector = TIMER0_COMP_vect,
248                                 },
249                         },
250                 },
251         },
252         .timer1 = {
253                 .name = '1',
254                 .wgm = { AVR_IO_REGBIT(TCCR1A, WGM10), AVR_IO_REGBIT(TCCR1A, WGM11),
255                                         AVR_IO_REGBIT(TCCR1B, WGM12), AVR_IO_REGBIT(TCCR1B, WGM13) },
256                 .wgm_op = {
257                         [0] = AVR_TIMER_WGM_NORMAL16(),
258                         // TODO: 1 PWM phase correct 8bit
259                         //               2 PWM phase correct 9bit
260                         //       3 PWM phase correct 10bit
261                         [4] = AVR_TIMER_WGM_CTC(),
262                         [5] = AVR_TIMER_WGM_FASTPWM8(),
263                         [6] = AVR_TIMER_WGM_FASTPWM9(),
264                         [7] = AVR_TIMER_WGM_FASTPWM10(),
265                         // TODO: 8, 9 PWM phase and freq correct ICR & 10, 11
266                         [12] = AVR_TIMER_WGM_ICCTC(),
267                         [14] = AVR_TIMER_WGM_ICPWM(),
268                         [15] = AVR_TIMER_WGM_OCPWM(),
269                 },
270                 .cs = { AVR_IO_REGBIT(TCCR1B, CS10), AVR_IO_REGBIT(TCCR1B, CS11), AVR_IO_REGBIT(TCCR1B, CS12) },
271                 .cs_div = { 0, 0, 3 /* 8 */, 6 /* 64 */, 8 /* 256 */, 10 /* 1024 */  /* TODO: 2 External clocks */},
272
273                 .r_tcnt = TCNT1L,
274                 .r_icr = ICR1L,
275                 .r_icrh = ICR1H,
276                 .r_tcnth = TCNT1H,
277
278                 .ices = AVR_IO_REGBIT(TCCR1B, ICES1),
279                 .icp = AVR_IO_REGBIT(PORTD, 4),
280
281                 .overflow = {
282                         .enable = AVR_IO_REGBIT(TIMSK, TOIE1),
283                         .raised = AVR_IO_REGBIT(TIFR, TOV1),
284                         .vector = TIMER1_OVF_vect,
285                 },
286                 .icr = {
287                         .enable = AVR_IO_REGBIT(TIMSK, TICIE1),
288                         .raised = AVR_IO_REGBIT(TIFR, ICF1),
289                         .vector = TIMER1_CAPT_vect,
290                 },
291                 .comp = {
292                         [AVR_TIMER_COMPA] = {
293                                 .r_ocr = OCR1AL,
294                                 .r_ocrh = OCR1AH,       // 16 bits timers have two bytes of it
295                                 .com = AVR_IO_REGBITS(TCCR1A, COM1A0, 0x3),
296                                 .com_pin = AVR_IO_REGBIT(PORTB, PB5),
297                                 .interrupt = {
298                                         .enable = AVR_IO_REGBIT(TIMSK, OCIE1A),
299                                         .raised = AVR_IO_REGBIT(TIFR, OCF1A),
300                                         .vector = TIMER1_COMPA_vect,
301                                 },
302                         },
303                         [AVR_TIMER_COMPB] = {
304                                 .r_ocr = OCR1BL,
305                                 .r_ocrh = OCR1BH,
306                                 .com = AVR_IO_REGBITS(TCCR1A, COM1B0, 0x3),
307                                 .com_pin = AVR_IO_REGBIT(PORTB, PB6),
308                                 .interrupt = {
309                                         .enable = AVR_IO_REGBIT(TIMSK, OCIE1B),
310                                         .raised = AVR_IO_REGBIT(TIFR, OCF1B),
311                                         .vector = TIMER1_COMPB_vect,
312                                 },
313                         },
314                         [AVR_TIMER_COMPC] = {
315                                 .r_ocr = OCR1CL,
316                                 .r_ocrh = OCR1CH,
317                                 .com = AVR_IO_REGBITS(TCCR1A, COM1C0, 0x3),
318                                 .com_pin = AVR_IO_REGBIT(PORTB, PB7), // same as timer2
319                                 .interrupt = {
320                                         .enable = AVR_IO_REGBIT(ETIMSK, OCIE1C),
321                                         .raised = AVR_IO_REGBIT(ETIFR, OCF1C),
322                                         .vector = TIMER1_COMPC_vect,
323                                 },
324                         },
325                 },
326
327         },
328         .timer2 = {
329                 .name = '2',
330                 .wgm = { AVR_IO_REGBIT(TCCR2, WGM20), AVR_IO_REGBIT(TCCR2, WGM21) },
331                 .wgm_op = {
332                         [0] = AVR_TIMER_WGM_NORMAL8(),
333                         // TODO 1 pwm phase correct 
334                         [2] = AVR_TIMER_WGM_CTC(),
335                         [3] = AVR_TIMER_WGM_FASTPWM8(),
336                 },
337                 .cs = { AVR_IO_REGBIT(TCCR2, CS20), AVR_IO_REGBIT(TCCR2, CS21), AVR_IO_REGBIT(TCCR2, CS22) },
338                 .cs_div = { 0, 0, 3 /* 8 */, 6 /* 64 */, 8 /* 256 */, 10 /* 1024 */ /* TODO external clock */ },
339
340                 .r_tcnt = TCNT2,
341                 
342                 .overflow = {
343                         .enable = AVR_IO_REGBIT(TIMSK, TOIE2),
344                         .raised = AVR_IO_REGBIT(TIFR, TOV2),
345                         .vector = TIMER2_OVF_vect,
346                 },
347                 .comp = {
348                         [AVR_TIMER_COMPA] = {
349                                 .r_ocr = OCR2,
350                                 .com = AVR_IO_REGBITS(TCCR2, COM20, 0x3),
351                                 .com_pin = AVR_IO_REGBIT(PORTB, PB7), // same as timer1C
352                                 .interrupt = {
353                                         .enable = AVR_IO_REGBIT(TIMSK, OCIE2),
354                                         .raised = AVR_IO_REGBIT(TIFR, OCF2),
355                                         .vector = TIMER2_COMP_vect,
356                                 },
357                         },
358                 },
359         },
360         .timer3 = {
361                 .name = '3',
362                 .wgm = { AVR_IO_REGBIT(TCCR3A, WGM30), AVR_IO_REGBIT(TCCR3A, WGM31),
363                                         AVR_IO_REGBIT(TCCR3B, WGM32), AVR_IO_REGBIT(TCCR3B, WGM33) },
364                 .wgm_op = {
365                         [0] = AVR_TIMER_WGM_NORMAL16(),
366                         // TODO: 1 PWM phase correct 8bit
367                         //       2 PWM phase correct 9bit
368                         //       3 PWM phase correct 10bit
369                         [4] = AVR_TIMER_WGM_CTC(),
370                         [5] = AVR_TIMER_WGM_FASTPWM8(),
371                         [6] = AVR_TIMER_WGM_FASTPWM9(),
372                         [7] = AVR_TIMER_WGM_FASTPWM10(),
373                         // TODO: 8 PWM phase and freq correct ICR
374                         //       9 PWM phase and freq correct OCR
375                         //       10
376                         //       11
377                         [12] = AVR_TIMER_WGM_ICCTC(),
378                         [14] = AVR_TIMER_WGM_ICPWM(),
379                         [15] = AVR_TIMER_WGM_OCPWM(),
380                 },
381                 .cs = { AVR_IO_REGBIT(TCCR3B, CS30), AVR_IO_REGBIT(TCCR3B, CS31), AVR_IO_REGBIT(TCCR3B, CS32) },
382                 .cs_div = { 0, 0, 3 /* 8 */, 6 /* 64 */, 8 /* 256 */, 10 /* 1024 */  /* TODO: 2 External clocks */},
383
384                 .r_tcnt = TCNT3L,
385                 .r_icr = ICR3L,
386                 .r_icrh = ICR3H,
387                 .r_tcnth = TCNT3H,
388
389                 .ices = AVR_IO_REGBIT(TCCR3B, ICES3),
390                 .icp = AVR_IO_REGBIT(PORTE, 7),
391
392                 .overflow = {
393                         .enable = AVR_IO_REGBIT(ETIMSK, TOIE3),
394                         .raised = AVR_IO_REGBIT(ETIFR, TOV3),
395                         .vector = TIMER3_OVF_vect,
396                 },
397                 .comp = {
398                         [AVR_TIMER_COMPA] = {
399                                 .r_ocr = OCR3AL,
400                                 .r_ocrh = OCR3AH,       // 16 bits timers have two bytes of it
401                                 .com = AVR_IO_REGBITS(TCCR3A, COM3A0, 0x3),
402                                 .com_pin = AVR_IO_REGBIT(PORTE, PE3),
403                                 .interrupt = {
404                                         .enable = AVR_IO_REGBIT(ETIMSK, OCIE3A),
405                                         .raised = AVR_IO_REGBIT(ETIFR, OCF3A),
406                                         .vector = TIMER3_COMPA_vect,
407                                 }
408                         },
409                         [AVR_TIMER_COMPB] = {
410                                 .r_ocr = OCR3BL,
411                                 .r_ocrh = OCR3BH,
412                                 .com = AVR_IO_REGBITS(TCCR3A, COM3B0, 0x3),
413                                 .com_pin = AVR_IO_REGBIT(PORTE, PE4),
414                                 .interrupt = {
415                                         .enable = AVR_IO_REGBIT(ETIMSK, OCIE3B),
416                                         .raised = AVR_IO_REGBIT(ETIFR, OCF3B),
417                                         .vector = TIMER3_COMPB_vect,
418                                 }
419                         },
420                         [AVR_TIMER_COMPC] = {
421                                 .r_ocr = OCR3CL,
422                                 .r_ocrh = OCR3CH,
423                                 .com = AVR_IO_REGBITS(TCCR3A, COM3C0, 0x3),
424                                 .com_pin = AVR_IO_REGBIT(PORTE, PE5),
425                                 .interrupt = {
426                                         .enable = AVR_IO_REGBIT(ETIMSK, OCIE3C),
427                                         .raised = AVR_IO_REGBIT(ETIFR, OCF3C),
428                                         .vector = TIMER3_COMPC_vect,
429                                 }
430                         }
431                 },
432                 .icr = {
433                         .enable = AVR_IO_REGBIT(ETIMSK, TICIE3),
434                         .raised = AVR_IO_REGBIT(ETIFR, ICF3),
435                         .vector = TIMER3_CAPT_vect,
436                 },
437         },
438         .spi = {
439
440                 .r_spdr = SPDR,
441                 .r_spcr = SPCR,
442                 .r_spsr = SPSR,
443
444                 .spe = AVR_IO_REGBIT(SPCR, SPE),
445                 .mstr = AVR_IO_REGBIT(SPCR, MSTR),
446
447                 .spr = { AVR_IO_REGBIT(SPCR, SPR0), AVR_IO_REGBIT(SPCR, SPR1), AVR_IO_REGBIT(SPSR, SPI2X) },
448                 .spi = {
449                         .enable = AVR_IO_REGBIT(SPCR, SPIE),
450                         .raised = AVR_IO_REGBIT(SPSR, SPIF),
451                         .vector = SPI_STC_vect,
452                 },
453         },
454         
455         .twi = {
456
457                 .r_twcr = TWCR,
458                 .r_twsr = TWSR,
459                 .r_twbr = TWBR,
460                 .r_twdr = TWDR,
461                 .r_twar = TWAR,
462                 // no .r_twamr = TWAMR,
463
464                 .twen = AVR_IO_REGBIT(TWCR, TWEN),
465                 .twea = AVR_IO_REGBIT(TWCR, TWEA),
466                 .twsta = AVR_IO_REGBIT(TWCR, TWSTA),
467                 .twsto = AVR_IO_REGBIT(TWCR, TWSTO),
468                 .twwc = AVR_IO_REGBIT(TWCR, TWWC),
469
470                 .twsr = AVR_IO_REGBITS(TWSR, TWS3, 0x1f),       // 5 bits
471                 .twps = AVR_IO_REGBITS(TWSR, TWPS0, 0x3),       // 2 bits
472
473                 .twi = {
474                         .enable = AVR_IO_REGBIT(TWCR, TWIE),
475                         .raised = AVR_IO_REGBIT(TWCR, TWINT),
476                         .raise_sticky = 1,
477                         .vector = TWI_vect,
478                 },
479         },
480
481 };
482
483 static avr_t * make()
484 {
485         return avr_core_allocate(&mcu_mega128.core, sizeof(struct mcu_t));
486 }
487
488 avr_kind_t mega128 = {
489         .names = { "atmega128", "atmega128L" },
490         .make = make
491 };
492
493 void m128_init(struct avr_t * avr)
494 {
495         struct mcu_t * mcu = (struct mcu_t*)avr;
496
497         printf("%s init\n", avr->mmcu);
498         
499         avr_eeprom_init(avr, &mcu->eeprom);
500         avr_flash_init(avr, &mcu->selfprog);
501         avr_extint_init(avr, &mcu->extint);
502         avr_watchdog_init(avr, &mcu->watchdog);
503         avr_ioport_init(avr, &mcu->porta);
504         avr_ioport_init(avr, &mcu->portb);
505         avr_ioport_init(avr, &mcu->portc);
506         avr_ioport_init(avr, &mcu->portd);
507         avr_ioport_init(avr, &mcu->porte);
508         avr_ioport_init(avr, &mcu->portf);
509         avr_ioport_init(avr, &mcu->portg);
510         avr_uart_init(avr, &mcu->uart0);
511         avr_uart_init(avr, &mcu->uart1);
512         avr_adc_init(avr, &mcu->adc);
513         avr_timer_init(avr, &mcu->timer0);
514         avr_timer_init(avr, &mcu->timer1);
515         avr_timer_init(avr, &mcu->timer2);
516         avr_timer_init(avr, &mcu->timer3);
517         avr_spi_init(avr, &mcu->spi);
518         avr_twi_init(avr, &mcu->twi);
519 }
520
521 void m128_reset(struct avr_t * avr)
522 {
523 //      struct mcu_t * mcu = (struct mcu_t*)avr;
524 }