Arduino-USB-HID-RetroJoysti.../C64_4joy_adapter/old2.txt

3344 lines
107 KiB
Plaintext

C:\Users\lehti\AppData\Local\Temp\arduino_build_972304\c64_4joystick-adapter.ino.elf: file format elf32-avr
Disassembly of section .text:
00000000 <__vectors>:
0: 0c 94 bf 00 jmp 0x17e ; 0x17e <__ctors_end>
4: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
8: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
c: 0c 94 70 06 jmp 0xce0 ; 0xce0 <__vector_3>
10: 0c 94 5d 06 jmp 0xcba ; 0xcba <__vector_4>
14: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
18: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
1c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
20: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
24: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
28: 0c 94 64 03 jmp 0x6c8 ; 0x6c8 <__vector_10>
2c: 0c 94 d3 03 jmp 0x7a6 ; 0x7a6 <__vector_11>
30: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
34: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
38: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
3c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
40: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
44: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
48: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
4c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
50: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
54: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
58: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
5c: 0c 94 05 06 jmp 0xc0a ; 0xc0a <__vector_23>
60: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
64: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
68: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
6c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
70: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
74: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
78: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
7c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
80: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
84: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
88: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
8c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
90: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
94: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
98: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
9c: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
a0: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
a4: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
a8: 0c 94 e7 00 jmp 0x1ce ; 0x1ce <__bad_interrupt>
000000ac <__trampolines_end>:
ac: 08 0b sbc r16, r24
ae: 00 02 muls r16, r16
b0: 02 02 muls r16, r18
b2: 00 00 nop
b4: 09 04 cpc r0, r9
b6: 00 00 nop
b8: 01 02 muls r16, r17
ba: 02 00 .word 0x0002 ; ????
bc: 00 05 cpc r16, r0
be: 24 00 .word 0x0024 ; ????
c0: 10 01 movw r2, r0
c2: 05 24 eor r0, r5
c4: 01 01 movw r0, r2
c6: 01 04 cpc r0, r1
c8: 24 02 muls r18, r20
ca: 06 05 cpc r16, r6
cc: 24 06 cpc r2, r20
ce: 00 01 movw r0, r0
d0: 07 05 cpc r16, r7
d2: 81 03 fmuls r16, r17
d4: 10 00 .word 0x0010 ; ????
d6: 40 09 sbc r20, r0
d8: 04 01 movw r0, r8
da: 00 02 muls r16, r16
dc: 0a 00 .word 0x000a ; ????
de: 00 00 nop
e0: 07 05 cpc r16, r7
e2: 02 02 muls r16, r18
e4: 40 00 .word 0x0040 ; ????
e6: 00 07 cpc r16, r16
e8: 05 83 std Z+5, r16 ; 0x05
ea: 02 40 sbci r16, 0x02 ; 2
...
000000ee <STRING_LANGUAGE>:
ee: 04 03 09 04 ....
000000f2 <USB_DeviceDescriptorIAD>:
f2: 12 01 00 02 ef 02 01 40 41 23 36 80 00 01 01 02 .......@A#6.....
102: 03 01 ..
00000104 <STRING_MANUFACTURER>:
104: 41 72 64 75 69 6e 6f 20 4c 4c 43 00 Arduino LLC.
00000110 <STRING_PRODUCT>:
110: 41 72 64 75 69 6e 6f 20 4c 65 6f 6e 61 72 64 6f Arduino Leonardo
...
00000121 <port_to_output_PGM>:
121: 00 00 00 00 25 00 28 00 2b 00 2e 00 31 00 ....%.(.+...1.
0000012f <port_to_mode_PGM>:
12f: 00 00 00 00 24 00 27 00 2a 00 2d 00 30 00 ....$.'.*.-.0.
0000013d <digital_pin_to_port_PGM>:
13d: 04 04 04 04 04 03 04 05 02 02 02 02 04 03 02 02 ................
14d: 02 02 06 06 06 06 06 06 04 04 02 02 02 04 04 ...............
0000015c <digital_pin_to_bit_mask_PGM>:
15c: 04 08 02 01 10 40 80 40 10 20 40 80 40 80 08 02 .....@.@. @.@...
16c: 04 01 80 40 20 10 02 01 10 80 10 20 40 40 20 00 ...@ ...... @@ .
0000017c <__ctors_start>:
17c: 75 06 cpc r7, r21
0000017e <__ctors_end>:
17e: 11 24 eor r1, r1
180: 1f be out 0x3f, r1 ; 63
182: cf ef ldi r28, 0xFF ; 255
184: da e0 ldi r29, 0x0A ; 10
186: de bf out 0x3e, r29 ; 62
188: cd bf out 0x3d, r28 ; 61
0000018a <__do_copy_data>:
18a: 11 e0 ldi r17, 0x01 ; 1
18c: a0 e0 ldi r26, 0x00 ; 0
18e: b1 e0 ldi r27, 0x01 ; 1
190: e6 e0 ldi r30, 0x06 ; 6
192: ff e0 ldi r31, 0x0F ; 15
194: 02 c0 rjmp .+4 ; 0x19a <__do_copy_data+0x10>
196: 05 90 lpm r0, Z+
198: 0d 92 st X+, r0
19a: a6 32 cpi r26, 0x26 ; 38
19c: b1 07 cpc r27, r17
19e: d9 f7 brne .-10 ; 0x196 <__do_copy_data+0xc>
000001a0 <__do_clear_bss>:
1a0: 21 e0 ldi r18, 0x01 ; 1
1a2: a6 e2 ldi r26, 0x26 ; 38
1a4: b1 e0 ldi r27, 0x01 ; 1
1a6: 01 c0 rjmp .+2 ; 0x1aa <.do_clear_bss_start>
000001a8 <.do_clear_bss_loop>:
1a8: 1d 92 st X+, r1
000001aa <.do_clear_bss_start>:
1aa: a5 39 cpi r26, 0x95 ; 149
1ac: b2 07 cpc r27, r18
1ae: e1 f7 brne .-8 ; 0x1a8 <.do_clear_bss_loop>
000001b0 <__do_global_ctors>:
1b0: 10 e0 ldi r17, 0x00 ; 0
1b2: cf eb ldi r28, 0xBF ; 191
1b4: d0 e0 ldi r29, 0x00 ; 0
1b6: 04 c0 rjmp .+8 ; 0x1c0 <__do_global_ctors+0x10>
1b8: 21 97 sbiw r28, 0x01 ; 1
1ba: fe 01 movw r30, r28
1bc: 0e 94 7b 07 call 0xef6 ; 0xef6 <__tablejump2__>
1c0: ce 3b cpi r28, 0xBE ; 190
1c2: d1 07 cpc r29, r17
1c4: c9 f7 brne .-14 ; 0x1b8 <__do_global_ctors+0x8>
1c6: 0e 94 8a 06 call 0xd14 ; 0xd14 <main>
1ca: 0c 94 81 07 jmp 0xf02 ; 0xf02 <_exit>
000001ce <__bad_interrupt>:
1ce: 0c 94 00 00 jmp 0 ; 0x0 <__vectors>
000001d2 <pinMode.constprop.11>:
#define ARDUINO_MAIN
#include "wiring_private.h"
#include "pins_arduino.h"
void pinMode(uint8_t pin, uint8_t mode)
1d2: cf 93 push r28
1d4: df 93 push r29
{
uint8_t bit = digitalPinToBitMask(pin);
1d6: 90 e0 ldi r25, 0x00 ; 0
1d8: fc 01 movw r30, r24
1da: e4 5a subi r30, 0xA4 ; 164
1dc: fe 4f sbci r31, 0xFE ; 254
1de: 24 91 lpm r18, Z
uint8_t port = digitalPinToPort(pin);
1e0: 83 5c subi r24, 0xC3 ; 195
1e2: 9e 4f sbci r25, 0xFE ; 254
1e4: fc 01 movw r30, r24
1e6: 84 91 lpm r24, Z
volatile uint8_t *reg, *out;
if (port == NOT_A_PIN) return;
1e8: 88 23 and r24, r24
1ea: c1 f0 breq .+48 ; 0x21c <pinMode.constprop.11+0x4a>
// JWS: can I let the optimizer do this?
reg = portModeRegister(port);
1ec: 90 e0 ldi r25, 0x00 ; 0
1ee: 88 0f add r24, r24
1f0: 99 1f adc r25, r25
1f2: fc 01 movw r30, r24
1f4: e1 5d subi r30, 0xD1 ; 209
1f6: fe 4f sbci r31, 0xFE ; 254
1f8: c5 91 lpm r28, Z+
1fa: d4 91 lpm r29, Z
out = portOutputRegister(port);
1fc: fc 01 movw r30, r24
1fe: ef 5d subi r30, 0xDF ; 223
200: fe 4f sbci r31, 0xFE ; 254
202: a5 91 lpm r26, Z+
204: b4 91 lpm r27, Z
cli();
*reg &= ~bit;
*out &= ~bit;
SREG = oldSREG;
} else if (mode == INPUT_PULLUP) {
uint8_t oldSREG = SREG;
206: 9f b7 in r25, 0x3f ; 63
cli();
208: f8 94 cli
*reg &= ~bit;
20a: 38 81 ld r19, Y
20c: 82 2f mov r24, r18
20e: 80 95 com r24
210: 83 23 and r24, r19
212: 88 83 st Y, r24
*out |= bit;
214: ec 91 ld r30, X
216: e2 2b or r30, r18
218: ec 93 st X, r30
SREG = oldSREG;
21a: 9f bf out 0x3f, r25 ; 63
uint8_t oldSREG = SREG;
cli();
*reg |= bit;
SREG = oldSREG;
}
}
21c: df 91 pop r29
21e: cf 91 pop r28
220: 08 95 ret
00000222 <_Z8USB_RecvhPvi.constprop.5>:
return FifoByteCount();
}
// Non Blocking receive
// Return number of bytes read
int USB_Recv(u8 ep, void* d, int len)
222: fc 01 movw r30, r24
{
if (!_usbConfiguration || len < 0)
224: 80 91 94 01 lds r24, 0x0194 ; 0x800194 <_usbConfiguration>
228: 88 23 and r24, r24
22a: 11 f1 breq .+68 ; 0x270 <_Z8USB_RecvhPvi.constprop.5+0x4e>
#define USB_RECV_TIMEOUT
class LockEP
{
u8 _sreg;
public:
LockEP(u8 ep) : _sreg(SREG)
22c: 3f b7 in r19, 0x3f ; 63
{
cli();
22e: f8 94 cli
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
230: 82 e0 ldi r24, 0x02 ; 2
232: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
}
static inline u8 FifoByteCount()
{
return UEBCLX;
236: 20 91 f2 00 lds r18, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
if (!_usbConfiguration || len < 0)
return -1;
LockEP lock(ep);
u8 n = FifoByteCount();
len = min(n,len);
23a: 82 2f mov r24, r18
23c: 90 e0 ldi r25, 0x00 ; 0
23e: 18 16 cp r1, r24
240: 19 06 cpc r1, r25
242: 14 f4 brge .+4 ; 0x248 <_Z8USB_RecvhPvi.constprop.5+0x26>
244: 81 e0 ldi r24, 0x01 ; 1
246: 90 e0 ldi r25, 0x00 ; 0
n = len;
u8* dst = (u8*)d;
while (n--)
248: 88 23 and r24, r24
24a: 39 f0 breq .+14 ; 0x25a <_Z8USB_RecvhPvi.constprop.5+0x38>
RxLEDPulse = TX_RX_LED_PULSE_MS;
}
static inline u8 Recv8()
{
RXLED1; // light the RX LED
24c: 28 98 cbi 0x05, 0 ; 5
RxLEDPulse = TX_RX_LED_PULSE_MS;
24e: 44 e6 ldi r20, 0x64 ; 100
250: 40 93 93 01 sts 0x0193, r20 ; 0x800193 <RxLEDPulse>
return UEDATX;
254: 40 91 f1 00 lds r20, 0x00F1 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
u8 n = FifoByteCount();
len = min(n,len);
n = len;
u8* dst = (u8*)d;
while (n--)
*dst++ = Recv8();
258: 40 83 st Z, r20
if (len && !FifoByteCount()) // release empty buffer
25a: 22 23 and r18, r18
25c: 39 f0 breq .+14 ; 0x26c <_Z8USB_RecvhPvi.constprop.5+0x4a>
UENUM = ep;
}
static inline u8 FifoByteCount()
{
return UEBCLX;
25e: 20 91 f2 00 lds r18, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
len = min(n,len);
n = len;
u8* dst = (u8*)d;
while (n--)
*dst++ = Recv8();
if (len && !FifoByteCount()) // release empty buffer
262: 21 11 cpse r18, r1
264: 03 c0 rjmp .+6 ; 0x26c <_Z8USB_RecvhPvi.constprop.5+0x4a>
return UEINTX & (1<<FIFOCON);
}
static inline void ReleaseRX()
{
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
266: 2b e6 ldi r18, 0x6B ; 107
268: 20 93 e8 00 sts 0x00E8, r18 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
cli();
SetEP(ep & 7);
}
~LockEP()
{
SREG = _sreg;
26c: 3f bf out 0x3f, r19 ; 63
26e: 08 95 ret
// Non Blocking receive
// Return number of bytes read
int USB_Recv(u8 ep, void* d, int len)
{
if (!_usbConfiguration || len < 0)
return -1;
270: 8f ef ldi r24, 0xFF ; 255
272: 9f ef ldi r25, 0xFF ; 255
*dst++ = Recv8();
if (len && !FifoByteCount()) // release empty buffer
ReleaseRX();
return len;
}
274: 08 95 ret
00000276 <_Z13USB_SendSpaceh.constprop.3>:
#define USB_RECV_TIMEOUT
class LockEP
{
u8 _sreg;
public:
LockEP(u8 ep) : _sreg(SREG)
276: 2f b7 in r18, 0x3f ; 63
{
cli();
278: f8 94 cli
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
27a: 83 e0 ldi r24, 0x03 ; 3
27c: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
UECONX = (1<<STALLRQ) | (1<<EPEN);
}
static inline u8 ReadWriteAllowed()
{
return UEINTX & (1<<RWAL);
280: 90 91 e8 00 lds r25, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
// Space in send EP
u8 USB_SendSpace(u8 ep)
{
LockEP lock(ep);
if (!ReadWriteAllowed())
284: 89 2f mov r24, r25
286: 80 72 andi r24, 0x20 ; 32
288: 95 ff sbrs r25, 5
28a: 04 c0 rjmp .+8 ; 0x294 <_Z13USB_SendSpaceh.constprop.3+0x1e>
UENUM = ep;
}
static inline u8 FifoByteCount()
{
return UEBCLX;
28c: 90 91 f2 00 lds r25, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
u8 USB_SendSpace(u8 ep)
{
LockEP lock(ep);
if (!ReadWriteAllowed())
return 0;
return USB_EP_SIZE - FifoByteCount();
290: 80 e4 ldi r24, 0x40 ; 64
292: 89 1b sub r24, r25
cli();
SetEP(ep & 7);
}
~LockEP()
{
SREG = _sreg;
294: 2f bf out 0x3f, r18 ; 63
{
LockEP lock(ep);
if (!ReadWriteAllowed())
return 0;
return USB_EP_SIZE - FifoByteCount();
}
296: 08 95 ret
00000298 <_Z12PluggableUSBv>:
// restart USB layer???
}
PluggableUSB_& PluggableUSB()
{
static PluggableUSB_ obj;
298: 80 91 8b 01 lds r24, 0x018B ; 0x80018b <_ZGVZ12PluggableUSBvE3obj>
29c: 81 11 cpse r24, r1
29e: 0d c0 rjmp .+26 ; 0x2ba <_Z12PluggableUSBv+0x22>
return obj;
}
PluggableUSB_::PluggableUSB_() : lastIf(CDC_ACM_INTERFACE + CDC_INTERFACE_COUNT),
lastEp(CDC_FIRST_ENDPOINT + CDC_ENPOINT_COUNT),
rootNode(NULL)
2a0: 82 e0 ldi r24, 0x02 ; 2
2a2: 80 93 87 01 sts 0x0187, r24 ; 0x800187 <_ZZ12PluggableUSBvE3obj>
2a6: 84 e0 ldi r24, 0x04 ; 4
2a8: 80 93 88 01 sts 0x0188, r24 ; 0x800188 <_ZZ12PluggableUSBvE3obj+0x1>
2ac: 10 92 8a 01 sts 0x018A, r1 ; 0x80018a <_ZZ12PluggableUSBvE3obj+0x3>
2b0: 10 92 89 01 sts 0x0189, r1 ; 0x800189 <_ZZ12PluggableUSBvE3obj+0x2>
// restart USB layer???
}
PluggableUSB_& PluggableUSB()
{
static PluggableUSB_ obj;
2b4: 81 e0 ldi r24, 0x01 ; 1
2b6: 80 93 8b 01 sts 0x018B, r24 ; 0x80018b <_ZGVZ12PluggableUSBvE3obj>
return obj;
}
2ba: 87 e8 ldi r24, 0x87 ; 135
2bc: 91 e0 ldi r25, 0x01 ; 1
2be: 08 95 ret
000002c0 <_ZN7Serial_5writeEh>:
{
USB_Flush(CDC_TX);
}
size_t Serial_::write(uint8_t c)
{
2c0: cf 93 push r28
2c2: df 93 push r29
2c4: 1f 92 push r1
2c6: cd b7 in r28, 0x3d ; 61
2c8: de b7 in r29, 0x3e ; 62
2ca: 69 83 std Y+1, r22 ; 0x01
return write(&c, 1);
2cc: dc 01 movw r26, r24
2ce: ed 91 ld r30, X+
2d0: fc 91 ld r31, X
2d2: 02 80 ldd r0, Z+2 ; 0x02
2d4: f3 81 ldd r31, Z+3 ; 0x03
2d6: e0 2d mov r30, r0
2d8: 41 e0 ldi r20, 0x01 ; 1
2da: 50 e0 ldi r21, 0x00 ; 0
2dc: be 01 movw r22, r28
2de: 6f 5f subi r22, 0xFF ; 255
2e0: 7f 4f sbci r23, 0xFF ; 255
2e2: 09 95 icall
}
2e4: 0f 90 pop r0
2e6: df 91 pop r29
2e8: cf 91 pop r28
2ea: 08 95 ret
000002ec <_ZN7Serial_5flushEv>:
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
2ec: 83 e0 ldi r24, 0x03 ; 3
2ee: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
}
static inline u8 FifoByteCount()
{
return UEBCLX;
2f2: 80 91 f2 00 lds r24, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
}
void USB_Flush(u8 ep)
{
SetEP(ep);
if (FifoByteCount())
2f6: 88 23 and r24, r24
2f8: 19 f0 breq .+6 ; 0x300 <_ZN7Serial_5flushEv+0x14>
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
}
static inline void ReleaseTX()
{
UEINTX = 0x3A; // FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
2fa: 8a e3 ldi r24, 0x3A ; 58
2fc: 80 93 e8 00 sts 0x00E8, r24 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
}
void Serial_::flush(void)
{
USB_Flush(CDC_TX);
}
300: 08 95 ret
00000302 <_ZN7Serial_17availableForWriteEv>:
return USB_Recv(CDC_RX);
}
int Serial_::availableForWrite(void)
{
return USB_SendSpace(CDC_TX);
302: 0e 94 3b 01 call 0x276 ; 0x276 <_Z13USB_SendSpaceh.constprop.3>
}
306: 90 e0 ldi r25, 0x00 ; 0
308: 08 95 ret
0000030a <_ZN7Serial_4readEv>:
peek_buffer = USB_Recv(CDC_RX);
return peek_buffer;
}
int Serial_::read(void)
{
30a: cf 93 push r28
30c: df 93 push r29
30e: 1f 92 push r1
310: cd b7 in r28, 0x3d ; 61
312: de b7 in r29, 0x3e ; 62
314: fc 01 movw r30, r24
if (peek_buffer >= 0) {
316: 84 85 ldd r24, Z+12 ; 0x0c
318: 95 85 ldd r25, Z+13 ; 0x0d
31a: 97 fd sbrc r25, 7
31c: 08 c0 rjmp .+16 ; 0x32e <_ZN7Serial_4readEv+0x24>
int c = peek_buffer;
peek_buffer = -1;
31e: 2f ef ldi r18, 0xFF ; 255
320: 3f ef ldi r19, 0xFF ; 255
322: 35 87 std Z+13, r19 ; 0x0d
324: 24 87 std Z+12, r18 ; 0x0c
return c;
}
return USB_Recv(CDC_RX);
}
326: 0f 90 pop r0
328: df 91 pop r29
32a: cf 91 pop r28
32c: 08 95 ret
// Recv 1 byte if ready
int USB_Recv(u8 ep)
{
u8 c;
if (USB_Recv(ep,&c,1) != 1)
32e: ce 01 movw r24, r28
330: 01 96 adiw r24, 0x01 ; 1
332: 0e 94 11 01 call 0x222 ; 0x222 <_Z8USB_RecvhPvi.constprop.5>
336: 01 97 sbiw r24, 0x01 ; 1
338: 19 f4 brne .+6 ; 0x340 <_ZN7Serial_4readEv+0x36>
return -1;
return c;
33a: 89 81 ldd r24, Y+1 ; 0x01
33c: 90 e0 ldi r25, 0x00 ; 0
33e: f3 cf rjmp .-26 ; 0x326 <_ZN7Serial_4readEv+0x1c>
// Recv 1 byte if ready
int USB_Recv(u8 ep)
{
u8 c;
if (USB_Recv(ep,&c,1) != 1)
return -1;
340: 8f ef ldi r24, 0xFF ; 255
342: 9f ef ldi r25, 0xFF ; 255
344: f0 cf rjmp .-32 ; 0x326 <_ZN7Serial_4readEv+0x1c>
00000346 <_ZN7Serial_4peekEv>:
}
return USB_Available(CDC_RX);
}
int Serial_::peek(void)
{
346: 0f 93 push r16
348: 1f 93 push r17
34a: cf 93 push r28
34c: df 93 push r29
34e: 1f 92 push r1
350: cd b7 in r28, 0x3d ; 61
352: de b7 in r29, 0x3e ; 62
354: 8c 01 movw r16, r24
if (peek_buffer < 0)
356: fc 01 movw r30, r24
358: 84 85 ldd r24, Z+12 ; 0x0c
35a: 95 85 ldd r25, Z+13 ; 0x0d
35c: 97 ff sbrs r25, 7
35e: 0b c0 rjmp .+22 ; 0x376 <_ZN7Serial_4peekEv+0x30>
// Recv 1 byte if ready
int USB_Recv(u8 ep)
{
u8 c;
if (USB_Recv(ep,&c,1) != 1)
360: ce 01 movw r24, r28
362: 01 96 adiw r24, 0x01 ; 1
364: 0e 94 11 01 call 0x222 ; 0x222 <_Z8USB_RecvhPvi.constprop.5>
368: 01 97 sbiw r24, 0x01 ; 1
36a: 71 f4 brne .+28 ; 0x388 <_ZN7Serial_4peekEv+0x42>
return -1;
return c;
36c: 89 81 ldd r24, Y+1 ; 0x01
36e: 90 e0 ldi r25, 0x00 ; 0
peek_buffer = USB_Recv(CDC_RX);
370: f8 01 movw r30, r16
372: 95 87 std Z+13, r25 ; 0x0d
374: 84 87 std Z+12, r24 ; 0x0c
return peek_buffer;
}
376: f8 01 movw r30, r16
378: 84 85 ldd r24, Z+12 ; 0x0c
37a: 95 85 ldd r25, Z+13 ; 0x0d
37c: 0f 90 pop r0
37e: df 91 pop r29
380: cf 91 pop r28
382: 1f 91 pop r17
384: 0f 91 pop r16
386: 08 95 ret
// Recv 1 byte if ready
int USB_Recv(u8 ep)
{
u8 c;
if (USB_Recv(ep,&c,1) != 1)
return -1;
388: 8f ef ldi r24, 0xFF ; 255
38a: 9f ef ldi r25, 0xFF ; 255
38c: f1 cf rjmp .-30 ; 0x370 <_ZN7Serial_4peekEv+0x2a>
0000038e <_ZN7Serial_9availableEv>:
{
}
int Serial_::available(void)
{
if (peek_buffer >= 0) {
38e: fc 01 movw r30, r24
390: 84 85 ldd r24, Z+12 ; 0x0c
392: 95 85 ldd r25, Z+13 ; 0x0d
394: 97 fd sbrc r25, 7
396: 0b c0 rjmp .+22 ; 0x3ae <_ZN7Serial_9availableEv+0x20>
#define USB_RECV_TIMEOUT
class LockEP
{
u8 _sreg;
public:
LockEP(u8 ep) : _sreg(SREG)
398: 9f b7 in r25, 0x3f ; 63
{
cli();
39a: f8 94 cli
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
39c: 82 e0 ldi r24, 0x02 ; 2
39e: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
}
static inline u8 FifoByteCount()
{
return UEBCLX;
3a2: 80 91 f2 00 lds r24, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
cli();
SetEP(ep & 7);
}
~LockEP()
{
SREG = _sreg;
3a6: 9f bf out 0x3f, r25 ; 63
return 1 + USB_Available(CDC_RX);
3a8: 90 e0 ldi r25, 0x00 ; 0
3aa: 01 96 adiw r24, 0x01 ; 1
3ac: 08 95 ret
#define USB_RECV_TIMEOUT
class LockEP
{
u8 _sreg;
public:
LockEP(u8 ep) : _sreg(SREG)
3ae: 9f b7 in r25, 0x3f ; 63
{
cli();
3b0: f8 94 cli
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
3b2: 82 e0 ldi r24, 0x02 ; 2
3b4: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
}
static inline u8 FifoByteCount()
{
return UEBCLX;
3b8: 80 91 f2 00 lds r24, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
cli();
SetEP(ep & 7);
}
~LockEP()
{
SREG = _sreg;
3bc: 9f bf out 0x3f, r25 ; 63
}
return USB_Available(CDC_RX);
3be: 90 e0 ldi r25, 0x00 ; 0
}
3c0: 08 95 ret
000003c2 <_ZL11SendControlh>:
}
static
bool SendControl(u8 d)
{
if (_cmark < _cend)
3c2: 40 91 31 01 lds r20, 0x0131 ; 0x800131 <_ZL6_cmark>
3c6: 50 91 32 01 lds r21, 0x0132 ; 0x800132 <_ZL6_cmark+0x1>
3ca: 20 91 2f 01 lds r18, 0x012F ; 0x80012f <_ZL5_cend>
3ce: 30 91 30 01 lds r19, 0x0130 ; 0x800130 <_ZL5_cend+0x1>
3d2: 42 17 cp r20, r18
3d4: 53 07 cpc r21, r19
3d6: b4 f4 brge .+44 ; 0x404 <__LOCK_REGION_LENGTH__+0x4>
;
}
static inline u8 WaitForINOrOUT()
{
while (!(UEINTX & ((1<<TXINI)|(1<<RXOUTI))))
3d8: 90 91 e8 00 lds r25, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
3dc: 95 70 andi r25, 0x05 ; 5
3de: e1 f3 breq .-8 ; 0x3d8 <_ZL11SendControlh+0x16>
;
return (UEINTX & (1<<RXOUTI)) == 0;
3e0: 90 91 e8 00 lds r25, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
static
bool SendControl(u8 d)
{
if (_cmark < _cend)
{
if (!WaitForINOrOUT())
3e4: 92 fd sbrc r25, 2
3e6: 19 c0 rjmp .+50 ; 0x41a <__LOCK_REGION_LENGTH__+0x1a>
return UEDATX;
}
static inline void Send8(u8 d)
{
UEDATX = d;
3e8: 80 93 f1 00 sts 0x00F1, r24 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
if (_cmark < _cend)
{
if (!WaitForINOrOUT())
return false;
Send8(d);
if (!((_cmark + 1) & 0x3F))
3ec: 80 91 31 01 lds r24, 0x0131 ; 0x800131 <_ZL6_cmark>
3f0: 90 91 32 01 lds r25, 0x0132 ; 0x800132 <_ZL6_cmark+0x1>
3f4: 01 96 adiw r24, 0x01 ; 1
3f6: 8f 73 andi r24, 0x3F ; 63
3f8: 99 27 eor r25, r25
3fa: 89 2b or r24, r25
3fc: 19 f4 brne .+6 ; 0x404 <__LOCK_REGION_LENGTH__+0x4>
;
}
static inline void ClearIN(void)
{
UEINTX = ~(1<<TXINI);
3fe: 8e ef ldi r24, 0xFE ; 254
400: 80 93 e8 00 sts 0x00E8, r24 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
return false;
Send8(d);
if (!((_cmark + 1) & 0x3F))
ClearIN(); // Fifo is full, release this packet
}
_cmark++;
404: 80 91 31 01 lds r24, 0x0131 ; 0x800131 <_ZL6_cmark>
408: 90 91 32 01 lds r25, 0x0132 ; 0x800132 <_ZL6_cmark+0x1>
40c: 01 96 adiw r24, 0x01 ; 1
40e: 90 93 32 01 sts 0x0132, r25 ; 0x800132 <_ZL6_cmark+0x1>
412: 80 93 31 01 sts 0x0131, r24 ; 0x800131 <_ZL6_cmark>
return true;
416: 81 e0 ldi r24, 0x01 ; 1
418: 08 95 ret
bool SendControl(u8 d)
{
if (_cmark < _cend)
{
if (!WaitForINOrOUT())
return false;
41a: 80 e0 ldi r24, 0x00 ; 0
if (!((_cmark + 1) & 0x3F))
ClearIN(); // Fifo is full, release this packet
}
_cmark++;
return true;
}
41c: 08 95 ret
0000041e <_ZL24USB_SendStringDescriptorPKhhh>:
}
// Send a USB descriptor string. The string is stored in PROGMEM as a
// plain ASCII string but is sent out as UTF-16 with the correct 2-byte
// prefix
static bool USB_SendStringDescriptor(const u8*string_P, u8 string_len, uint8_t flags) {
41e: ef 92 push r14
420: ff 92 push r15
422: 0f 93 push r16
424: 1f 93 push r17
426: cf 93 push r28
428: df 93 push r29
42a: f8 2e mov r15, r24
42c: 19 2f mov r17, r25
42e: e6 2e mov r14, r22
430: 04 2f mov r16, r20
SendControl(2 + string_len * 2);
432: 81 e0 ldi r24, 0x01 ; 1
434: 86 0f add r24, r22
436: 88 0f add r24, r24
438: 0e 94 e1 01 call 0x3c2 ; 0x3c2 <_ZL11SendControlh>
SendControl(3);
43c: 83 e0 ldi r24, 0x03 ; 3
43e: 0e 94 e1 01 call 0x3c2 ; 0x3c2 <_ZL11SendControlh>
442: cf 2d mov r28, r15
444: d1 2f mov r29, r17
446: ec 0e add r14, r28
448: fd 2e mov r15, r29
44a: f1 1c adc r15, r1
bool pgm = flags & TRANSFER_PGM;
for(u8 i = 0; i < string_len; i++) {
44c: ce 15 cp r28, r14
44e: df 05 cpc r29, r15
450: b9 f0 breq .+46 ; 0x480 <_ZL24USB_SendStringDescriptorPKhhh+0x62>
bool r = SendControl(pgm ? pgm_read_byte(&string_P[i]) : string_P[i]);
452: 07 ff sbrs r16, 7
454: 13 c0 rjmp .+38 ; 0x47c <_ZL24USB_SendStringDescriptorPKhhh+0x5e>
456: fe 01 movw r30, r28
458: 84 91 lpm r24, Z
45a: 0e 94 e1 01 call 0x3c2 ; 0x3c2 <_ZL11SendControlh>
45e: 18 2f mov r17, r24
r &= SendControl(0); // high byte
460: 80 e0 ldi r24, 0x00 ; 0
462: 0e 94 e1 01 call 0x3c2 ; 0x3c2 <_ZL11SendControlh>
466: 81 23 and r24, r17
468: 21 96 adiw r28, 0x01 ; 1
if(!r) {
46a: 81 11 cpse r24, r1
46c: ef cf rjmp .-34 ; 0x44c <_ZL24USB_SendStringDescriptorPKhhh+0x2e>
return false;
}
}
return true;
}
46e: df 91 pop r29
470: cf 91 pop r28
472: 1f 91 pop r17
474: 0f 91 pop r16
476: ff 90 pop r15
478: ef 90 pop r14
47a: 08 95 ret
static bool USB_SendStringDescriptor(const u8*string_P, u8 string_len, uint8_t flags) {
SendControl(2 + string_len * 2);
SendControl(3);
bool pgm = flags & TRANSFER_PGM;
for(u8 i = 0; i < string_len; i++) {
bool r = SendControl(pgm ? pgm_read_byte(&string_P[i]) : string_P[i]);
47c: 88 81 ld r24, Y
47e: ed cf rjmp .-38 ; 0x45a <_ZL24USB_SendStringDescriptorPKhhh+0x3c>
r &= SendControl(0); // high byte
if(!r) {
return false;
}
}
return true;
480: 81 e0 ldi r24, 0x01 ; 1
482: f5 cf rjmp .-22 ; 0x46e <_ZL24USB_SendStringDescriptorPKhhh+0x50>
00000484 <_Z15USB_SendControlhPKvi>:
return true;
}
// Clipped by _cmark/_cend
int USB_SendControl(u8 flags, const void* d, int len)
{
484: df 92 push r13
486: ef 92 push r14
488: ff 92 push r15
48a: 0f 93 push r16
48c: 1f 93 push r17
48e: cf 93 push r28
490: df 93 push r29
492: d8 2e mov r13, r24
494: 8a 01 movw r16, r20
496: eb 01 movw r28, r22
498: 7b 01 movw r14, r22
49a: e4 0e add r14, r20
49c: f5 1e adc r15, r21
int sent = len;
const u8* data = (const u8*)d;
bool pgm = flags & TRANSFER_PGM;
while (len--)
49e: ce 15 cp r28, r14
4a0: df 05 cpc r29, r15
4a2: 59 f0 breq .+22 ; 0x4ba <_Z15USB_SendControlhPKvi+0x36>
{
u8 c = pgm ? pgm_read_byte(data++) : *data++;
4a4: d7 fe sbrs r13, 7
4a6: 12 c0 rjmp .+36 ; 0x4cc <_Z15USB_SendControlhPKvi+0x48>
4a8: fe 01 movw r30, r28
4aa: 84 91 lpm r24, Z
if (!SendControl(c))
4ac: 0e 94 e1 01 call 0x3c2 ; 0x3c2 <_ZL11SendControlh>
4b0: 21 96 adiw r28, 0x01 ; 1
4b2: 81 11 cpse r24, r1
4b4: f4 cf rjmp .-24 ; 0x49e <_Z15USB_SendControlhPKvi+0x1a>
return -1;
4b6: 0f ef ldi r16, 0xFF ; 255
4b8: 1f ef ldi r17, 0xFF ; 255
}
return sent;
}
4ba: c8 01 movw r24, r16
4bc: df 91 pop r29
4be: cf 91 pop r28
4c0: 1f 91 pop r17
4c2: 0f 91 pop r16
4c4: ff 90 pop r15
4c6: ef 90 pop r14
4c8: df 90 pop r13
4ca: 08 95 ret
int sent = len;
const u8* data = (const u8*)d;
bool pgm = flags & TRANSFER_PGM;
while (len--)
{
u8 c = pgm ? pgm_read_byte(data++) : *data++;
4cc: 88 81 ld r24, Y
4ce: ee cf rjmp .-36 ; 0x4ac <_Z15USB_SendControlhPKvi+0x28>
000004d0 <_ZL14SendInterfacesv>:
}
return len;
}
static u8 SendInterfaces()
{
4d0: 0f 93 push r16
4d2: 1f 93 push r17
4d4: cf 93 push r28
4d6: df 93 push r29
4d8: 1f 92 push r1
4da: cd b7 in r28, 0x3d ; 61
4dc: de b7 in r29, 0x3e ; 62
return pgm_read_word(FLASHEND - 1) == NEW_LUFA_SIGNATURE;
}
int CDC_GetInterface(u8* interfaceNum)
{
interfaceNum[0] += 2; // uses 2
4de: 82 e0 ldi r24, 0x02 ; 2
4e0: 89 83 std Y+1, r24 ; 0x01
return USB_SendControl(TRANSFER_PGM,&_cdcInterface,sizeof(_cdcInterface));
4e2: 42 e4 ldi r20, 0x42 ; 66
4e4: 50 e0 ldi r21, 0x00 ; 0
4e6: 6c ea ldi r22, 0xAC ; 172
4e8: 70 e0 ldi r23, 0x00 ; 0
4ea: 80 e8 ldi r24, 0x80 ; 128
4ec: 0e 94 42 02 call 0x484 ; 0x484 <_Z15USB_SendControlhPKvi>
#ifdef CDC_ENABLED
CDC_GetInterface(&interfaces);
#endif
#ifdef PLUGGABLE_USB_ENABLED
PluggableUSB().getInterface(&interfaces);
4f0: 0e 94 4c 01 call 0x298 ; 0x298 <_Z12PluggableUSBv>
int PluggableUSB_::getInterface(uint8_t* interfaceCount)
{
int sent = 0;
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
4f4: dc 01 movw r26, r24
4f6: 12 96 adiw r26, 0x02 ; 2
4f8: 0d 91 ld r16, X+
4fa: 1c 91 ld r17, X
4fc: 01 15 cp r16, r1
4fe: 11 05 cpc r17, r1
500: 89 f0 breq .+34 ; 0x524 <_ZL14SendInterfacesv+0x54>
int res = node->getInterface(interfaceCount);
502: d8 01 movw r26, r16
504: ed 91 ld r30, X+
506: fc 91 ld r31, X
508: 02 80 ldd r0, Z+2 ; 0x02
50a: f3 81 ldd r31, Z+3 ; 0x03
50c: e0 2d mov r30, r0
50e: be 01 movw r22, r28
510: 6f 5f subi r22, 0xFF ; 255
512: 7f 4f sbci r23, 0xFF ; 255
514: c8 01 movw r24, r16
516: 09 95 icall
if (res < 0)
518: 97 fd sbrc r25, 7
51a: 04 c0 rjmp .+8 ; 0x524 <_ZL14SendInterfacesv+0x54>
int PluggableUSB_::getInterface(uint8_t* interfaceCount)
{
int sent = 0;
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
51c: f8 01 movw r30, r16
51e: 00 85 ldd r16, Z+8 ; 0x08
520: 11 85 ldd r17, Z+9 ; 0x09
522: ec cf rjmp .-40 ; 0x4fc <_ZL14SendInterfacesv+0x2c>
#endif
return interfaces;
}
524: 89 81 ldd r24, Y+1 ; 0x01
526: 0f 90 pop r0
528: df 91 pop r29
52a: cf 91 pop r28
52c: 1f 91 pop r17
52e: 0f 91 pop r16
530: 08 95 ret
00000532 <_ZL4RecvPVhh>:
UEINTX = ~(1<<RXOUTI);
}
static inline void Recv(volatile u8* data, u8 count)
{
while (count--)
532: 61 50 subi r22, 0x01 ; 1
534: 30 f0 brcs .+12 ; 0x542 <_ZL4RecvPVhh+0x10>
*data++ = UEDATX;
536: 20 91 f1 00 lds r18, 0x00F1 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
53a: fc 01 movw r30, r24
53c: 20 83 st Z, r18
53e: 01 96 adiw r24, 0x01 ; 1
540: f8 cf rjmp .-16 ; 0x532 <_ZL4RecvPVhh>
RXLED1; // light the RX LED
542: 28 98 cbi 0x05, 0 ; 5
RxLEDPulse = TX_RX_LED_PULSE_MS;
544: 84 e6 ldi r24, 0x64 ; 100
546: 80 93 93 01 sts 0x0193, r24 ; 0x800193 <RxLEDPulse>
}
54a: 08 95 ret
0000054c <micros>:
return m;
}
unsigned long micros() {
unsigned long m;
uint8_t oldSREG = SREG, t;
54c: 3f b7 in r19, 0x3f ; 63
cli();
54e: f8 94 cli
m = timer0_overflow_count;
550: 80 91 2b 01 lds r24, 0x012B ; 0x80012b <timer0_overflow_count>
554: 90 91 2c 01 lds r25, 0x012C ; 0x80012c <timer0_overflow_count+0x1>
558: a0 91 2d 01 lds r26, 0x012D ; 0x80012d <timer0_overflow_count+0x2>
55c: b0 91 2e 01 lds r27, 0x012E ; 0x80012e <timer0_overflow_count+0x3>
#if defined(TCNT0)
t = TCNT0;
560: 26 b5 in r18, 0x26 ; 38
#else
#error TIMER 0 not defined
#endif
#ifdef TIFR0
if ((TIFR0 & _BV(TOV0)) && (t < 255))
562: a8 9b sbis 0x15, 0 ; 21
564: 05 c0 rjmp .+10 ; 0x570 <micros+0x24>
566: 2f 3f cpi r18, 0xFF ; 255
568: 19 f0 breq .+6 ; 0x570 <micros+0x24>
m++;
56a: 01 96 adiw r24, 0x01 ; 1
56c: a1 1d adc r26, r1
56e: b1 1d adc r27, r1
#else
if ((TIFR & _BV(TOV0)) && (t < 255))
m++;
#endif
SREG = oldSREG;
570: 3f bf out 0x3f, r19 ; 63
return ((m << 8) + t) * (64 / clockCyclesPerMicrosecond());
572: ba 2f mov r27, r26
574: a9 2f mov r26, r25
576: 98 2f mov r25, r24
578: 88 27 eor r24, r24
57a: bc 01 movw r22, r24
57c: cd 01 movw r24, r26
57e: 62 0f add r22, r18
580: 71 1d adc r23, r1
582: 81 1d adc r24, r1
584: 91 1d adc r25, r1
586: 42 e0 ldi r20, 0x02 ; 2
588: 66 0f add r22, r22
58a: 77 1f adc r23, r23
58c: 88 1f adc r24, r24
58e: 99 1f adc r25, r25
590: 4a 95 dec r20
592: d1 f7 brne .-12 ; 0x588 <micros+0x3c>
}
594: 08 95 ret
00000596 <delay.constprop.10>:
void delay(unsigned long ms)
596: cf 92 push r12
598: df 92 push r13
59a: ef 92 push r14
59c: ff 92 push r15
{
uint32_t start = micros();
59e: 0e 94 a6 02 call 0x54c ; 0x54c <micros>
5a2: 6b 01 movw r12, r22
5a4: 7c 01 movw r14, r24
while (ms > 0) {
yield();
while ( ms > 0 && (micros() - start) >= 1000) {
5a6: 0e 94 a6 02 call 0x54c ; 0x54c <micros>
5aa: 6c 19 sub r22, r12
5ac: 7d 09 sbc r23, r13
5ae: 8e 09 sbc r24, r14
5b0: 9f 09 sbc r25, r15
5b2: 68 3e cpi r22, 0xE8 ; 232
5b4: 73 40 sbci r23, 0x03 ; 3
5b6: 81 05 cpc r24, r1
5b8: 91 05 cpc r25, r1
5ba: a8 f3 brcs .-22 ; 0x5a6 <delay.constprop.10+0x10>
ms--;
start += 1000;
}
}
}
5bc: ff 90 pop r15
5be: ef 90 pop r14
5c0: df 90 pop r13
5c2: cf 90 pop r12
5c4: 08 95 ret
000005c6 <_ZN7Serial_5writeEPKhj>:
{
return write(&c, 1);
}
size_t Serial_::write(const uint8_t *buffer, size_t size)
{
5c6: 8f 92 push r8
5c8: 9f 92 push r9
5ca: af 92 push r10
5cc: bf 92 push r11
5ce: cf 92 push r12
5d0: df 92 push r13
5d2: ef 92 push r14
5d4: ff 92 push r15
5d6: 0f 93 push r16
5d8: 1f 93 push r17
5da: cf 93 push r28
5dc: df 93 push r29
5de: 6c 01 movw r12, r24
5e0: 7b 01 movw r14, r22
5e2: 8a 01 movw r16, r20
the connection is closed are lost - just like with a UART. */
// TODO - ZE - check behavior on different OSes and test what happens if an
// open connection isn't broken cleanly (cable is yanked out, host dies
// or locks up, or host virtual serial port hangs)
if (_usbLineInfo.lineState > 0) {
5e4: 80 91 0b 01 lds r24, 0x010B ; 0x80010b <_ZL12_usbLineInfo+0x7>
5e8: 88 23 and r24, r24
5ea: 09 f4 brne .+2 ; 0x5ee <_ZN7Serial_5writeEPKhj+0x28>
5ec: 58 c0 rjmp .+176 ; 0x69e <_ZN7Serial_5writeEPKhj+0xd8>
}
// Blocking Send of data to an endpoint
int USB_Send(u8 ep, const void* d, int len)
{
if (!_usbConfiguration)
5ee: 80 91 94 01 lds r24, 0x0194 ; 0x800194 <_usbConfiguration>
5f2: 88 23 and r24, r24
5f4: 09 f4 brne .+2 ; 0x5f8 <_ZN7Serial_5writeEPKhj+0x32>
5f6: 53 c0 rjmp .+166 ; 0x69e <_ZN7Serial_5writeEPKhj+0xd8>
return -1;
if (_usbSuspendState & (1<<SUSPI)) {
5f8: 80 91 36 01 lds r24, 0x0136 ; 0x800136 <_usbSuspendState>
5fc: 80 ff sbrs r24, 0
5fe: 05 c0 rjmp .+10 ; 0x60a <_ZN7Serial_5writeEPKhj+0x44>
//send a remote wakeup
UDCON |= (1 << RMWKUP);
600: 80 91 e0 00 lds r24, 0x00E0 ; 0x8000e0 <__DATA_REGION_ORIGIN__+0x80>
604: 82 60 ori r24, 0x02 ; 2
606: 80 93 e0 00 sts 0x00E0, r24 ; 0x8000e0 <__DATA_REGION_ORIGIN__+0x80>
{
return write(&c, 1);
}
size_t Serial_::write(const uint8_t *buffer, size_t size)
{
60a: e8 01 movw r28, r16
60c: b1 2c mov r11, r1
60e: 8a ef ldi r24, 0xFA ; 250
610: a8 2e mov r10, r24
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
612: 93 e0 ldi r25, 0x03 ; 3
614: 89 2e mov r8, r25
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
}
static inline void ReleaseTX()
{
UEINTX = 0x3A; // FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
616: 2a e3 ldi r18, 0x3A ; 58
618: 92 2e mov r9, r18
int r = len;
const u8* data = (const u8*)d;
u8 timeout = 250; // 250ms timeout on send? TODO
bool sendZlp = false;
while (len || sendZlp)
61a: 20 97 sbiw r28, 0x00 ; 0
61c: 11 f4 brne .+4 ; 0x622 <_ZN7Serial_5writeEPKhj+0x5c>
61e: bb 20 and r11, r11
620: b9 f1 breq .+110 ; 0x690 <_ZN7Serial_5writeEPKhj+0xca>
{
u8 n = USB_SendSpace(ep);
622: 0e 94 3b 01 call 0x276 ; 0x276 <_Z13USB_SendSpaceh.constprop.3>
if (n == 0)
626: 81 11 cpse r24, r1
628: 06 c0 rjmp .+12 ; 0x636 <_ZN7Serial_5writeEPKhj+0x70>
{
if (!(--timeout))
62a: aa 94 dec r10
62c: aa 20 and r10, r10
62e: b9 f1 breq .+110 ; 0x69e <_ZN7Serial_5writeEPKhj+0xd8>
return -1;
delay(1);
630: 0e 94 cb 02 call 0x596 ; 0x596 <delay.constprop.10>
634: f2 cf rjmp .-28 ; 0x61a <_ZN7Serial_5writeEPKhj+0x54>
continue;
}
if (n > len) {
636: 8c 17 cp r24, r28
638: 1d 06 cpc r1, r29
63a: 11 f0 breq .+4 ; 0x640 <_ZN7Serial_5writeEPKhj+0x7a>
63c: 0c f0 brlt .+2 ; 0x640 <_ZN7Serial_5writeEPKhj+0x7a>
n = len;
63e: 8c 2f mov r24, r28
#define USB_RECV_TIMEOUT
class LockEP
{
u8 _sreg;
public:
LockEP(u8 ep) : _sreg(SREG)
640: 9f b7 in r25, 0x3f ; 63
{
cli();
642: f8 94 cli
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
644: 80 92 e9 00 sts 0x00E9, r8 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
UECONX = (1<<STALLRQ) | (1<<EPEN);
}
static inline u8 ReadWriteAllowed()
{
return UEINTX & (1<<RWAL);
648: 20 91 e8 00 lds r18, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
}
{
LockEP lock(ep);
// Frame may have been released by the SOF interrupt handler
if (!ReadWriteAllowed())
64c: 25 fd sbrc r18, 5
64e: 02 c0 rjmp .+4 ; 0x654 <_ZN7Serial_5writeEPKhj+0x8e>
cli();
SetEP(ep & 7);
}
~LockEP()
{
SREG = _sreg;
650: 9f bf out 0x3f, r25 ; 63
652: e3 cf rjmp .-58 ; 0x61a <_ZN7Serial_5writeEPKhj+0x54>
LockEP lock(ep);
// Frame may have been released by the SOF interrupt handler
if (!ReadWriteAllowed())
continue;
len -= n;
654: 28 2f mov r18, r24
656: 30 e0 ldi r19, 0x00 ; 0
658: c2 1b sub r28, r18
65a: d3 0b sbc r29, r19
65c: f7 01 movw r30, r14
while (n--)
Send8(pgm_read_byte(data++));
}
else
{
while (n--)
65e: 81 50 subi r24, 0x01 ; 1
660: 20 f0 brcs .+8 ; 0x66a <_ZN7Serial_5writeEPKhj+0xa4>
Send8(*data++);
662: 41 91 ld r20, Z+
return UEDATX;
}
static inline void Send8(u8 d)
{
UEDATX = d;
664: 40 93 f1 00 sts 0x00F1, r20 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
668: fa cf rjmp .-12 ; 0x65e <_ZN7Serial_5writeEPKhj+0x98>
66a: e2 0e add r14, r18
66c: f3 1e adc r15, r19
{
while (n--)
Send8(*data++);
}
if (sendZlp) {
66e: bb 20 and r11, r11
670: 21 f0 breq .+8 ; 0x67a <_ZN7Serial_5writeEPKhj+0xb4>
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
}
static inline void ReleaseTX()
{
UEINTX = 0x3A; // FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
672: 90 92 e8 00 sts 0x00E8, r9 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
if (sendZlp) {
ReleaseTX();
sendZlp = false;
} else if (!ReadWriteAllowed()) { // ...release if buffer is full...
ReleaseTX();
if (len == 0) sendZlp = true;
676: b1 2c mov r11, r1
678: eb cf rjmp .-42 ; 0x650 <_ZN7Serial_5writeEPKhj+0x8a>
UECONX = (1<<STALLRQ) | (1<<EPEN);
}
static inline u8 ReadWriteAllowed()
{
return UEINTX & (1<<RWAL);
67a: 80 91 e8 00 lds r24, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
}
if (sendZlp) {
ReleaseTX();
sendZlp = false;
} else if (!ReadWriteAllowed()) { // ...release if buffer is full...
67e: 85 fd sbrc r24, 5
680: e7 cf rjmp .-50 ; 0x650 <_ZN7Serial_5writeEPKhj+0x8a>
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
}
static inline void ReleaseTX()
{
UEINTX = 0x3A; // FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
682: 90 92 e8 00 sts 0x00E8, r9 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
if (sendZlp) {
ReleaseTX();
sendZlp = false;
} else if (!ReadWriteAllowed()) { // ...release if buffer is full...
ReleaseTX();
if (len == 0) sendZlp = true;
686: bb 24 eor r11, r11
688: b3 94 inc r11
68a: 20 97 sbiw r28, 0x00 ; 0
68c: 09 f3 breq .-62 ; 0x650 <_ZN7Serial_5writeEPKhj+0x8a>
68e: f3 cf rjmp .-26 ; 0x676 <_ZN7Serial_5writeEPKhj+0xb0>
// XXX: TRANSFER_RELEASE is never used can be removed?
ReleaseTX();
}
}
}
TXLED1; // light the TX LED
690: 5d 98 cbi 0x0b, 5 ; 11
TxLEDPulse = TX_RX_LED_PULSE_MS;
692: 84 e6 ldi r24, 0x64 ; 100
694: 80 93 35 01 sts 0x0135, r24 ; 0x800135 <TxLEDPulse>
// TODO - ZE - check behavior on different OSes and test what happens if an
// open connection isn't broken cleanly (cable is yanked out, host dies
// or locks up, or host virtual serial port hangs)
if (_usbLineInfo.lineState > 0) {
int r = USB_Send(CDC_TX,buffer,size);
if (r > 0) {
698: 10 16 cp r1, r16
69a: 11 06 cpc r1, r17
69c: 3c f0 brlt .+14 ; 0x6ac <_ZN7Serial_5writeEPKhj+0xe6>
private:
int write_error;
size_t printNumber(unsigned long, uint8_t);
size_t printFloat(double, uint8_t);
protected:
void setWriteError(int err = 1) { write_error = err; }
69e: 81 e0 ldi r24, 0x01 ; 1
6a0: 90 e0 ldi r25, 0x00 ; 0
6a2: f6 01 movw r30, r12
6a4: 93 83 std Z+3, r25 ; 0x03
6a6: 82 83 std Z+2, r24 ; 0x02
return r;
} else {
setWriteError();
return 0;
6a8: 10 e0 ldi r17, 0x00 ; 0
6aa: 00 e0 ldi r16, 0x00 ; 0
}
}
setWriteError();
return 0;
}
6ac: c8 01 movw r24, r16
6ae: df 91 pop r29
6b0: cf 91 pop r28
6b2: 1f 91 pop r17
6b4: 0f 91 pop r16
6b6: ff 90 pop r15
6b8: ef 90 pop r14
6ba: df 90 pop r13
6bc: cf 90 pop r12
6be: bf 90 pop r11
6c0: af 90 pop r10
6c2: 9f 90 pop r9
6c4: 8f 90 pop r8
6c6: 08 95 ret
000006c8 <__vector_10>:
#endif
}
// General interrupt
ISR(USB_GEN_vect)
{
6c8: 1f 92 push r1
6ca: 0f 92 push r0
6cc: 0f b6 in r0, 0x3f ; 63
6ce: 0f 92 push r0
6d0: 11 24 eor r1, r1
6d2: 8f 93 push r24
6d4: 9f 93 push r25
u8 udint = UDINT;
6d6: 80 91 e1 00 lds r24, 0x00E1 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
UDINT &= ~((1<<EORSTI) | (1<<SOFI)); // clear the IRQ flags for the IRQs which are handled here, except WAKEUPI and SUSPI (see below)
6da: 90 91 e1 00 lds r25, 0x00E1 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
6de: 93 7f andi r25, 0xF3 ; 243
6e0: 90 93 e1 00 sts 0x00E1, r25 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
// End of Reset
if (udint & (1<<EORSTI))
6e4: 83 ff sbrs r24, 3
6e6: 0f c0 rjmp .+30 ; 0x706 <__vector_10+0x3e>
#define EP_SINGLE_16 0x12
static
void InitEP(u8 index, u8 type, u8 size)
{
UENUM = index;
6e8: 10 92 e9 00 sts 0x00E9, r1 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
UECONX = (1<<EPEN);
6ec: 91 e0 ldi r25, 0x01 ; 1
6ee: 90 93 eb 00 sts 0x00EB, r25 ; 0x8000eb <__DATA_REGION_ORIGIN__+0x8b>
UECFG0X = type;
6f2: 10 92 ec 00 sts 0x00EC, r1 ; 0x8000ec <__DATA_REGION_ORIGIN__+0x8c>
UECFG1X = size;
6f6: 92 e3 ldi r25, 0x32 ; 50
6f8: 90 93 ed 00 sts 0x00ED, r25 ; 0x8000ed <__DATA_REGION_ORIGIN__+0x8d>
// End of Reset
if (udint & (1<<EORSTI))
{
InitEP(0,EP_TYPE_CONTROL,EP_SINGLE_64); // init ep0
_usbConfiguration = 0; // not configured yet
6fc: 10 92 94 01 sts 0x0194, r1 ; 0x800194 <_usbConfiguration>
UEIENX = 1 << RXSTPE; // Enable interrupts for ep0
700: 98 e0 ldi r25, 0x08 ; 8
702: 90 93 f0 00 sts 0x00F0, r25 ; 0x8000f0 <__DATA_REGION_ORIGIN__+0x90>
}
// Start of Frame - happens every millisecond so we use it for TX and RX LED one-shot timing, too
if (udint & (1<<SOFI))
706: 82 ff sbrs r24, 2
708: 22 c0 rjmp .+68 ; 0x74e <__vector_10+0x86>
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
70a: 93 e0 ldi r25, 0x03 ; 3
70c: 90 93 e9 00 sts 0x00E9, r25 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
}
static inline u8 FifoByteCount()
{
return UEBCLX;
710: 90 91 f2 00 lds r25, 0x00F2 ; 0x8000f2 <__DATA_REGION_ORIGIN__+0x92>
}
void USB_Flush(u8 ep)
{
SetEP(ep);
if (FifoByteCount())
714: 99 23 and r25, r25
716: 19 f0 breq .+6 ; 0x71e <__vector_10+0x56>
UEINTX = 0x6B; // FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1
}
static inline void ReleaseTX()
{
UEINTX = 0x3A; // FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0
718: 9a e3 ldi r25, 0x3A ; 58
71a: 90 93 e8 00 sts 0x00E8, r25 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
if (udint & (1<<SOFI))
{
USB_Flush(CDC_TX); // Send a tx frame if found
// check whether the one-shot period has elapsed. if so, turn off the LED
if (TxLEDPulse && !(--TxLEDPulse))
71e: 90 91 35 01 lds r25, 0x0135 ; 0x800135 <TxLEDPulse>
722: 99 23 and r25, r25
724: 41 f0 breq .+16 ; 0x736 <__vector_10+0x6e>
726: 90 91 35 01 lds r25, 0x0135 ; 0x800135 <TxLEDPulse>
72a: 91 50 subi r25, 0x01 ; 1
72c: 90 93 35 01 sts 0x0135, r25 ; 0x800135 <TxLEDPulse>
730: 91 11 cpse r25, r1
732: 01 c0 rjmp .+2 ; 0x736 <__vector_10+0x6e>
TXLED0;
734: 5d 9a sbi 0x0b, 5 ; 11
if (RxLEDPulse && !(--RxLEDPulse))
736: 90 91 93 01 lds r25, 0x0193 ; 0x800193 <RxLEDPulse>
73a: 99 23 and r25, r25
73c: 41 f0 breq .+16 ; 0x74e <__vector_10+0x86>
73e: 90 91 93 01 lds r25, 0x0193 ; 0x800193 <RxLEDPulse>
742: 91 50 subi r25, 0x01 ; 1
744: 90 93 93 01 sts 0x0193, r25 ; 0x800193 <RxLEDPulse>
748: 91 11 cpse r25, r1
74a: 01 c0 rjmp .+2 ; 0x74e <__vector_10+0x86>
RXLED0;
74c: 28 9a sbi 0x05, 0 ; 5
}
// the WAKEUPI interrupt is triggered as soon as there are non-idle patterns on the data
// lines. Thus, the WAKEUPI interrupt can occur even if the controller is not in the "suspend" mode.
// Therefore the we enable it only when USB is suspended
if (udint & (1<<WAKEUPI))
74e: 84 ff sbrs r24, 4
750: 18 c0 rjmp .+48 ; 0x782 <__vector_10+0xba>
{
UDIEN = (UDIEN & ~(1<<WAKEUPE)) | (1<<SUSPE); // Disable interrupts for WAKEUP and enable interrupts for SUSPEND
752: 80 91 e2 00 lds r24, 0x00E2 ; 0x8000e2 <__DATA_REGION_ORIGIN__+0x82>
756: 8e 7e andi r24, 0xEE ; 238
758: 81 60 ori r24, 0x01 ; 1
75a: 80 93 e2 00 sts 0x00E2, r24 ; 0x8000e2 <__DATA_REGION_ORIGIN__+0x82>
//TODO
// WAKEUPI shall be cleared by software (USB clock inputs must be enabled before).
//USB_ClockEnable();
UDINT &= ~(1<<WAKEUPI);
75e: 80 91 e1 00 lds r24, 0x00E1 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
762: 8f 7e andi r24, 0xEF ; 239
764: 80 93 e1 00 sts 0x00E1, r24 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
_usbSuspendState = (_usbSuspendState & ~(1<<SUSPI)) | (1<<WAKEUPI);
768: 80 91 36 01 lds r24, 0x0136 ; 0x800136 <_usbSuspendState>
76c: 8e 7e andi r24, 0xEE ; 238
76e: 80 61 ori r24, 0x10 ; 16
//TODO
//USB_ClockDisable();
UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear any already pending WAKEUP IRQs and the SUSPI request
_usbSuspendState = (_usbSuspendState & ~(1<<WAKEUPI)) | (1<<SUSPI);
770: 80 93 36 01 sts 0x0136, r24 ; 0x800136 <_usbSuspendState>
}
}
774: 9f 91 pop r25
776: 8f 91 pop r24
778: 0f 90 pop r0
77a: 0f be out 0x3f, r0 ; 63
77c: 0f 90 pop r0
77e: 1f 90 pop r1
780: 18 95 reti
// WAKEUPI shall be cleared by software (USB clock inputs must be enabled before).
//USB_ClockEnable();
UDINT &= ~(1<<WAKEUPI);
_usbSuspendState = (_usbSuspendState & ~(1<<SUSPI)) | (1<<WAKEUPI);
}
else if (udint & (1<<SUSPI)) // only one of the WAKEUPI / SUSPI bits can be active at time
782: 80 ff sbrs r24, 0
784: f7 cf rjmp .-18 ; 0x774 <__vector_10+0xac>
{
UDIEN = (UDIEN & ~(1<<SUSPE)) | (1<<WAKEUPE); // Disable interrupts for SUSPEND and enable interrupts for WAKEUP
786: 80 91 e2 00 lds r24, 0x00E2 ; 0x8000e2 <__DATA_REGION_ORIGIN__+0x82>
78a: 8e 7e andi r24, 0xEE ; 238
78c: 80 61 ori r24, 0x10 ; 16
78e: 80 93 e2 00 sts 0x00E2, r24 ; 0x8000e2 <__DATA_REGION_ORIGIN__+0x82>
//TODO
//USB_ClockDisable();
UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear any already pending WAKEUP IRQs and the SUSPI request
792: 80 91 e1 00 lds r24, 0x00E1 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
796: 8e 7e andi r24, 0xEE ; 238
798: 80 93 e1 00 sts 0x00E1, r24 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
_usbSuspendState = (_usbSuspendState & ~(1<<WAKEUPI)) | (1<<SUSPI);
79c: 80 91 36 01 lds r24, 0x0136 ; 0x800136 <_usbSuspendState>
7a0: 8e 7e andi r24, 0xEE ; 238
7a2: 81 60 ori r24, 0x01 ; 1
7a4: e5 cf rjmp .-54 ; 0x770 <__vector_10+0xa8>
000007a6 <__vector_11>:
return true;
}
// Endpoint 0 interrupt
ISR(USB_COM_vect)
{
7a6: 1f 92 push r1
7a8: 0f 92 push r0
7aa: 0f b6 in r0, 0x3f ; 63
7ac: 0f 92 push r0
7ae: 11 24 eor r1, r1
7b0: cf 92 push r12
7b2: df 92 push r13
7b4: ef 92 push r14
7b6: ff 92 push r15
7b8: 0f 93 push r16
7ba: 1f 93 push r17
7bc: 2f 93 push r18
7be: 3f 93 push r19
7c0: 4f 93 push r20
7c2: 5f 93 push r21
7c4: 6f 93 push r22
7c6: 7f 93 push r23
7c8: 8f 93 push r24
7ca: 9f 93 push r25
7cc: af 93 push r26
7ce: bf 93 push r27
7d0: ef 93 push r30
7d2: ff 93 push r31
7d4: cf 93 push r28
7d6: df 93 push r29
7d8: cd b7 in r28, 0x3d ; 61
7da: de b7 in r29, 0x3e ; 62
7dc: 6c 97 sbiw r28, 0x1c ; 28
7de: de bf out 0x3e, r29 ; 62
7e0: cd bf out 0x3d, r28 ; 61
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
7e2: 10 92 e9 00 sts 0x00E9, r1 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
return UEBCLX;
}
static inline u8 ReceivedSetupInt()
{
return UEINTX & (1<<RXSTPI);
7e6: 80 91 e8 00 lds r24, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
// Endpoint 0 interrupt
ISR(USB_COM_vect)
{
SetEP(0);
if (!ReceivedSetupInt())
7ea: 83 ff sbrs r24, 3
7ec: 25 c0 rjmp .+74 ; 0x838 <__vector_11+0x92>
return;
USBSetup setup;
Recv((u8*)&setup,8);
7ee: 68 e0 ldi r22, 0x08 ; 8
7f0: ce 01 movw r24, r28
7f2: 45 96 adiw r24, 0x15 ; 21
7f4: 0e 94 99 02 call 0x532 ; 0x532 <_ZL4RecvPVhh>
return UEINTX & (1<<RXSTPI);
}
static inline void ClearSetupInt()
{
UEINTX = ~((1<<RXSTPI) | (1<<RXOUTI) | (1<<TXINI));
7f8: 82 ef ldi r24, 0xF2 ; 242
7fa: 80 93 e8 00 sts 0x00E8, r24 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
USBSetup setup;
Recv((u8*)&setup,8);
ClearSetupInt();
u8 requestType = setup.bmRequestType;
7fe: 8d 89 ldd r24, Y+21 ; 0x15
if (requestType & REQUEST_DEVICETOHOST)
800: 87 ff sbrs r24, 7
802: 39 c0 rjmp .+114 ; 0x876 <__vector_11+0xd0>
volatile u8 _usbCurrentStatus = 0; // meaning of bits see usb_20.pdf, Figure 9-4. Information Returned by a GetStatus() Request to a Device
volatile u8 _usbSuspendState = 0; // copy of UDINT to check SUSPI and WAKEUPI bits
static inline void WaitIN(void)
{
while (!(UEINTX & (1<<TXINI)))
804: 90 91 e8 00 lds r25, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
808: 90 ff sbrs r25, 0
80a: fc cf rjmp .-8 ; 0x804 <__vector_11+0x5e>
WaitIN();
else
ClearIN();
bool ok = true;
if (REQUEST_STANDARD == (requestType & REQUEST_TYPE))
80c: 98 2f mov r25, r24
80e: 90 76 andi r25, 0x60 ; 96
810: 09 f0 breq .+2 ; 0x814 <__vector_11+0x6e>
812: 34 c1 rjmp .+616 ; 0xa7c <__vector_11+0x2d6>
{
// Standard Requests
u8 r = setup.bRequest;
814: 9e 89 ldd r25, Y+22 ; 0x16
816: 4f 89 ldd r20, Y+23 ; 0x17
818: 58 8d ldd r21, Y+24 ; 0x18
u16 wValue = setup.wValueL | (setup.wValueH << 8);
81a: 2f 89 ldd r18, Y+23 ; 0x17
81c: f8 8c ldd r15, Y+24 ; 0x18
if (GET_STATUS == r)
81e: 91 11 cpse r25, r1
820: 31 c0 rjmp .+98 ; 0x884 <__vector_11+0xde>
{
if (requestType == (REQUEST_DEVICETOHOST | REQUEST_STANDARD | REQUEST_DEVICE))
822: 80 38 cpi r24, 0x80 ; 128
824: 61 f5 brne .+88 ; 0x87e <__vector_11+0xd8>
{
Send8(_usbCurrentStatus);
826: 80 91 34 01 lds r24, 0x0134 ; 0x800134 <_usbCurrentStatus>
return UEDATX;
}
static inline void Send8(u8 d)
{
UEDATX = d;
82a: 80 93 f1 00 sts 0x00F1, r24 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
82e: 10 92 f1 00 sts 0x00F1, r1 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
;
}
static inline void ClearIN(void)
{
UEINTX = ~(1<<TXINI);
832: 8e ef ldi r24, 0xFE ; 254
834: 80 93 e8 00 sts 0x00E8, r24 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
ClearIN();
else
{
Stall();
}
}
838: 6c 96 adiw r28, 0x1c ; 28
83a: 0f b6 in r0, 0x3f ; 63
83c: f8 94 cli
83e: de bf out 0x3e, r29 ; 62
840: 0f be out 0x3f, r0 ; 63
842: cd bf out 0x3d, r28 ; 61
844: df 91 pop r29
846: cf 91 pop r28
848: ff 91 pop r31
84a: ef 91 pop r30
84c: bf 91 pop r27
84e: af 91 pop r26
850: 9f 91 pop r25
852: 8f 91 pop r24
854: 7f 91 pop r23
856: 6f 91 pop r22
858: 5f 91 pop r21
85a: 4f 91 pop r20
85c: 3f 91 pop r19
85e: 2f 91 pop r18
860: 1f 91 pop r17
862: 0f 91 pop r16
864: ff 90 pop r15
866: ef 90 pop r14
868: df 90 pop r13
86a: cf 90 pop r12
86c: 0f 90 pop r0
86e: 0f be out 0x3f, r0 ; 63
870: 0f 90 pop r0
872: 1f 90 pop r1
874: 18 95 reti
;
}
static inline void ClearIN(void)
{
UEINTX = ~(1<<TXINI);
876: 9e ef ldi r25, 0xFE ; 254
878: 90 93 e8 00 sts 0x00E8, r25 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
87c: c7 cf rjmp .-114 ; 0x80c <__vector_11+0x66>
return UEDATX;
}
static inline void Send8(u8 d)
{
UEDATX = d;
87e: 10 92 f1 00 sts 0x00F1, r1 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
882: d5 cf rjmp .-86 ; 0x82e <__vector_11+0x88>
// see "Figure 9-6. Information Returned by a GetStatus() Request to an Endpoint" in usb_20.pdf for more information
Send8(0);
Send8(0);
}
}
else if (CLEAR_FEATURE == r)
884: 91 30 cpi r25, 0x01 ; 1
886: 59 f4 brne .+22 ; 0x89e <__vector_11+0xf8>
{
if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE))
888: 81 11 cpse r24, r1
88a: d3 cf rjmp .-90 ; 0x832 <__vector_11+0x8c>
&& (wValue == DEVICE_REMOTE_WAKEUP))
88c: 41 30 cpi r20, 0x01 ; 1
88e: 51 05 cpc r21, r1
890: 81 f6 brne .-96 ; 0x832 <__vector_11+0x8c>
{
_usbCurrentStatus &= ~FEATURE_REMOTE_WAKEUP_ENABLED;
892: 80 91 34 01 lds r24, 0x0134 ; 0x800134 <_usbCurrentStatus>
896: 8d 7f andi r24, 0xFD ; 253
else if (SET_FEATURE == r)
{
if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE))
&& (wValue == DEVICE_REMOTE_WAKEUP))
{
_usbCurrentStatus |= FEATURE_REMOTE_WAKEUP_ENABLED;
898: 80 93 34 01 sts 0x0134, r24 ; 0x800134 <_usbCurrentStatus>
89c: ca cf rjmp .-108 ; 0x832 <__vector_11+0x8c>
&& (wValue == DEVICE_REMOTE_WAKEUP))
{
_usbCurrentStatus &= ~FEATURE_REMOTE_WAKEUP_ENABLED;
}
}
else if (SET_FEATURE == r)
89e: 93 30 cpi r25, 0x03 ; 3
8a0: 49 f4 brne .+18 ; 0x8b4 <__vector_11+0x10e>
{
if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE))
8a2: 81 11 cpse r24, r1
8a4: c6 cf rjmp .-116 ; 0x832 <__vector_11+0x8c>
&& (wValue == DEVICE_REMOTE_WAKEUP))
8a6: 41 30 cpi r20, 0x01 ; 1
8a8: 51 05 cpc r21, r1
8aa: 19 f6 brne .-122 ; 0x832 <__vector_11+0x8c>
{
_usbCurrentStatus |= FEATURE_REMOTE_WAKEUP_ENABLED;
8ac: 80 91 34 01 lds r24, 0x0134 ; 0x800134 <_usbCurrentStatus>
8b0: 82 60 ori r24, 0x02 ; 2
8b2: f2 cf rjmp .-28 ; 0x898 <__vector_11+0xf2>
}
}
else if (SET_ADDRESS == r)
8b4: 95 30 cpi r25, 0x05 ; 5
8b6: 41 f4 brne .+16 ; 0x8c8 <__vector_11+0x122>
volatile u8 _usbCurrentStatus = 0; // meaning of bits see usb_20.pdf, Figure 9-4. Information Returned by a GetStatus() Request to a Device
volatile u8 _usbSuspendState = 0; // copy of UDINT to check SUSPI and WAKEUPI bits
static inline void WaitIN(void)
{
while (!(UEINTX & (1<<TXINI)))
8b8: 80 91 e8 00 lds r24, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
8bc: 80 ff sbrs r24, 0
8be: fc cf rjmp .-8 ; 0x8b8 <__vector_11+0x112>
}
}
else if (SET_ADDRESS == r)
{
WaitIN();
UDADDR = setup.wValueL | (1<<ADDEN);
8c0: 20 68 ori r18, 0x80 ; 128
8c2: 20 93 e3 00 sts 0x00E3, r18 ; 0x8000e3 <__DATA_REGION_ORIGIN__+0x83>
8c6: b5 cf rjmp .-150 ; 0x832 <__vector_11+0x8c>
}
else if (GET_DESCRIPTOR == r)
8c8: 96 30 cpi r25, 0x06 ; 6
8ca: 09 f0 breq .+2 ; 0x8ce <__vector_11+0x128>
8cc: a9 c0 rjmp .+338 ; 0xa20 <__vector_11+0x27a>
8ce: 0b 8d ldd r16, Y+27 ; 0x1b
8d0: 1c 8d ldd r17, Y+28 ; 0x1c
static
bool SendDescriptor(USBSetup& setup)
{
u8 t = setup.wValueH;
if (USB_CONFIGURATION_DESCRIPTOR_TYPE == t)
8d2: 22 e0 ldi r18, 0x02 ; 2
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
8d4: 10 92 e9 00 sts 0x00E9, r1 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
static int _cmark;
static int _cend;
void InitControl(int end)
{
SetEP(0);
_cmark = 0;
8d8: 10 92 32 01 sts 0x0132, r1 ; 0x800132 <_ZL6_cmark+0x1>
8dc: 10 92 31 01 sts 0x0131, r1 ; 0x800131 <_ZL6_cmark>
static
bool SendDescriptor(USBSetup& setup)
{
u8 t = setup.wValueH;
if (USB_CONFIGURATION_DESCRIPTOR_TYPE == t)
8e0: f2 12 cpse r15, r18
8e2: 2e c0 rjmp .+92 ; 0x940 <__vector_11+0x19a>
static int _cend;
void InitControl(int end)
{
SetEP(0);
_cmark = 0;
_cend = end;
8e4: 10 92 30 01 sts 0x0130, r1 ; 0x800130 <_ZL5_cend+0x1>
8e8: 10 92 2f 01 sts 0x012F, r1 ; 0x80012f <_ZL5_cend>
static
bool SendConfiguration(int maxlen)
{
// Count and measure interfaces
InitControl(0);
u8 interfaces = SendInterfaces();
8ec: 0e 94 68 02 call 0x4d0 ; 0x4d0 <_ZL14SendInterfacesv>
ConfigDescriptor config = D_CONFIG(_cmark + sizeof(ConfigDescriptor),interfaces);
8f0: 1f 82 std Y+7, r1 ; 0x07
8f2: 99 e0 ldi r25, 0x09 ; 9
8f4: 99 83 std Y+1, r25 ; 0x01
8f6: fa 82 std Y+2, r15 ; 0x02
8f8: 91 e0 ldi r25, 0x01 ; 1
8fa: 9e 83 std Y+6, r25 ; 0x06
8fc: 90 ea ldi r25, 0xA0 ; 160
8fe: 98 87 std Y+8, r25 ; 0x08
900: 9a ef ldi r25, 0xFA ; 250
902: 99 87 std Y+9, r25 ; 0x09
904: 20 91 31 01 lds r18, 0x0131 ; 0x800131 <_ZL6_cmark>
908: 30 91 32 01 lds r19, 0x0132 ; 0x800132 <_ZL6_cmark+0x1>
90c: 27 5f subi r18, 0xF7 ; 247
90e: 3f 4f sbci r19, 0xFF ; 255
910: 3c 83 std Y+4, r19 ; 0x04
912: 2b 83 std Y+3, r18 ; 0x03
914: 8d 83 std Y+5, r24 ; 0x05
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
916: 10 92 e9 00 sts 0x00E9, r1 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
static int _cmark;
static int _cend;
void InitControl(int end)
{
SetEP(0);
_cmark = 0;
91a: 10 92 32 01 sts 0x0132, r1 ; 0x800132 <_ZL6_cmark+0x1>
91e: 10 92 31 01 sts 0x0131, r1 ; 0x800131 <_ZL6_cmark>
_cend = end;
922: 10 93 30 01 sts 0x0130, r17 ; 0x800130 <_ZL5_cend+0x1>
926: 00 93 2f 01 sts 0x012F, r16 ; 0x80012f <_ZL5_cend>
u8 interfaces = SendInterfaces();
ConfigDescriptor config = D_CONFIG(_cmark + sizeof(ConfigDescriptor),interfaces);
// Now send them
InitControl(maxlen);
USB_SendControl(0,&config,sizeof(ConfigDescriptor));
92a: 49 e0 ldi r20, 0x09 ; 9
92c: 50 e0 ldi r21, 0x00 ; 0
92e: be 01 movw r22, r28
930: 6f 5f subi r22, 0xFF ; 255
932: 7f 4f sbci r23, 0xFF ; 255
934: 80 e0 ldi r24, 0x00 ; 0
936: 0e 94 42 02 call 0x484 ; 0x484 <_Z15USB_SendControlhPKvi>
SendInterfaces();
93a: 0e 94 68 02 call 0x4d0 ; 0x4d0 <_ZL14SendInterfacesv>
93e: 79 cf rjmp .-270 ; 0x832 <__vector_11+0x8c>
static int _cend;
void InitControl(int end)
{
SetEP(0);
_cmark = 0;
_cend = end;
940: 10 93 30 01 sts 0x0130, r17 ; 0x800130 <_ZL5_cend+0x1>
944: 00 93 2f 01 sts 0x012F, r16 ; 0x80012f <_ZL5_cend>
if (USB_CONFIGURATION_DESCRIPTOR_TYPE == t)
return SendConfiguration(setup.wLength);
InitControl(setup.wLength);
#ifdef PLUGGABLE_USB_ENABLED
int ret = PluggableUSB().getDescriptor(setup);
948: 0e 94 4c 01 call 0x298 ; 0x298 <_Z12PluggableUSBv>
}
int PluggableUSB_::getDescriptor(USBSetup& setup)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
94c: dc 01 movw r26, r24
94e: 12 96 adiw r26, 0x02 ; 2
950: 0d 91 ld r16, X+
952: 1c 91 ld r17, X
954: 01 15 cp r16, r1
956: 11 05 cpc r17, r1
958: 09 f4 brne .+2 ; 0x95c <__vector_11+0x1b6>
95a: 51 c1 rjmp .+674 ; 0xbfe <__stack+0xff>
int ret = node->getDescriptor(setup);
95c: d8 01 movw r26, r16
95e: ed 91 ld r30, X+
960: fc 91 ld r31, X
962: 04 80 ldd r0, Z+4 ; 0x04
964: f5 81 ldd r31, Z+5 ; 0x05
966: e0 2d mov r30, r0
968: be 01 movw r22, r28
96a: 6b 5e subi r22, 0xEB ; 235
96c: 7f 4f sbci r23, 0xFF ; 255
96e: c8 01 movw r24, r16
970: 09 95 icall
// ret!=0 -> request has been processed
if (ret)
972: 00 97 sbiw r24, 0x00 ; 0
974: 09 f0 breq .+2 ; 0x978 <__vector_11+0x1d2>
976: 3e c1 rjmp .+636 ; 0xbf4 <__stack+0xf5>
}
int PluggableUSB_::getDescriptor(USBSetup& setup)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
978: f8 01 movw r30, r16
97a: 00 85 ldd r16, Z+8 ; 0x08
97c: 11 85 ldd r17, Z+9 ; 0x09
97e: ea cf rjmp .-44 ; 0x954 <__vector_11+0x1ae>
const u8* desc_addr = 0;
if (USB_DEVICE_DESCRIPTOR_TYPE == t)
{
desc_addr = (const u8*)&USB_DeviceDescriptorIAD;
}
else if (USB_STRING_DESCRIPTOR_TYPE == t)
980: f3 e0 ldi r31, 0x03 ; 3
982: ff 12 cpse r15, r31
984: 0e c0 rjmp .+28 ; 0x9a2 <__vector_11+0x1fc>
{
if (setup.wValueL == 0) {
986: 8f 89 ldd r24, Y+23 ; 0x17
988: 88 23 and r24, r24
98a: 09 f4 brne .+2 ; 0x98e <__vector_11+0x1e8>
98c: 40 c0 rjmp .+128 ; 0xa0e <__vector_11+0x268>
desc_addr = (const u8*)&STRING_LANGUAGE;
}
else if (setup.wValueL == IPRODUCT) {
98e: 82 30 cpi r24, 0x02 ; 2
990: 61 f4 brne .+24 ; 0x9aa <__vector_11+0x204>
return USB_SendStringDescriptor(STRING_PRODUCT, strlen(USB_PRODUCT), TRANSFER_PGM);
992: 40 e8 ldi r20, 0x80 ; 128
994: 60 e1 ldi r22, 0x10 ; 16
996: 80 e1 ldi r24, 0x10 ; 16
998: 91 e0 ldi r25, 0x01 ; 1
}
else if (setup.wValueL == ISERIAL) {
#ifdef PLUGGABLE_USB_ENABLED
char name[ISERIAL_MAX_LEN];
PluggableUSB().getShortName(name);
return USB_SendStringDescriptor((uint8_t*)name, strlen(name), 0);
99a: 0e 94 0f 02 call 0x41e ; 0x41e <_ZL24USB_SendStringDescriptorPKhhh>
{
InitControl(setup.wLength); // Max length of transfer
ok = ClassInterfaceRequest(setup);
}
if (ok)
99e: 81 11 cpse r24, r1
9a0: 48 cf rjmp .-368 ; 0x832 <__vector_11+0x8c>
UEINTX = ~((1<<RXSTPI) | (1<<RXOUTI) | (1<<TXINI));
}
static inline void Stall()
{
UECONX = (1<<STALLRQ) | (1<<EPEN);
9a2: 81 e2 ldi r24, 0x21 ; 33
9a4: 80 93 eb 00 sts 0x00EB, r24 ; 0x8000eb <__DATA_REGION_ORIGIN__+0x8b>
9a8: 47 cf rjmp .-370 ; 0x838 <__vector_11+0x92>
desc_addr = (const u8*)&STRING_LANGUAGE;
}
else if (setup.wValueL == IPRODUCT) {
return USB_SendStringDescriptor(STRING_PRODUCT, strlen(USB_PRODUCT), TRANSFER_PGM);
}
else if (setup.wValueL == IMANUFACTURER) {
9aa: 81 30 cpi r24, 0x01 ; 1
9ac: 29 f4 brne .+10 ; 0x9b8 <__vector_11+0x212>
return USB_SendStringDescriptor(STRING_MANUFACTURER, strlen(USB_MANUFACTURER), TRANSFER_PGM);
9ae: 40 e8 ldi r20, 0x80 ; 128
9b0: 6b e0 ldi r22, 0x0B ; 11
9b2: 84 e0 ldi r24, 0x04 ; 4
9b4: 91 e0 ldi r25, 0x01 ; 1
9b6: f1 cf rjmp .-30 ; 0x99a <__vector_11+0x1f4>
}
else if (setup.wValueL == ISERIAL) {
9b8: 83 30 cpi r24, 0x03 ; 3
9ba: 99 f7 brne .-26 ; 0x9a2 <__vector_11+0x1fc>
#ifdef PLUGGABLE_USB_ENABLED
char name[ISERIAL_MAX_LEN];
PluggableUSB().getShortName(name);
9bc: 0e 94 4c 01 call 0x298 ; 0x298 <_Z12PluggableUSBv>
}
void PluggableUSB_::getShortName(char *iSerialNum)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
9c0: dc 01 movw r26, r24
9c2: 12 96 adiw r26, 0x02 ; 2
9c4: ed 90 ld r14, X+
9c6: fc 90 ld r15, X
9c8: 8e 01 movw r16, r28
9ca: 0f 5f subi r16, 0xFF ; 255
9cc: 1f 4f sbci r17, 0xFF ; 255
9ce: 68 01 movw r12, r16
9d0: e1 14 cp r14, r1
9d2: f1 04 cpc r15, r1
9d4: 79 f0 breq .+30 ; 0x9f4 <__vector_11+0x24e>
iSerialNum += node->getShortName(iSerialNum);
9d6: d7 01 movw r26, r14
9d8: ed 91 ld r30, X+
9da: fc 91 ld r31, X
9dc: 06 80 ldd r0, Z+6 ; 0x06
9de: f7 81 ldd r31, Z+7 ; 0x07
9e0: e0 2d mov r30, r0
9e2: b8 01 movw r22, r16
9e4: c7 01 movw r24, r14
9e6: 09 95 icall
9e8: 08 0f add r16, r24
9ea: 11 1d adc r17, r1
}
void PluggableUSB_::getShortName(char *iSerialNum)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
9ec: f7 01 movw r30, r14
9ee: e0 84 ldd r14, Z+8 ; 0x08
9f0: f1 84 ldd r15, Z+9 ; 0x09
9f2: ee cf rjmp .-36 ; 0x9d0 <__vector_11+0x22a>
iSerialNum += node->getShortName(iSerialNum);
}
*iSerialNum = 0;
9f4: d8 01 movw r26, r16
9f6: 1c 92 st X, r1
return USB_SendStringDescriptor((uint8_t*)name, strlen(name), 0);
9f8: f6 01 movw r30, r12
9fa: 01 90 ld r0, Z+
9fc: 00 20 and r0, r0
9fe: e9 f7 brne .-6 ; 0x9fa <__vector_11+0x254>
a00: 31 97 sbiw r30, 0x01 ; 1
a02: bf 01 movw r22, r30
a04: 6c 19 sub r22, r12
a06: 7d 09 sbc r23, r13
a08: 40 e0 ldi r20, 0x00 ; 0
a0a: c6 01 movw r24, r12
a0c: c6 cf rjmp .-116 ; 0x99a <__vector_11+0x1f4>
desc_addr = (const u8*)&USB_DeviceDescriptorIAD;
}
else if (USB_STRING_DESCRIPTOR_TYPE == t)
{
if (setup.wValueL == 0) {
desc_addr = (const u8*)&STRING_LANGUAGE;
a0e: 6e ee ldi r22, 0xEE ; 238
a10: 70 e0 ldi r23, 0x00 ; 0
return false;
}
if (desc_addr == 0)
return false;
u8 desc_length = pgm_read_byte(desc_addr);
a12: fb 01 movw r30, r22
a14: 44 91 lpm r20, Z
USB_SendControl(TRANSFER_PGM,desc_addr,desc_length);
a16: 50 e0 ldi r21, 0x00 ; 0
a18: 80 e8 ldi r24, 0x80 ; 128
if (REQUEST_DEVICETOHOST_CLASS_INTERFACE == requestType)
{
if (CDC_GET_LINE_CODING == r)
{
USB_SendControl(0,(void*)&_usbLineInfo,7);
a1a: 0e 94 42 02 call 0x484 ; 0x484 <_Z15USB_SendControlhPKvi>
a1e: 09 cf rjmp .-494 ; 0x832 <__vector_11+0x8c>
}
else if (GET_DESCRIPTOR == r)
{
ok = SendDescriptor(setup);
}
else if (SET_DESCRIPTOR == r)
a20: 97 30 cpi r25, 0x07 ; 7
a22: 09 f4 brne .+2 ; 0xa26 <__vector_11+0x280>
a24: be cf rjmp .-132 ; 0x9a2 <__vector_11+0x1fc>
{
ok = false;
}
else if (GET_CONFIGURATION == r)
a26: 98 30 cpi r25, 0x08 ; 8
a28: 21 f4 brne .+8 ; 0xa32 <__vector_11+0x28c>
return UEDATX;
}
static inline void Send8(u8 d)
{
UEDATX = d;
a2a: 81 e0 ldi r24, 0x01 ; 1
a2c: 80 93 f1 00 sts 0x00F1, r24 ; 0x8000f1 <__DATA_REGION_ORIGIN__+0x91>
a30: 00 cf rjmp .-512 ; 0x832 <__vector_11+0x8c>
}
else if (GET_CONFIGURATION == r)
{
Send8(1);
}
else if (SET_CONFIGURATION == r)
a32: 99 30 cpi r25, 0x09 ; 9
a34: 09 f0 breq .+2 ; 0xa38 <__vector_11+0x292>
a36: fd ce rjmp .-518 ; 0x832 <__vector_11+0x8c>
{
if (REQUEST_DEVICE == (requestType & REQUEST_RECIPIENT))
a38: 83 70 andi r24, 0x03 ; 3
a3a: 09 f0 breq .+2 ; 0xa3e <__vector_11+0x298>
a3c: b2 cf rjmp .-156 ; 0x9a2 <__vector_11+0x1fc>
a3e: ed e0 ldi r30, 0x0D ; 13
a40: f1 e0 ldi r31, 0x01 ; 1
}
static
void InitEndpoints()
{
for (u8 i = 1; i < sizeof(_initEndpoints) && _initEndpoints[i] != 0; i++)
a42: 81 e0 ldi r24, 0x01 ; 1
{
UENUM = i;
UECONX = (1<<EPEN);
a44: 31 e0 ldi r19, 0x01 ; 1
UECFG0X = _initEndpoints[i];
#if USB_EP_SIZE == 16
UECFG1X = EP_SINGLE_16;
#elif USB_EP_SIZE == 64
UECFG1X = EP_DOUBLE_64;
a46: 96 e3 ldi r25, 0x36 ; 54
}
static
void InitEndpoints()
{
for (u8 i = 1; i < sizeof(_initEndpoints) && _initEndpoints[i] != 0; i++)
a48: 21 91 ld r18, Z+
a4a: 22 23 and r18, r18
a4c: 71 f0 breq .+28 ; 0xa6a <__vector_11+0x2c4>
{
UENUM = i;
a4e: 80 93 e9 00 sts 0x00E9, r24 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
UECONX = (1<<EPEN);
a52: 30 93 eb 00 sts 0x00EB, r19 ; 0x8000eb <__DATA_REGION_ORIGIN__+0x8b>
UECFG0X = _initEndpoints[i];
a56: df 01 movw r26, r30
a58: 11 97 sbiw r26, 0x01 ; 1
a5a: 2c 91 ld r18, X
a5c: 20 93 ec 00 sts 0x00EC, r18 ; 0x8000ec <__DATA_REGION_ORIGIN__+0x8c>
#if USB_EP_SIZE == 16
UECFG1X = EP_SINGLE_16;
#elif USB_EP_SIZE == 64
UECFG1X = EP_DOUBLE_64;
a60: 90 93 ed 00 sts 0x00ED, r25 ; 0x8000ed <__DATA_REGION_ORIGIN__+0x8d>
}
static
void InitEndpoints()
{
for (u8 i = 1; i < sizeof(_initEndpoints) && _initEndpoints[i] != 0; i++)
a64: 8f 5f subi r24, 0xFF ; 255
a66: 87 30 cpi r24, 0x07 ; 7
a68: 79 f7 brne .-34 ; 0xa48 <__vector_11+0x2a2>
UECFG1X = EP_DOUBLE_64;
#else
#error Unsupported value for USB_EP_SIZE
#endif
}
UERST = 0x7E; // And reset them
a6a: 8e e7 ldi r24, 0x7E ; 126
a6c: 80 93 ea 00 sts 0x00EA, r24 ; 0x8000ea <__DATA_REGION_ORIGIN__+0x8a>
UERST = 0;
a70: 10 92 ea 00 sts 0x00EA, r1 ; 0x8000ea <__DATA_REGION_ORIGIN__+0x8a>
else if (SET_CONFIGURATION == r)
{
if (REQUEST_DEVICE == (requestType & REQUEST_RECIPIENT))
{
InitEndpoints();
_usbConfiguration = setup.wValueL;
a74: 8f 89 ldd r24, Y+23 ; 0x17
a76: 80 93 94 01 sts 0x0194, r24 ; 0x800194 <_usbConfiguration>
a7a: db ce rjmp .-586 ; 0x832 <__vector_11+0x8c>
{
}
}
else
{
InitControl(setup.wLength); // Max length of transfer
a7c: 8b 8d ldd r24, Y+27 ; 0x1b
a7e: 9c 8d ldd r25, Y+28 ; 0x1c
UEDATX = d;
}
static inline void SetEP(u8 ep)
{
UENUM = ep;
a80: 10 92 e9 00 sts 0x00E9, r1 ; 0x8000e9 <__DATA_REGION_ORIGIN__+0x89>
static int _cmark;
static int _cend;
void InitControl(int end)
{
SetEP(0);
_cmark = 0;
a84: 10 92 32 01 sts 0x0132, r1 ; 0x800132 <_ZL6_cmark+0x1>
a88: 10 92 31 01 sts 0x0131, r1 ; 0x800131 <_ZL6_cmark>
_cend = end;
a8c: 90 93 30 01 sts 0x0130, r25 ; 0x800130 <_ZL5_cend+0x1>
a90: 80 93 2f 01 sts 0x012F, r24 ; 0x80012f <_ZL5_cend>
bool ClassInterfaceRequest(USBSetup& setup)
{
#ifdef CDC_ENABLED
u8 i = setup.wIndex;
if (CDC_ACM_INTERFACE == i)
a94: 89 8d ldd r24, Y+25 ; 0x19
a96: 81 11 cpse r24, r1
a98: 92 c0 rjmp .+292 ; 0xbbe <__stack+0xbf>
return USB_SendControl(TRANSFER_PGM,&_cdcInterface,sizeof(_cdcInterface));
}
bool CDC_Setup(USBSetup& setup)
{
u8 r = setup.bRequest;
a9a: 8e 89 ldd r24, Y+22 ; 0x16
u8 requestType = setup.bmRequestType;
a9c: 9d 89 ldd r25, Y+21 ; 0x15
if (REQUEST_DEVICETOHOST_CLASS_INTERFACE == requestType)
a9e: 91 3a cpi r25, 0xA1 ; 161
aa0: 49 f4 brne .+18 ; 0xab4 <__vector_11+0x30e>
{
if (CDC_GET_LINE_CODING == r)
aa2: 81 32 cpi r24, 0x21 ; 33
aa4: 09 f0 breq .+2 ; 0xaa8 <__vector_11+0x302>
aa6: 7d cf rjmp .-262 ; 0x9a2 <__vector_11+0x1fc>
{
USB_SendControl(0,(void*)&_usbLineInfo,7);
aa8: 47 e0 ldi r20, 0x07 ; 7
aaa: 50 e0 ldi r21, 0x00 ; 0
aac: 64 e0 ldi r22, 0x04 ; 4
aae: 71 e0 ldi r23, 0x01 ; 1
ab0: 80 e0 ldi r24, 0x00 ; 0
ab2: b3 cf rjmp .-154 ; 0xa1a <__vector_11+0x274>
return true;
}
}
if (REQUEST_HOSTTODEVICE_CLASS_INTERFACE == requestType)
ab4: 91 32 cpi r25, 0x21 ; 33
ab6: 09 f0 breq .+2 ; 0xaba <__vector_11+0x314>
ab8: 74 cf rjmp .-280 ; 0x9a2 <__vector_11+0x1fc>
{
if (CDC_SEND_BREAK == r)
aba: 83 32 cpi r24, 0x23 ; 35
abc: 69 f4 brne .+26 ; 0xad8 <__vector_11+0x332>
{
breakValue = ((uint16_t)setup.wValueH << 8) | setup.wValueL;
abe: 8f 89 ldd r24, Y+23 ; 0x17
ac0: 98 8d ldd r25, Y+24 ; 0x18
ac2: b0 e0 ldi r27, 0x00 ; 0
ac4: a0 e0 ldi r26, 0x00 ; 0
ac6: 80 93 00 01 sts 0x0100, r24 ; 0x800100 <__data_start>
aca: 90 93 01 01 sts 0x0101, r25 ; 0x800101 <__data_start+0x1>
ace: a0 93 02 01 sts 0x0102, r26 ; 0x800102 <__data_start+0x2>
ad2: b0 93 03 01 sts 0x0103, r27 ; 0x800103 <__data_start+0x3>
ad6: ad ce rjmp .-678 ; 0x832 <__vector_11+0x8c>
}
if (CDC_SET_LINE_CODING == r)
ad8: 80 32 cpi r24, 0x20 ; 32
ada: 69 f4 brne .+26 ; 0xaf6 <__vector_11+0x350>
UEINTX = ~(1<<TXINI);
}
static inline void WaitOUT(void)
{
while (!(UEINTX & (1<<RXOUTI)))
adc: 80 91 e8 00 lds r24, 0x00E8 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
ae0: 82 ff sbrs r24, 2
ae2: fc cf rjmp .-8 ; 0xadc <__vector_11+0x336>
recvLength = 64;
}
// Write data to fit to the end (not the beginning) of the array
WaitOUT();
Recv((u8*)d + len - length, recvLength);
ae4: 67 e0 ldi r22, 0x07 ; 7
ae6: 84 e0 ldi r24, 0x04 ; 4
ae8: 91 e0 ldi r25, 0x01 ; 1
aea: 0e 94 99 02 call 0x532 ; 0x532 <_ZL4RecvPVhh>
return (UEINTX & (1<<RXOUTI)) == 0;
}
static inline void ClearOUT(void)
{
UEINTX = ~(1<<RXOUTI);
aee: 8b ef ldi r24, 0xFB ; 251
af0: 80 93 e8 00 sts 0x00E8, r24 ; 0x8000e8 <__DATA_REGION_ORIGIN__+0x88>
af4: 9e ce rjmp .-708 ; 0x832 <__vector_11+0x8c>
{
USB_RecvControl((void*)&_usbLineInfo,7);
}
if (CDC_SET_CONTROL_LINE_STATE == r)
af6: 82 32 cpi r24, 0x22 ; 34
af8: 09 f0 breq .+2 ; 0xafc <__vector_11+0x356>
afa: 9b ce rjmp .-714 ; 0x832 <__vector_11+0x8c>
{
_usbLineInfo.lineState = setup.wValueL;
afc: 8f 89 ldd r24, Y+23 ; 0x17
afe: 80 93 0b 01 sts 0x010B, r24 ; 0x80010b <_ZL12_usbLineInfo+0x7>
D_ENDPOINT(USB_ENDPOINT_IN (CDC_ENDPOINT_IN ),USB_ENDPOINT_TYPE_BULK,USB_EP_SIZE,0)
};
bool isLUFAbootloader()
{
return pgm_read_word(FLASHEND - 1) == NEW_LUFA_SIGNATURE;
b02: ee ef ldi r30, 0xFE ; 254
b04: ff e7 ldi r31, 0x7F ; 127
b06: 85 91 lpm r24, Z+
b08: 94 91 lpm r25, Z
// This is used to keep compatible with the old leonardo bootloaders.
// You are still able to set the magic key position manually to RAMEND-1 to save a few bytes for this check.
#if MAGIC_KEY_POS != (RAMEND-1)
// For future boards save the key in the inproblematic RAMEND
// Which is reserved for the main() return value (which will never return)
if (isLUFAbootloader()) {
b0a: 8b 3f cpi r24, 0xFB ; 251
b0c: 9c 4d sbci r25, 0xDC ; 220
b0e: 51 f1 breq .+84 ; 0xb64 <__stack+0x65>
// auto-reset into the bootloader is triggered when the port, already
// open at 1200 bps, is closed. this is the signal to start the watchdog
// with a relatively long period so it can finish housekeeping tasks
// like servicing endpoints before the sketch ends
uint16_t magic_key_pos = MAGIC_KEY_POS;
b10: e0 e0 ldi r30, 0x00 ; 0
b12: f8 e0 ldi r31, 0x08 ; 8
magic_key_pos = (RAMEND-1);
}
#endif
// We check DTR state to determine if host port is open (bit 0 of lineState).
if (1200 == _usbLineInfo.dwDTERate && (_usbLineInfo.lineState & 0x01) == 0)
b14: 80 91 04 01 lds r24, 0x0104 ; 0x800104 <_ZL12_usbLineInfo>
b18: 90 91 05 01 lds r25, 0x0105 ; 0x800105 <_ZL12_usbLineInfo+0x1>
b1c: a0 91 06 01 lds r26, 0x0106 ; 0x800106 <_ZL12_usbLineInfo+0x2>
b20: b0 91 07 01 lds r27, 0x0107 ; 0x800107 <_ZL12_usbLineInfo+0x3>
b24: 80 3b cpi r24, 0xB0 ; 176
b26: 94 40 sbci r25, 0x04 ; 4
b28: a1 05 cpc r26, r1
b2a: b1 05 cpc r27, r1
b2c: f1 f4 brne .+60 ; 0xb6a <__stack+0x6b>
b2e: 80 91 0b 01 lds r24, 0x010B ; 0x80010b <_ZL12_usbLineInfo+0x7>
b32: 80 fd sbrc r24, 0
b34: 1a c0 rjmp .+52 ; 0xb6a <__stack+0x6b>
{
#if MAGIC_KEY_POS != (RAMEND-1)
// Backup ram value if its not a newer bootloader and it hasn't already been saved.
// This should avoid memory corruption at least a bit, not fully
if (magic_key_pos != (RAMEND-1) && *(uint16_t *)magic_key_pos != MAGIC_KEY) {
b36: ee 3f cpi r30, 0xFE ; 254
b38: 8a e0 ldi r24, 0x0A ; 10
b3a: f8 07 cpc r31, r24
b3c: 89 f5 brne .+98 ; 0xba0 <__stack+0xa1>
*(uint16_t *)(RAMEND-1) = *(uint16_t *)magic_key_pos;
}
#endif
// Store boot key
*(uint16_t *)magic_key_pos = MAGIC_KEY;
b3e: 87 e7 ldi r24, 0x77 ; 119
b40: 97 e7 ldi r25, 0x77 ; 119
b42: 91 83 std Z+1, r25 ; 0x01
b44: 80 83 st Z, r24
// Save the watchdog state in case the reset is aborted.
wdtcsr_save = WDTCSR;
b46: 80 91 60 00 lds r24, 0x0060 ; 0x800060 <__DATA_REGION_ORIGIN__>
b4a: 80 93 33 01 sts 0x0133, r24 ; 0x800133 <_ZL11wdtcsr_save>
: "n" (_SFR_MEM_ADDR(_WD_CONTROL_REG)),
"r" ((uint8_t)(_BV(_WD_CHANGE_BIT) | _BV(WDE))),
"r" ((uint8_t) ((value & 0x08 ? _WD_PS3_MASK : 0x00) |
_BV(WDE) | (value & 0x07)) )
: "r0"
);
b4e: 88 e1 ldi r24, 0x18 ; 24
b50: 9b e0 ldi r25, 0x0B ; 11
b52: 0f b6 in r0, 0x3f ; 63
b54: f8 94 cli
b56: a8 95 wdr
b58: 80 93 60 00 sts 0x0060, r24 ; 0x800060 <__DATA_REGION_ORIGIN__>
b5c: 0f be out 0x3f, r0 ; 63
b5e: 90 93 60 00 sts 0x0060, r25 ; 0x800060 <__DATA_REGION_ORIGIN__>
b62: 67 ce rjmp .-818 ; 0x832 <__vector_11+0x8c>
#if MAGIC_KEY_POS != (RAMEND-1)
// For future boards save the key in the inproblematic RAMEND
// Which is reserved for the main() return value (which will never return)
if (isLUFAbootloader()) {
// horray, we got a new bootloader!
magic_key_pos = (RAMEND-1);
b64: ee ef ldi r30, 0xFE ; 254
b66: fa e0 ldi r31, 0x0A ; 10
b68: d5 cf rjmp .-86 ; 0xb14 <__stack+0x15>
*(uint16_t *)magic_key_pos = MAGIC_KEY;
// Save the watchdog state in case the reset is aborted.
wdtcsr_save = WDTCSR;
wdt_enable(WDTO_120MS);
}
else if (*(uint16_t *)magic_key_pos == MAGIC_KEY)
b6a: 80 81 ld r24, Z
b6c: 91 81 ldd r25, Z+1 ; 0x01
b6e: 87 37 cpi r24, 0x77 ; 119
b70: 97 47 sbci r25, 0x77 ; 119
b72: 09 f0 breq .+2 ; 0xb76 <__stack+0x77>
b74: 5e ce rjmp .-836 ; 0x832 <__vector_11+0x8c>
// To avoid spurious resets we set the watchdog to 120ms and eventually
// cancel if DTR goes back high.
// Cancellation is only done if an auto-reset was started, which is
// indicated by the magic key having been set.
wdt_reset();
b76: a8 95 wdr
// Restore the watchdog state in case the sketch was using it.
WDTCSR |= (1<<WDCE) | (1<<WDE);
b78: 80 91 60 00 lds r24, 0x0060 ; 0x800060 <__DATA_REGION_ORIGIN__>
b7c: 88 61 ori r24, 0x18 ; 24
b7e: 80 93 60 00 sts 0x0060, r24 ; 0x800060 <__DATA_REGION_ORIGIN__>
WDTCSR = wdtcsr_save;
b82: 80 91 33 01 lds r24, 0x0133 ; 0x800133 <_ZL11wdtcsr_save>
b86: 80 93 60 00 sts 0x0060, r24 ; 0x800060 <__DATA_REGION_ORIGIN__>
#if MAGIC_KEY_POS != (RAMEND-1)
// Restore backed up (old bootloader) magic key data
if (magic_key_pos != (RAMEND-1)) {
b8a: ee 3f cpi r30, 0xFE ; 254
b8c: 2a e0 ldi r18, 0x0A ; 10
b8e: f2 07 cpc r31, r18
b90: 89 f0 breq .+34 ; 0xbb4 <__stack+0xb5>
*(uint16_t *)magic_key_pos = *(uint16_t *)(RAMEND-1);
b92: 80 91 fe 0a lds r24, 0x0AFE ; 0x800afe <__bss_end+0x969>
b96: 90 91 ff 0a lds r25, 0x0AFF ; 0x800aff <__bss_end+0x96a>
b9a: 91 83 std Z+1, r25 ; 0x01
b9c: 80 83 st Z, r24
b9e: 49 ce rjmp .-878 ; 0x832 <__vector_11+0x8c>
if (1200 == _usbLineInfo.dwDTERate && (_usbLineInfo.lineState & 0x01) == 0)
{
#if MAGIC_KEY_POS != (RAMEND-1)
// Backup ram value if its not a newer bootloader and it hasn't already been saved.
// This should avoid memory corruption at least a bit, not fully
if (magic_key_pos != (RAMEND-1) && *(uint16_t *)magic_key_pos != MAGIC_KEY) {
ba0: 80 81 ld r24, Z
ba2: 91 81 ldd r25, Z+1 ; 0x01
ba4: 87 37 cpi r24, 0x77 ; 119
ba6: 98 07 cpc r25, r24
ba8: 51 f2 breq .-108 ; 0xb3e <__stack+0x3f>
*(uint16_t *)(RAMEND-1) = *(uint16_t *)magic_key_pos;
baa: 90 93 ff 0a sts 0x0AFF, r25 ; 0x800aff <__bss_end+0x96a>
bae: 80 93 fe 0a sts 0x0AFE, r24 ; 0x800afe <__bss_end+0x969>
bb2: c5 cf rjmp .-118 ; 0xb3e <__stack+0x3f>
*(uint16_t *)magic_key_pos = *(uint16_t *)(RAMEND-1);
} else
#endif
{
// Clean up RAMEND key
*(uint16_t *)magic_key_pos = 0x0000;
bb4: 10 92 ff 0a sts 0x0AFF, r1 ; 0x800aff <__bss_end+0x96a>
bb8: 10 92 fe 0a sts 0x0AFE, r1 ; 0x800afe <__bss_end+0x969>
bbc: 3a ce rjmp .-908 ; 0x832 <__vector_11+0x8c>
if (CDC_ACM_INTERFACE == i)
return CDC_Setup(setup);
#endif
#ifdef PLUGGABLE_USB_ENABLED
return PluggableUSB().setup(setup);
bbe: 0e 94 4c 01 call 0x298 ; 0x298 <_Z12PluggableUSBv>
}
bool PluggableUSB_::setup(USBSetup& setup)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
bc2: dc 01 movw r26, r24
bc4: 12 96 adiw r26, 0x02 ; 2
bc6: 0d 91 ld r16, X+
bc8: 1c 91 ld r17, X
bca: 01 15 cp r16, r1
bcc: 11 05 cpc r17, r1
bce: 09 f4 brne .+2 ; 0xbd2 <__stack+0xd3>
bd0: e8 ce rjmp .-560 ; 0x9a2 <__vector_11+0x1fc>
if (node->setup(setup)) {
bd2: d8 01 movw r26, r16
bd4: ed 91 ld r30, X+
bd6: fc 91 ld r31, X
bd8: 01 90 ld r0, Z+
bda: f0 81 ld r31, Z
bdc: e0 2d mov r30, r0
bde: be 01 movw r22, r28
be0: 6b 5e subi r22, 0xEB ; 235
be2: 7f 4f sbci r23, 0xFF ; 255
be4: c8 01 movw r24, r16
be6: 09 95 icall
be8: 81 11 cpse r24, r1
bea: 23 ce rjmp .-954 ; 0x832 <__vector_11+0x8c>
}
bool PluggableUSB_::setup(USBSetup& setup)
{
PluggableUSBModule* node;
for (node = rootNode; node; node = node->next) {
bec: f8 01 movw r30, r16
bee: 00 85 ldd r16, Z+8 ; 0x08
bf0: 11 85 ldd r17, Z+9 ; 0x09
bf2: eb cf rjmp .-42 ; 0xbca <__stack+0xcb>
InitControl(setup.wLength);
#ifdef PLUGGABLE_USB_ENABLED
int ret = PluggableUSB().getDescriptor(setup);
if (ret != 0) {
return (ret > 0 ? true : false);
bf4: 18 16 cp r1, r24
bf6: 19 06 cpc r1, r25
bf8: 0c f4 brge .+2 ; 0xbfc <__stack+0xfd>
bfa: 1b ce rjmp .-970 ; 0x832 <__vector_11+0x8c>
bfc: d2 ce rjmp .-604 ; 0x9a2 <__vector_11+0x1fc>
}
#endif
const u8* desc_addr = 0;
if (USB_DEVICE_DESCRIPTOR_TYPE == t)
bfe: f1 e0 ldi r31, 0x01 ; 1
c00: ff 12 cpse r15, r31
c02: be ce rjmp .-644 ; 0x980 <__vector_11+0x1da>
{
desc_addr = (const u8*)&USB_DeviceDescriptorIAD;
c04: 62 ef ldi r22, 0xF2 ; 242
c06: 70 e0 ldi r23, 0x00 ; 0
c08: 04 cf rjmp .-504 ; 0xa12 <__vector_11+0x26c>
00000c0a <__vector_23>:
#if defined(TIM0_OVF_vect)
ISR(TIM0_OVF_vect)
#else
ISR(TIMER0_OVF_vect)
#endif
{
c0a: 1f 92 push r1
c0c: 0f 92 push r0
c0e: 0f b6 in r0, 0x3f ; 63
c10: 0f 92 push r0
c12: 11 24 eor r1, r1
c14: 2f 93 push r18
c16: 3f 93 push r19
c18: 8f 93 push r24
c1a: 9f 93 push r25
c1c: af 93 push r26
c1e: bf 93 push r27
// copy these to local variables so they can be stored in registers
// (volatile variables must be read from memory on every access)
unsigned long m = timer0_millis;
c20: 80 91 27 01 lds r24, 0x0127 ; 0x800127 <timer0_millis>
c24: 90 91 28 01 lds r25, 0x0128 ; 0x800128 <timer0_millis+0x1>
c28: a0 91 29 01 lds r26, 0x0129 ; 0x800129 <timer0_millis+0x2>
c2c: b0 91 2a 01 lds r27, 0x012A ; 0x80012a <timer0_millis+0x3>
unsigned char f = timer0_fract;
c30: 30 91 26 01 lds r19, 0x0126 ; 0x800126 <__data_end>
m += MILLIS_INC;
f += FRACT_INC;
c34: 23 e0 ldi r18, 0x03 ; 3
c36: 23 0f add r18, r19
if (f >= FRACT_MAX) {
c38: 2d 37 cpi r18, 0x7D ; 125
c3a: 58 f5 brcc .+86 ; 0xc92 <__vector_23+0x88>
// copy these to local variables so they can be stored in registers
// (volatile variables must be read from memory on every access)
unsigned long m = timer0_millis;
unsigned char f = timer0_fract;
m += MILLIS_INC;
c3c: 01 96 adiw r24, 0x01 ; 1
c3e: a1 1d adc r26, r1
c40: b1 1d adc r27, r1
if (f >= FRACT_MAX) {
f -= FRACT_MAX;
m += 1;
}
timer0_fract = f;
c42: 20 93 26 01 sts 0x0126, r18 ; 0x800126 <__data_end>
timer0_millis = m;
c46: 80 93 27 01 sts 0x0127, r24 ; 0x800127 <timer0_millis>
c4a: 90 93 28 01 sts 0x0128, r25 ; 0x800128 <timer0_millis+0x1>
c4e: a0 93 29 01 sts 0x0129, r26 ; 0x800129 <timer0_millis+0x2>
c52: b0 93 2a 01 sts 0x012A, r27 ; 0x80012a <timer0_millis+0x3>
timer0_overflow_count++;
c56: 80 91 2b 01 lds r24, 0x012B ; 0x80012b <timer0_overflow_count>
c5a: 90 91 2c 01 lds r25, 0x012C ; 0x80012c <timer0_overflow_count+0x1>
c5e: a0 91 2d 01 lds r26, 0x012D ; 0x80012d <timer0_overflow_count+0x2>
c62: b0 91 2e 01 lds r27, 0x012E ; 0x80012e <timer0_overflow_count+0x3>
c66: 01 96 adiw r24, 0x01 ; 1
c68: a1 1d adc r26, r1
c6a: b1 1d adc r27, r1
c6c: 80 93 2b 01 sts 0x012B, r24 ; 0x80012b <timer0_overflow_count>
c70: 90 93 2c 01 sts 0x012C, r25 ; 0x80012c <timer0_overflow_count+0x1>
c74: a0 93 2d 01 sts 0x012D, r26 ; 0x80012d <timer0_overflow_count+0x2>
c78: b0 93 2e 01 sts 0x012E, r27 ; 0x80012e <timer0_overflow_count+0x3>
}
c7c: bf 91 pop r27
c7e: af 91 pop r26
c80: 9f 91 pop r25
c82: 8f 91 pop r24
c84: 3f 91 pop r19
c86: 2f 91 pop r18
c88: 0f 90 pop r0
c8a: 0f be out 0x3f, r0 ; 63
c8c: 0f 90 pop r0
c8e: 1f 90 pop r1
c90: 18 95 reti
unsigned char f = timer0_fract;
m += MILLIS_INC;
f += FRACT_INC;
if (f >= FRACT_MAX) {
f -= FRACT_MAX;
c92: 26 e8 ldi r18, 0x86 ; 134
c94: 23 0f add r18, r19
m += 1;
c96: 02 96 adiw r24, 0x02 ; 2
c98: a1 1d adc r26, r1
c9a: b1 1d adc r27, r1
c9c: d2 cf rjmp .-92 ; 0xc42 <__vector_23+0x38>
00000c9e <INT3_vect_part_2>:
" rjmp INT3_vect_part_2 \n" // go to part 2 for required prologue and epilogue
:: [pin] "I" (_SFR_IO_ADDR(PORTB)), [gpio] "I" (_SFR_IO_ADDR(GPIOR1)));
//:: [pin] "I" (_SFR_IO_ADDR(PORTB)), [gpio] "M" (_SFR_MEM_ADDR(GPIOR1)));
}
ISR(INT3_vect_part_2) { GPIOR2 = &GPIOR1; }
c9e: 1f 92 push r1
ca0: 0f 92 push r0
ca2: 0f b6 in r0, 0x3f ; 63
ca4: 0f 92 push r0
ca6: 11 24 eor r1, r1
ca8: 8f 93 push r24
caa: 8a e4 ldi r24, 0x4A ; 74
cac: 8b bd out 0x2b, r24 ; 43
cae: 8f 91 pop r24
cb0: 0f 90 pop r0
cb2: 0f be out 0x3f, r0 ; 63
cb4: 0f 90 pop r0
cb6: 1f 90 pop r1
cb8: 18 95 reti
00000cba <__vector_4>:
// " lds r0, %[gpio] \n" // GPIOR1 address is 42
" in r0, %[gpio] \n"
" out %[pin], r0 \n"
" pop r0 \n"
" rjmp INT3_vect_part_2 \n" // go to part 2 for required prologue and epilogue
:: [pin] "I" (_SFR_IO_ADDR(PORTB)), [gpio] "I" (_SFR_IO_ADDR(GPIOR1)));
cba: 0f 92 push r0
cbc: 0a b4 in r0, 0x2a ; 42
cbe: 05 b8 out 0x05, r0 ; 5
cc0: 0f 90 pop r0
cc2: ed cf rjmp .-38 ; 0xc9e <INT3_vect_part_2>
00000cc4 <INT2_vect_part_2>:
" pop r0 \n"
" rjmp INT2_vect_part_2 \n" // go to part 2 for required prologue and epilogue
:: [pin] "I" (_SFR_IO_ADDR(PORTB)), [gpio] "I" (_SFR_IO_ADDR(GPIOR0)));
}
ISR(INT2_vect_part_2) { GPIOR2 = &GPIOR0; }
cc4: 1f 92 push r1
cc6: 0f 92 push r0
cc8: 0f b6 in r0, 0x3f ; 63
cca: 0f 92 push r0
ccc: 11 24 eor r1, r1
cce: 8f 93 push r24
cd0: 8e e3 ldi r24, 0x3E ; 62
cd2: 8b bd out 0x2b, r24 ; 43
cd4: 8f 91 pop r24
cd6: 0f 90 pop r0
cd8: 0f be out 0x3f, r0 ; 63
cda: 0f 90 pop r0
cdc: 1f 90 pop r1
cde: 18 95 reti
00000ce0 <__vector_3>:
" push r0 \n"
" in r0, %[gpio] \n"
" out %[pin], r0 \n"
" pop r0 \n"
" rjmp INT2_vect_part_2 \n" // go to part 2 for required prologue and epilogue
:: [pin] "I" (_SFR_IO_ADDR(PORTB)), [gpio] "I" (_SFR_IO_ADDR(GPIOR0)));
ce0: 0f 92 push r0
ce2: 0e b2 in r0, 0x1e ; 30
ce4: 05 b8 out 0x05, r0 ; 5
ce6: 0f 90 pop r0
ce8: ed cf rjmp .-38 ; 0xcc4 <INT2_vect_part_2>
00000cea <_GLOBAL__sub_I__cdcInterface>:
public:
Print() : write_error(0) {}
cea: e7 e3 ldi r30, 0x37 ; 55
cec: f1 e0 ldi r31, 0x01 ; 1
cee: 13 82 std Z+3, r1 ; 0x03
cf0: 12 82 std Z+2, r1 ; 0x02
public:
virtual int available() = 0;
virtual int read() = 0;
virtual int peek() = 0;
Stream() {_timeout=1000;}
cf2: 88 ee ldi r24, 0xE8 ; 232
cf4: 93 e0 ldi r25, 0x03 ; 3
cf6: a0 e0 ldi r26, 0x00 ; 0
cf8: b0 e0 ldi r27, 0x00 ; 0
cfa: 84 83 std Z+4, r24 ; 0x04
cfc: 95 83 std Z+5, r25 ; 0x05
cfe: a6 83 std Z+6, r26 ; 0x06
d00: b7 83 std Z+7, r27 ; 0x07
class Serial_ : public Stream
{
private:
int peek_buffer;
public:
Serial_() { peek_buffer = -1; };
d02: 87 e1 ldi r24, 0x17 ; 23
d04: 91 e0 ldi r25, 0x01 ; 1
d06: 91 83 std Z+1, r25 ; 0x01
d08: 80 83 st Z, r24
d0a: 8f ef ldi r24, 0xFF ; 255
d0c: 9f ef ldi r25, 0xFF ; 255
d0e: 95 87 std Z+13, r25 ; 0x0d
d10: 84 87 std Z+12, r24 ; 0x0c
breakValue = -1;
}
return ret;
}
Serial_ Serial;
d12: 08 95 ret
00000d14 <main>:
void init()
{
// this needs to be called before setup() or some functions won't
// work there
sei();
d14: 78 94 sei
// on the ATmega168, timer 0 is also used for fast hardware pwm
// (using phase-correct PWM would mean that timer 0 overflowed half as often
// resulting in different millis() behavior on the ATmega8 and ATmega168)
#if defined(TCCR0A) && defined(WGM01)
sbi(TCCR0A, WGM01);
d16: 84 b5 in r24, 0x24 ; 36
d18: 82 60 ori r24, 0x02 ; 2
d1a: 84 bd out 0x24, r24 ; 36
sbi(TCCR0A, WGM00);
d1c: 84 b5 in r24, 0x24 ; 36
d1e: 81 60 ori r24, 0x01 ; 1
d20: 84 bd out 0x24, r24 ; 36
// this combination is for the standard atmega8
sbi(TCCR0, CS01);
sbi(TCCR0, CS00);
#elif defined(TCCR0B) && defined(CS01) && defined(CS00)
// this combination is for the standard 168/328/1280/2560
sbi(TCCR0B, CS01);
d22: 85 b5 in r24, 0x25 ; 37
d24: 82 60 ori r24, 0x02 ; 2
d26: 85 bd out 0x25, r24 ; 37
sbi(TCCR0B, CS00);
d28: 85 b5 in r24, 0x25 ; 37
d2a: 81 60 ori r24, 0x01 ; 1
d2c: 85 bd out 0x25, r24 ; 37
// enable timer 0 overflow interrupt
#if defined(TIMSK) && defined(TOIE0)
sbi(TIMSK, TOIE0);
#elif defined(TIMSK0) && defined(TOIE0)
sbi(TIMSK0, TOIE0);
d2e: 80 91 6e 00 lds r24, 0x006E ; 0x80006e <__DATA_REGION_ORIGIN__+0xe>
d32: 81 60 ori r24, 0x01 ; 1
d34: 80 93 6e 00 sts 0x006E, r24 ; 0x80006e <__DATA_REGION_ORIGIN__+0xe>
// this is better for motors as it ensures an even waveform
// note, however, that fast pwm mode can achieve a frequency of up
// 8 MHz (with a 16 MHz clock) at 50% duty cycle
#if defined(TCCR1B) && defined(CS11) && defined(CS10)
TCCR1B = 0;
d38: 10 92 81 00 sts 0x0081, r1 ; 0x800081 <__DATA_REGION_ORIGIN__+0x21>
// set timer 1 prescale factor to 64
sbi(TCCR1B, CS11);
d3c: 80 91 81 00 lds r24, 0x0081 ; 0x800081 <__DATA_REGION_ORIGIN__+0x21>
d40: 82 60 ori r24, 0x02 ; 2
d42: 80 93 81 00 sts 0x0081, r24 ; 0x800081 <__DATA_REGION_ORIGIN__+0x21>
#if F_CPU >= 8000000L
sbi(TCCR1B, CS10);
d46: 80 91 81 00 lds r24, 0x0081 ; 0x800081 <__DATA_REGION_ORIGIN__+0x21>
d4a: 81 60 ori r24, 0x01 ; 1
d4c: 80 93 81 00 sts 0x0081, r24 ; 0x800081 <__DATA_REGION_ORIGIN__+0x21>
sbi(TCCR1, CS10);
#endif
#endif
// put timer 1 in 8-bit phase correct pwm mode
#if defined(TCCR1A) && defined(WGM10)
sbi(TCCR1A, WGM10);
d50: 80 91 80 00 lds r24, 0x0080 ; 0x800080 <__DATA_REGION_ORIGIN__+0x20>
d54: 81 60 ori r24, 0x01 ; 1
d56: 80 93 80 00 sts 0x0080, r24 ; 0x800080 <__DATA_REGION_ORIGIN__+0x20>
//#else
// Timer 2 not finished (may not be present on this CPU)
#endif
#if defined(TCCR3B) && defined(CS31) && defined(WGM30)
sbi(TCCR3B, CS31); // set timer 3 prescale factor to 64
d5a: 80 91 91 00 lds r24, 0x0091 ; 0x800091 <__DATA_REGION_ORIGIN__+0x31>
d5e: 82 60 ori r24, 0x02 ; 2
d60: 80 93 91 00 sts 0x0091, r24 ; 0x800091 <__DATA_REGION_ORIGIN__+0x31>
sbi(TCCR3B, CS30);
d64: 80 91 91 00 lds r24, 0x0091 ; 0x800091 <__DATA_REGION_ORIGIN__+0x31>
d68: 81 60 ori r24, 0x01 ; 1
d6a: 80 93 91 00 sts 0x0091, r24 ; 0x800091 <__DATA_REGION_ORIGIN__+0x31>
sbi(TCCR3A, WGM30); // put timer 3 in 8-bit phase correct pwm mode
d6e: 80 91 90 00 lds r24, 0x0090 ; 0x800090 <__DATA_REGION_ORIGIN__+0x30>
d72: 81 60 ori r24, 0x01 ; 1
d74: 80 93 90 00 sts 0x0090, r24 ; 0x800090 <__DATA_REGION_ORIGIN__+0x30>
#endif
#if defined(TCCR4A) && defined(TCCR4B) && defined(TCCR4D) /* beginning of timer4 block for 32U4 and similar */
sbi(TCCR4B, CS42); // set timer4 prescale factor to 64
d78: 80 91 c1 00 lds r24, 0x00C1 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
d7c: 84 60 ori r24, 0x04 ; 4
d7e: 80 93 c1 00 sts 0x00C1, r24 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
sbi(TCCR4B, CS41);
d82: 80 91 c1 00 lds r24, 0x00C1 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
d86: 82 60 ori r24, 0x02 ; 2
d88: 80 93 c1 00 sts 0x00C1, r24 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
sbi(TCCR4B, CS40);
d8c: 80 91 c1 00 lds r24, 0x00C1 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
d90: 81 60 ori r24, 0x01 ; 1
d92: 80 93 c1 00 sts 0x00C1, r24 ; 0x8000c1 <__DATA_REGION_ORIGIN__+0x61>
sbi(TCCR4D, WGM40); // put timer 4 in phase- and frequency-correct PWM mode
d96: 80 91 c3 00 lds r24, 0x00C3 ; 0x8000c3 <__DATA_REGION_ORIGIN__+0x63>
d9a: 81 60 ori r24, 0x01 ; 1
d9c: 80 93 c3 00 sts 0x00C3, r24 ; 0x8000c3 <__DATA_REGION_ORIGIN__+0x63>
sbi(TCCR4A, PWM4A); // enable PWM mode for comparator OCR4A
da0: 80 91 c0 00 lds r24, 0x00C0 ; 0x8000c0 <__DATA_REGION_ORIGIN__+0x60>
da4: 82 60 ori r24, 0x02 ; 2
da6: 80 93 c0 00 sts 0x00C0, r24 ; 0x8000c0 <__DATA_REGION_ORIGIN__+0x60>
sbi(TCCR4C, PWM4D); // enable PWM mode for comparator OCR4D
daa: 80 91 c2 00 lds r24, 0x00C2 ; 0x8000c2 <__DATA_REGION_ORIGIN__+0x62>
dae: 81 60 ori r24, 0x01 ; 1
db0: 80 93 c2 00 sts 0x00C2, r24 ; 0x8000c2 <__DATA_REGION_ORIGIN__+0x62>
#endif
#if defined(ADCSRA)
// set a2d prescaler so we are inside the desired 50-200 KHz range.
#if F_CPU >= 16000000 // 16 MHz / 128 = 125 KHz
sbi(ADCSRA, ADPS2);
db4: 80 91 7a 00 lds r24, 0x007A ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
db8: 84 60 ori r24, 0x04 ; 4
dba: 80 93 7a 00 sts 0x007A, r24 ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
sbi(ADCSRA, ADPS1);
dbe: 80 91 7a 00 lds r24, 0x007A ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
dc2: 82 60 ori r24, 0x02 ; 2
dc4: 80 93 7a 00 sts 0x007A, r24 ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
sbi(ADCSRA, ADPS0);
dc8: 80 91 7a 00 lds r24, 0x007A ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
dcc: 81 60 ori r24, 0x01 ; 1
dce: 80 93 7a 00 sts 0x007A, r24 ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
cbi(ADCSRA, ADPS2);
cbi(ADCSRA, ADPS1);
sbi(ADCSRA, ADPS0);
#endif
// enable a2d conversions
sbi(ADCSRA, ADEN);
dd2: 80 91 7a 00 lds r24, 0x007A ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
dd6: 80 68 ori r24, 0x80 ; 128
dd8: 80 93 7a 00 sts 0x007A, r24 ; 0x80007a <__DATA_REGION_ORIGIN__+0x1a>
{
}
void USBDevice_::attach()
{
_usbConfiguration = 0;
ddc: 10 92 94 01 sts 0x0194, r1 ; 0x800194 <_usbConfiguration>
_usbCurrentStatus = 0;
de0: 10 92 34 01 sts 0x0134, r1 ; 0x800134 <_usbCurrentStatus>
_usbSuspendState = 0;
de4: 10 92 36 01 sts 0x0136, r1 ; 0x800136 <_usbSuspendState>
}
static inline void USB_ClockEnable()
{
#if defined(UHWCON)
UHWCON |= (1<<UVREGE); // power internal reg
de8: 80 91 d7 00 lds r24, 0x00D7 ; 0x8000d7 <__DATA_REGION_ORIGIN__+0x77>
dec: 81 60 ori r24, 0x01 ; 1
dee: 80 93 d7 00 sts 0x00D7, r24 ; 0x8000d7 <__DATA_REGION_ORIGIN__+0x77>
#endif
USBCON = (1<<USBE) | (1<<FRZCLK); // clock frozen, usb enabled
df2: 80 ea ldi r24, 0xA0 ; 160
df4: 80 93 d8 00 sts 0x00D8, r24 ; 0x8000d8 <__DATA_REGION_ORIGIN__+0x78>
// ATmega32U4
#if defined(PINDIV)
#if F_CPU == 16000000UL
PLLCSR |= (1<<PINDIV); // Need 16 MHz xtal
df8: 89 b5 in r24, 0x29 ; 41
dfa: 80 61 ori r24, 0x10 ; 16
dfc: 89 bd out 0x29, r24 ; 41
#endif
#else
#error "USB Chip not supported, please defined method of USB PLL initialization"
#endif
PLLCSR |= (1<<PLLE);
dfe: 89 b5 in r24, 0x29 ; 41
e00: 82 60 ori r24, 0x02 ; 2
e02: 89 bd out 0x29, r24 ; 41
while (!(PLLCSR & (1<<PLOCK))) // wait for lock pll
e04: 09 b4 in r0, 0x29 ; 41
e06: 00 fe sbrs r0, 0
e08: fd cf rjmp .-6 ; 0xe04 <main+0xf0>
}
// Some tests on specific versions of macosx (10.7.3), reported some
// strange behaviors when the board is reset using the serial
// port touch at 1200 bps. This delay fixes this behavior.
delay(1);
e0a: 0e 94 cb 02 call 0x596 ; 0x596 <delay.constprop.10>
#if defined(OTGPADE)
USBCON = (USBCON & ~(1<<FRZCLK)) | (1<<OTGPADE); // start USB clock, enable VBUS Pad
e0e: 80 91 d8 00 lds r24, 0x00D8 ; 0x8000d8 <__DATA_REGION_ORIGIN__+0x78>
e12: 8f 7c andi r24, 0xCF ; 207
e14: 80 61 ori r24, 0x10 ; 16
e16: 80 93 d8 00 sts 0x00D8, r24 ; 0x8000d8 <__DATA_REGION_ORIGIN__+0x78>
USBCON &= ~(1 << FRZCLK); // start USB clock
#endif
#if defined(RSTCPU)
#if defined(LSM)
UDCON &= ~((1<<RSTCPU) | (1<<LSM) | (1<<RMWKUP) | (1<<DETACH)); // enable attach resistor, set full speed mode
e1a: 80 91 e0 00 lds r24, 0x00E0 ; 0x8000e0 <__DATA_REGION_ORIGIN__+0x80>
e1e: 80 7f andi r24, 0xF0 ; 240
e20: 80 93 e0 00 sts 0x00E0, r24 ; 0x8000e0 <__DATA_REGION_ORIGIN__+0x80>
_usbConfiguration = 0;
_usbCurrentStatus = 0;
_usbSuspendState = 0;
USB_ClockEnable();
UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear already pending WAKEUP / SUSPEND requests
e24: 80 91 e1 00 lds r24, 0x00E1 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
e28: 8e 7e andi r24, 0xEE ; 238
e2a: 80 93 e1 00 sts 0x00E1, r24 ; 0x8000e1 <__DATA_REGION_ORIGIN__+0x81>
UDIEN = (1<<EORSTE) | (1<<SOFE) | (1<<SUSPE); // Enable interrupts for EOR (End of Reset), SOF (start of frame) and SUSPEND
e2e: 8d e0 ldi r24, 0x0D ; 13
e30: 80 93 e2 00 sts 0x00E2, r24 ; 0x8000e2 <__DATA_REGION_ORIGIN__+0x82>
TX_RX_LED_INIT;
e34: 55 9a sbi 0x0a, 5 ; 10
e36: 20 9a sbi 0x04, 0 ; 4
}
ISR(INT3_vect_part_2) { GPIOR2 = &GPIOR1; }
void setup() {
DDRB = 0xff; PORTB = 0xff; //all PB-ports are outputs and high (0xff = zero state, because signals are inverted)
e38: 8f ef ldi r24, 0xFF ; 255
e3a: 84 b9 out 0x04, r24 ; 4
e3c: 85 b9 out 0x05, r24 ; 5
DDRF = 0; PORTF = 0xff; // all PF-ports are inputs with pullups
e3e: 10 ba out 0x10, r1 ; 16
e40: 81 bb out 0x11, r24 ; 17
DDRD = B00100000; PORTD = B11110011; // all PD-ports are inputs (except PD5) with pullups (PD2,PD3 without pullup)
e42: 80 e2 ldi r24, 0x20 ; 32
e44: 8a b9 out 0x0a, r24 ; 10
e46: 83 ef ldi r24, 0xF3 ; 243
e48: 8b b9 out 0x0b, r24 ; 11
pinMode(5, INPUT_PULLUP); // pin5 (PC6) is input
e4a: 85 e0 ldi r24, 0x05 ; 5
e4c: 0e 94 e9 00 call 0x1d2 ; 0x1d2 <pinMode.constprop.11>
pinMode(7, INPUT_PULLUP); // pin7 (PE6) is input
e50: 87 e0 ldi r24, 0x07 ; 7
e52: 0e 94 e9 00 call 0x1d2 ; 0x1d2 <pinMode.constprop.11>
if (selectC) GPIOR2 = &GPIOR0; else GPIOR2 = &GPIOR1;
e56: 4a 9b sbis 0x09, 2 ; 9
e58: 4a c0 rjmp .+148 ; 0xeee <main+0x1da>
e5a: 8e e3 ldi r24, 0x3E ; 62
e5c: 8b bd out 0x2b, r24 ; 43
GPIOR0 = 0xff; GPIOR1 = 0xff; // start from zero state (signals are inverted)
e5e: 8f ef ldi r24, 0xFF ; 255
e60: 8e bb out 0x1e, r24 ; 30
e62: 8a bd out 0x2a, r24 ; 42
TIMSK0 = 0; // disable timer0 interrupts (Arduino Uno/Pro Micro millis()/micros() update ISR)
e64: 10 92 6e 00 sts 0x006E, r1 ; 0x80006e <__DATA_REGION_ORIGIN__+0xe>
EICRA = B10110000; // INT2 ÔÇô rising edge on RXD (Bxx11xxxx), INT3 - falling edge on TXD (B10xxxxxx)
e68: 80 eb ldi r24, 0xB0 ; 176
e6a: 80 93 69 00 sts 0x0069, r24 ; 0x800069 <__DATA_REGION_ORIGIN__+0x9>
EIMSK = B1100; // enable INT2 (Bx1xx) and INT3 (B1xxx)
e6e: 8c e0 ldi r24, 0x0C ; 12
e70: 8d bb out 0x1d, r24 ; 29
setup();
for (;;) {
loop();
if (serialEventRun) serialEventRun();
e72: c0 e0 ldi r28, 0x00 ; 0
e74: d0 e0 ldi r29, 0x00 ; 0
TCNT1 = 0; // reset Timer1 counter*/
}
void loop() {
uint8_t PF, PD, PC, PE;
PF = PINF; PD = PIND; PC = PINC; PE = PINE;
e76: 3f b1 in r19, 0x0f ; 15
e78: 29 b1 in r18, 0x09 ; 9
e7a: 86 b1 in r24, 0x06 ; 6
e7c: 4c b1 in r20, 0x0c ; 12
uint8_t joy1 = 0xff; uint8_t joy2 = 0xff; // all signals are inverted
if (up1) bitClear(joy1,upC);
e7e: 9d ef ldi r25, 0xFD ; 253
e80: 27 fd sbrc r18, 7
}
void loop() {
uint8_t PF, PD, PC, PE;
PF = PINF; PD = PIND; PC = PINC; PE = PINE;
uint8_t joy1 = 0xff; uint8_t joy2 = 0xff; // all signals are inverted
e82: 9f ef ldi r25, 0xFF ; 255
if (up1) bitClear(joy1,upC);
if (down1) bitClear(joy1,downC);
e84: 86 ff sbrs r24, 6
e86: 97 7f andi r25, 0xF7 ; 247
if (left1) bitClear(joy1,leftC);
e88: 24 ff sbrs r18, 4
e8a: 9b 7f andi r25, 0xFB ; 251
if (right1) bitClear(joy1,rightC);
e8c: 20 ff sbrs r18, 0
e8e: 9f 7b andi r25, 0xBF ; 191
if (up2) bitClear(joy2,upC);
e90: 8d ef ldi r24, 0xFD ; 253
e92: 37 fd sbrc r19, 7
}
void loop() {
uint8_t PF, PD, PC, PE;
PF = PINF; PD = PIND; PC = PINC; PE = PINE;
uint8_t joy1 = 0xff; uint8_t joy2 = 0xff; // all signals are inverted
e94: 8f ef ldi r24, 0xFF ; 255
if (up1) bitClear(joy1,upC);
if (down1) bitClear(joy1,downC);
if (left1) bitClear(joy1,leftC);
if (right1) bitClear(joy1,rightC);
if (up2) bitClear(joy2,upC);
if (down2) bitClear(joy2,downC);
e96: 36 ff sbrs r19, 6
e98: 87 7f andi r24, 0xF7 ; 247
if (left2) bitClear(joy2,leftC);
e9a: 35 ff sbrs r19, 5
e9c: 8b 7f andi r24, 0xFB ; 251
if (right2) bitClear(joy2,rightC);
e9e: 34 ff sbrs r19, 4
ea0: 8f 7b andi r24, 0xBF ; 191
if (fire1) { bitClear(joy1,fire1C); bitClear(joy2,fire1C); }
ea2: 21 fd sbrc r18, 1
ea4: 02 c0 rjmp .+4 ; 0xeaa <main+0x196>
ea6: 9f 7e andi r25, 0xEF ; 239
ea8: 8f 7e andi r24, 0xEF ; 239
if (fire2) { bitClear(joy1,fire2C); bitClear(joy2,fire2C); }
eaa: 46 fd sbrc r20, 6
eac: 02 c0 rjmp .+4 ; 0xeb2 <main+0x19e>
eae: 9f 7d andi r25, 0xDF ; 223
eb0: 8f 7d andi r24, 0xDF ; 223
if (GPIOR2 == &GPIOR0) { PORTD &= ~_BV(5); } else { PORTD |= _BV(5); } //TX-LED on, if joystick 3 is activated
eb2: 2b b5 in r18, 0x2b ; 43
eb4: 2e 33 cpi r18, 0x3E ; 62
eb6: e9 f4 brne .+58 ; 0xef2 <main+0x1de>
eb8: 5d 98 cbi 0x0b, 5 ; 11
if (GPIOR2 == &GPIOR1) { bitClear(joy2,0); } //RX-LED on, if joystick 4 is activated
eba: 2b b5 in r18, 0x2b ; 43
ebc: 2a 34 cpi r18, 0x4A ; 74
ebe: 09 f4 brne .+2 ; 0xec2 <main+0x1ae>
ec0: 8e 7f andi r24, 0xFE ; 254
GPIOR0 = joy1; GPIOR1 = joy2;
ec2: 9e bb out 0x1e, r25 ; 30
ec4: 8a bd out 0x2a, r24 ; 42
//PORTB = *ptr; // is this atomic? probably, because ptr is 6-bit pointer. nope...
noInterrupts();
ec6: f8 94 cli
PORTB = *((unsigned int *)GPIOR2);
ec8: eb b5 in r30, 0x2b ; 43
eca: f0 e0 ldi r31, 0x00 ; 0
ecc: 80 81 ld r24, Z
ece: 85 b9 out 0x05, r24 ; 5
//ec8: eb b5 in r30, 0x2b ; 43
//eca: f0 e0 ldi r31, 0x00 ; 0
//ecc: 80 81 ld r24, Z
//ece: 85 b9 out 0x05, r24 ; 5
interrupts();
ed0: 78 94 sei
" cli \n"
" lds r30, %[gpio] \n"
" ld __tmp_reg__, Z \n"
" sts %[pin], __tmp_reg__ \n"
" sei \n"
:: [pin] "M" (_SFR_MEM_ADDR(PORTB)), [gpio] "M" (_SFR_MEM_ADDR(GPIOR2)) : "r30", "r31");
ed2: ff 27 eor r31, r31
ed4: f8 94 cli
ed6: e0 91 4b 00 lds r30, 0x004B ; 0x80004b <__TEXT_REGION_LENGTH__+0x7e004b>
eda: 00 80 ld r0, Z
edc: 00 92 25 00 sts 0x0025, r0 ; 0x800025 <__TEXT_REGION_LENGTH__+0x7e0025>
ee0: 78 94 sei
ee2: 20 97 sbiw r28, 0x00 ; 0
ee4: 09 f4 brne .+2 ; 0xee8 <main+0x1d4>
ee6: c7 cf rjmp .-114 ; 0xe76 <main+0x162>
ee8: 0e 94 00 00 call 0 ; 0x0 <__vectors>
eec: c4 cf rjmp .-120 ; 0xe76 <main+0x162>
DDRF = 0; PORTF = 0xff; // all PF-ports are inputs with pullups
DDRD = B00100000; PORTD = B11110011; // all PD-ports are inputs (except PD5) with pullups (PD2,PD3 without pullup)
pinMode(5, INPUT_PULLUP); // pin5 (PC6) is input
pinMode(7, INPUT_PULLUP); // pin7 (PE6) is input
if (selectC) GPIOR2 = &GPIOR0; else GPIOR2 = &GPIOR1;
eee: 8a e4 ldi r24, 0x4A ; 74
ef0: b5 cf rjmp .-150 ; 0xe5c <main+0x148>
if (left2) bitClear(joy2,leftC);
if (right2) bitClear(joy2,rightC);
if (fire1) { bitClear(joy1,fire1C); bitClear(joy2,fire1C); }
if (fire2) { bitClear(joy1,fire2C); bitClear(joy2,fire2C); }
if (GPIOR2 == &GPIOR0) { PORTD &= ~_BV(5); } else { PORTD |= _BV(5); } //TX-LED on, if joystick 3 is activated
ef2: 5d 9a sbi 0x0b, 5 ; 11
ef4: e2 cf rjmp .-60 ; 0xeba <main+0x1a6>
00000ef6 <__tablejump2__>:
ef6: ee 0f add r30, r30
ef8: ff 1f adc r31, r31
efa: 05 90 lpm r0, Z+
efc: f4 91 lpm r31, Z
efe: e0 2d mov r30, r0
f00: 09 94 ijmp
00000f02 <_exit>:
f02: f8 94 cli
00000f04 <__stop_program>:
f04: ff cf rjmp .-2 ; 0xf04 <__stop_program>