3471 |
miho |
1 |
/* Name: usbdrvasm128.inc |
|
|
2 |
* Project: V-USB, virtual USB port for Atmel's(r) AVR(r) microcontrollers |
|
|
3 |
* Author: Christian Starkjohann |
|
|
4 |
* Creation Date: 2008-10-11 |
|
|
5 |
* Tabsize: 4 |
|
|
6 |
* Copyright: (c) 2008 by OBJECTIVE DEVELOPMENT Software GmbH |
|
|
7 |
* License: GNU GPL v2 (see License.txt), GNU GPL v3 or proprietary (CommercialLicense.txt) |
|
|
8 |
* This Revision: $Id: usbdrvasm128.inc 758 2009-08-06 10:12:54Z cs $ |
|
|
9 |
*/ |
|
|
10 |
|
|
|
11 |
/* Do not link this file! Link usbdrvasm.S instead, which includes the |
|
|
12 |
* appropriate implementation! |
|
|
13 |
*/ |
|
|
14 |
|
|
|
15 |
/* |
|
|
16 |
General Description: |
|
|
17 |
This file is the 12.8 MHz version of the USB driver. It is intended for use |
|
|
18 |
with the internal RC oscillator. Although 12.8 MHz is outside the guaranteed |
|
|
19 |
calibration range of the oscillator, almost all AVRs can reach this frequency. |
|
|
20 |
This version contains a phase locked loop in the receiver routine to cope with |
|
|
21 |
slight clock rate deviations of up to +/- 1%. |
|
|
22 |
|
|
|
23 |
See usbdrv.h for a description of the entire driver. |
|
|
24 |
|
|
|
25 |
LIMITATIONS |
|
|
26 |
=========== |
|
|
27 |
Although it may seem very handy to save the crystal and use the internal |
|
|
28 |
RC oscillator of the CPU, this method (and this module) has some serious |
|
|
29 |
limitations: |
|
|
30 |
(1) The guaranteed calibration range of the oscillator is only 8.1 MHz. |
|
|
31 |
They typical range is 14.5 MHz and most AVRs can actually reach this rate. |
|
|
32 |
(2) Writing EEPROM and Flash may be unreliable (short data lifetime) since |
|
|
33 |
the write procedure is timed from the RC oscillator. |
|
|
34 |
(3) End Of Packet detection (SE0) should be in bit 1, bit it is only checked |
|
|
35 |
if bits 0 and 1 both read as 0 on D- and D+ read as 0 in the middle. This may |
|
|
36 |
cause problems with old hubs which delay SE0 by up to one cycle. |
|
|
37 |
(4) Code size is much larger than that of the other modules. |
|
|
38 |
|
|
|
39 |
Since almost all of this code is timing critical, don't change unless you |
|
|
40 |
really know what you are doing! Many parts require not only a maximum number |
|
|
41 |
of CPU cycles, but even an exact number of cycles! |
|
|
42 |
|
|
|
43 |
Implementation notes: |
|
|
44 |
====================== |
|
|
45 |
min frequency: 67 cycles for 8 bit -> 12.5625 MHz |
|
|
46 |
max frequency: 69.286 cycles for 8 bit -> 12.99 MHz |
|
|
47 |
nominal frequency: 12.77 MHz ( = sqrt(min * max)) |
|
|
48 |
|
|
|
49 |
sampling positions: (next even number in range [+/- 0.5]) |
|
|
50 |
cycle index range: 0 ... 66 |
|
|
51 |
bits: |
|
|
52 |
.5, 8.875, 17.25, 25.625, 34, 42.375, 50.75, 59.125 |
|
|
53 |
[0/1], [9], [17], [25/+26], [34], [+42/43], [51], [59] |
|
|
54 |
|
|
|
55 |
bit number: 0 1 2 3 4 5 6 7 |
|
|
56 |
spare cycles 1 2 1 2 1 1 1 0 |
|
|
57 |
|
|
|
58 |
operations to perform: duration cycle |
|
|
59 |
---------------- |
|
|
60 |
eor fix, shift 1 -> 00 |
|
|
61 |
andi phase, USBMASK 1 -> 08 |
|
|
62 |
breq se0 1 -> 16 (moved to 11) |
|
|
63 |
st y+, data 2 -> 24, 25 |
|
|
64 |
mov data, fix 1 -> 33 |
|
|
65 |
ser data 1 -> 41 |
|
|
66 |
subi cnt, 1 1 -> 49 |
|
|
67 |
brcs overflow 1 -> 50 |
|
|
68 |
|
|
|
69 |
layout of samples and operations: |
|
|
70 |
[##] = sample bit |
|
|
71 |
<##> = sample phase |
|
|
72 |
*##* = operation |
|
|
73 |
|
|
|
74 |
0: *00* [01] 02 03 04 <05> 06 07 |
|
|
75 |
1: *08* [09] 10 11 12 <13> 14 15 *16* |
|
|
76 |
2: [17] 18 19 20 <21> 22 23 |
|
|
77 |
3: *24* *25* [26] 27 28 29 <30> 31 32 |
|
|
78 |
4: *33* [34] 35 36 37 <38> 39 40 |
|
|
79 |
5: *41* [42] 43 44 45 <46> 47 48 |
|
|
80 |
6: *49* *50* [51] 52 53 54 <55> 56 57 58 |
|
|
81 |
7: [59] 60 61 62 <63> 64 65 66 |
|
|
82 |
*****************************************************************************/ |
|
|
83 |
|
|
|
84 |
/* we prefer positive expressions (do if condition) instead of negative |
|
|
85 |
* (skip if condition), therefore use defines for skip instructions: |
|
|
86 |
*/ |
|
|
87 |
#define ifioclr sbis |
|
|
88 |
#define ifioset sbic |
|
|
89 |
#define ifrclr sbrs |
|
|
90 |
#define ifrset sbrc |
|
|
91 |
|
|
|
92 |
/* The registers "fix" and "data" swap their meaning during the loop. Use |
|
|
93 |
* defines to keep their name constant. |
|
|
94 |
*/ |
|
|
95 |
#define fix x2 |
|
|
96 |
#define data x1 |
|
|
97 |
#undef phase /* phase has a default definition to x4 */ |
|
|
98 |
#define phase x3 |
|
|
99 |
|
|
|
100 |
|
|
|
101 |
USB_INTR_VECTOR: |
|
|
102 |
;order of registers pushed: YL, SREG [sofError], YH, shift, x1, x2, x3, cnt, r0 |
|
|
103 |
push YL ;2 push only what is necessary to sync with edge ASAP |
|
|
104 |
in YL, SREG ;1 |
|
|
105 |
push YL ;2 |
|
|
106 |
;---------------------------------------------------------------------------- |
|
|
107 |
; Synchronize with sync pattern: |
|
|
108 |
;---------------------------------------------------------------------------- |
|
|
109 |
;sync byte (D-) pattern LSb to MSb: 01010100 [1 = idle = J, 0 = K] |
|
|
110 |
;sync up with J to K edge during sync pattern -- use fastest possible loops |
|
|
111 |
;The first part waits at most 1 bit long since we must be in sync pattern. |
|
|
112 |
;YL is guarenteed to be < 0x80 because I flag is clear. When we jump to |
|
|
113 |
;waitForJ, ensure that this prerequisite is met. |
|
|
114 |
waitForJ: |
|
|
115 |
inc YL |
|
|
116 |
sbis USBIN, USBMINUS |
|
|
117 |
brne waitForJ ; just make sure we have ANY timeout |
|
|
118 |
waitForK: |
|
|
119 |
;The following code results in a sampling window of 1/4 bit which meets the spec. |
|
|
120 |
sbis USBIN, USBMINUS |
|
|
121 |
rjmp foundK |
|
|
122 |
sbis USBIN, USBMINUS |
|
|
123 |
rjmp foundK |
|
|
124 |
sbis USBIN, USBMINUS |
|
|
125 |
rjmp foundK |
|
|
126 |
sbis USBIN, USBMINUS |
|
|
127 |
rjmp foundK |
|
|
128 |
sbis USBIN, USBMINUS ;[0] |
|
|
129 |
rjmp foundK ;[1] |
|
|
130 |
#if USB_COUNT_SOF |
|
|
131 |
lds YL, usbSofCount |
|
|
132 |
inc YL |
|
|
133 |
sts usbSofCount, YL |
|
|
134 |
#endif /* USB_COUNT_SOF */ |
|
|
135 |
#ifdef USB_SOF_HOOK |
|
|
136 |
USB_SOF_HOOK |
|
|
137 |
#endif |
|
|
138 |
rjmp sofError |
|
|
139 |
|
|
|
140 |
foundK: |
|
|
141 |
;{3, 5} after falling D- edge, average delay: 4 cycles [we want 4 for center sampling] |
|
|
142 |
;we have 1 bit time for setup purposes, then sample again. Numbers in brackets |
|
|
143 |
;are cycles from center of first sync (double K) bit after the instruction |
|
|
144 |
push YH ;[2] |
|
|
145 |
lds YL, usbInputBufOffset;[4] |
|
|
146 |
clr YH ;[6] |
|
|
147 |
subi YL, lo8(-(usbRxBuf));[7] |
|
|
148 |
sbci YH, hi8(-(usbRxBuf));[8] |
|
|
149 |
|
|
|
150 |
sbis USBIN, USBMINUS ;[9] we want two bits K [we want to sample at 8 + 4 - 1.5 = 10.5] |
|
|
151 |
rjmp haveTwoBitsK ;[10] |
|
|
152 |
pop YH ;[11] undo the push from before |
|
|
153 |
rjmp waitForK ;[13] this was not the end of sync, retry |
|
|
154 |
haveTwoBitsK: |
|
|
155 |
;---------------------------------------------------------------------------- |
|
|
156 |
; push more registers and initialize values while we sample the first bits: |
|
|
157 |
;---------------------------------------------------------------------------- |
|
|
158 |
#define fix x2 |
|
|
159 |
#define data x1 |
|
|
160 |
|
|
|
161 |
push shift ;[12] |
|
|
162 |
push x1 ;[14] |
|
|
163 |
push x2 ;[16] |
|
|
164 |
ldi shift, 0x80 ;[18] prevent bit-unstuffing but init low bits to 0 |
|
|
165 |
ifioset USBIN, USBMINUS ;[19] [01] <--- bit 0 [10.5 + 8 = 18.5] |
|
|
166 |
ori shift, 1<<0 ;[02] |
|
|
167 |
push x3 ;[03] |
|
|
168 |
push cnt ;[05] |
|
|
169 |
push r0 ;[07] |
|
|
170 |
ifioset USBIN, USBMINUS ;[09] <--- bit 1 |
|
|
171 |
ori shift, 1<<1 ;[10] |
|
|
172 |
ser fix ;[11] |
|
|
173 |
ldi cnt, USB_BUFSIZE ;[12] |
|
|
174 |
mov data, shift ;[13] |
|
|
175 |
lsl shift ;[14] |
|
|
176 |
nop2 ;[15] |
|
|
177 |
ifioset USBIN, USBMINUS ;[17] <--- bit 2 |
|
|
178 |
ori data, 3<<2 ;[18] store in bit 2 AND bit 3 |
|
|
179 |
eor shift, data ;[19] do nrzi decoding |
|
|
180 |
andi data, 1<<3 ;[20] |
|
|
181 |
in phase, USBIN ;[21] <- phase |
|
|
182 |
brne jumpToEntryAfterSet ;[22] if USBMINS at bit 3 was 1 |
|
|
183 |
nop ;[23] |
|
|
184 |
rjmp entryAfterClr ;[24] |
|
|
185 |
jumpToEntryAfterSet: |
|
|
186 |
rjmp entryAfterSet ;[24] |
|
|
187 |
|
|
|
188 |
;---------------------------------------------------------------------------- |
|
|
189 |
; Receiver loop (numbers in brackets are cycles within byte after instr) |
|
|
190 |
;---------------------------------------------------------------------------- |
|
|
191 |
#undef fix |
|
|
192 |
#define fix x1 |
|
|
193 |
#undef data |
|
|
194 |
#define data x2 |
|
|
195 |
|
|
|
196 |
bit7IsSet: |
|
|
197 |
ifrclr phase, USBMINUS ;[62] check phase only if D- changed |
|
|
198 |
lpm ;[63] |
|
|
199 |
in phase, USBIN ;[64] <- phase (one cycle too late) |
|
|
200 |
ori shift, 1 << 7 ;[65] |
|
|
201 |
nop ;[66] |
|
|
202 |
;;;;rjmp bit0AfterSet ; -> [00] == [67] moved block up to save jump |
|
|
203 |
bit0AfterSet: |
|
|
204 |
eor fix, shift ;[00] |
|
|
205 |
#undef fix |
|
|
206 |
#define fix x2 |
|
|
207 |
#undef data |
|
|
208 |
#define data x1 /* we now have result in data, fix is reset to 0xff */ |
|
|
209 |
ifioclr USBIN, USBMINUS ;[01] <--- sample 0 |
|
|
210 |
rjmp bit0IsClr ;[02] |
|
|
211 |
andi shift, ~(7 << 0) ;[03] |
|
|
212 |
breq unstuff0s ;[04] |
|
|
213 |
in phase, USBIN ;[05] <- phase |
|
|
214 |
rjmp bit1AfterSet ;[06] |
|
|
215 |
unstuff0s: |
|
|
216 |
in phase, USBIN ;[06] <- phase (one cycle too late) |
|
|
217 |
andi fix, ~(1 << 0) ;[07] |
|
|
218 |
ifioclr USBIN, USBMINUS ;[00] |
|
|
219 |
ifioset USBIN, USBPLUS ;[01] |
|
|
220 |
rjmp bit0IsClr ;[02] executed if first expr false or second true |
|
|
221 |
se0AndStore: ; executed only if both bits 0 |
|
|
222 |
st y+, x1 ;[15/17] cycles after start of byte |
|
|
223 |
rjmp se0 ;[17/19] |
|
|
224 |
|
|
|
225 |
bit0IsClr: |
|
|
226 |
ifrset phase, USBMINUS ;[04] check phase only if D- changed |
|
|
227 |
lpm ;[05] |
|
|
228 |
in phase, USBIN ;[06] <- phase (one cycle too late) |
|
|
229 |
ori shift, 1 << 0 ;[07] |
|
|
230 |
bit1AfterClr: |
|
|
231 |
andi phase, USBMASK ;[08] |
|
|
232 |
ifioset USBIN, USBMINUS ;[09] <--- sample 1 |
|
|
233 |
rjmp bit1IsSet ;[10] |
|
|
234 |
breq se0AndStore ;[11] if D- was 0 in bits 0 AND 1 and D+ was 0 in between, we have SE0 |
|
|
235 |
andi shift, ~(7 << 1) ;[12] |
|
|
236 |
in phase, USBIN ;[13] <- phase |
|
|
237 |
breq unstuff1c ;[14] |
|
|
238 |
rjmp bit2AfterClr ;[15] |
|
|
239 |
unstuff1c: |
|
|
240 |
andi fix, ~(1 << 1) ;[16] |
|
|
241 |
nop2 ;[08] |
|
|
242 |
nop2 ;[10] |
|
|
243 |
bit1IsSet: |
|
|
244 |
ifrclr phase, USBMINUS ;[12] check phase only if D- changed |
|
|
245 |
lpm ;[13] |
|
|
246 |
in phase, USBIN ;[14] <- phase (one cycle too late) |
|
|
247 |
ori shift, 1 << 1 ;[15] |
|
|
248 |
nop ;[16] |
|
|
249 |
bit2AfterSet: |
|
|
250 |
ifioclr USBIN, USBMINUS ;[17] <--- sample 2 |
|
|
251 |
rjmp bit2IsClr ;[18] |
|
|
252 |
andi shift, ~(7 << 2) ;[19] |
|
|
253 |
breq unstuff2s ;[20] |
|
|
254 |
in phase, USBIN ;[21] <- phase |
|
|
255 |
rjmp bit3AfterSet ;[22] |
|
|
256 |
unstuff2s: |
|
|
257 |
in phase, USBIN ;[22] <- phase (one cycle too late) |
|
|
258 |
andi fix, ~(1 << 2) ;[23] |
|
|
259 |
nop2 ;[16] |
|
|
260 |
nop2 ;[18] |
|
|
261 |
bit2IsClr: |
|
|
262 |
ifrset phase, USBMINUS ;[20] check phase only if D- changed |
|
|
263 |
lpm ;[21] |
|
|
264 |
in phase, USBIN ;[22] <- phase (one cycle too late) |
|
|
265 |
ori shift, 1 << 2 ;[23] |
|
|
266 |
bit3AfterClr: |
|
|
267 |
st y+, data ;[24] |
|
|
268 |
entryAfterClr: |
|
|
269 |
ifioset USBIN, USBMINUS ;[26] <--- sample 3 |
|
|
270 |
rjmp bit3IsSet ;[27] |
|
|
271 |
andi shift, ~(7 << 3) ;[28] |
|
|
272 |
breq unstuff3c ;[29] |
|
|
273 |
in phase, USBIN ;[30] <- phase |
|
|
274 |
rjmp bit4AfterClr ;[31] |
|
|
275 |
unstuff3c: |
|
|
276 |
in phase, USBIN ;[31] <- phase (one cycle too late) |
|
|
277 |
andi fix, ~(1 << 3) ;[32] |
|
|
278 |
nop2 ;[25] |
|
|
279 |
nop2 ;[27] |
|
|
280 |
bit3IsSet: |
|
|
281 |
ifrclr phase, USBMINUS ;[29] check phase only if D- changed |
|
|
282 |
lpm ;[30] |
|
|
283 |
in phase, USBIN ;[31] <- phase (one cycle too late) |
|
|
284 |
ori shift, 1 << 3 ;[32] |
|
|
285 |
bit4AfterSet: |
|
|
286 |
mov data, fix ;[33] undo this move by swapping defines |
|
|
287 |
#undef fix |
|
|
288 |
#define fix x1 |
|
|
289 |
#undef data |
|
|
290 |
#define data x2 |
|
|
291 |
ifioclr USBIN, USBMINUS ;[34] <--- sample 4 |
|
|
292 |
rjmp bit4IsClr ;[35] |
|
|
293 |
andi shift, ~(7 << 4) ;[36] |
|
|
294 |
breq unstuff4s ;[37] |
|
|
295 |
in phase, USBIN ;[38] <- phase |
|
|
296 |
rjmp bit5AfterSet ;[39] |
|
|
297 |
unstuff4s: |
|
|
298 |
in phase, USBIN ;[39] <- phase (one cycle too late) |
|
|
299 |
andi fix, ~(1 << 4) ;[40] |
|
|
300 |
nop2 ;[33] |
|
|
301 |
nop2 ;[35] |
|
|
302 |
bit4IsClr: |
|
|
303 |
ifrset phase, USBMINUS ;[37] check phase only if D- changed |
|
|
304 |
lpm ;[38] |
|
|
305 |
in phase, USBIN ;[39] <- phase (one cycle too late) |
|
|
306 |
ori shift, 1 << 4 ;[40] |
|
|
307 |
bit5AfterClr: |
|
|
308 |
ser data ;[41] |
|
|
309 |
ifioset USBIN, USBMINUS ;[42] <--- sample 5 |
|
|
310 |
rjmp bit5IsSet ;[43] |
|
|
311 |
andi shift, ~(7 << 5) ;[44] |
|
|
312 |
breq unstuff5c ;[45] |
|
|
313 |
in phase, USBIN ;[46] <- phase |
|
|
314 |
rjmp bit6AfterClr ;[47] |
|
|
315 |
unstuff5c: |
|
|
316 |
in phase, USBIN ;[47] <- phase (one cycle too late) |
|
|
317 |
andi fix, ~(1 << 5) ;[48] |
|
|
318 |
nop2 ;[41] |
|
|
319 |
nop2 ;[43] |
|
|
320 |
bit5IsSet: |
|
|
321 |
ifrclr phase, USBMINUS ;[45] check phase only if D- changed |
|
|
322 |
lpm ;[46] |
|
|
323 |
in phase, USBIN ;[47] <- phase (one cycle too late) |
|
|
324 |
ori shift, 1 << 5 ;[48] |
|
|
325 |
bit6AfterSet: |
|
|
326 |
subi cnt, 1 ;[49] |
|
|
327 |
brcs jumpToOverflow ;[50] |
|
|
328 |
ifioclr USBIN, USBMINUS ;[51] <--- sample 6 |
|
|
329 |
rjmp bit6IsClr ;[52] |
|
|
330 |
andi shift, ~(3 << 6) ;[53] |
|
|
331 |
cpi shift, 2 ;[54] |
|
|
332 |
in phase, USBIN ;[55] <- phase |
|
|
333 |
brlt unstuff6s ;[56] |
|
|
334 |
rjmp bit7AfterSet ;[57] |
|
|
335 |
|
|
|
336 |
jumpToOverflow: |
|
|
337 |
rjmp overflow |
|
|
338 |
|
|
|
339 |
unstuff6s: |
|
|
340 |
andi fix, ~(1 << 6) ;[50] |
|
|
341 |
lpm ;[51] |
|
|
342 |
bit6IsClr: |
|
|
343 |
ifrset phase, USBMINUS ;[54] check phase only if D- changed |
|
|
344 |
lpm ;[55] |
|
|
345 |
in phase, USBIN ;[56] <- phase (one cycle too late) |
|
|
346 |
ori shift, 1 << 6 ;[57] |
|
|
347 |
nop ;[58] |
|
|
348 |
bit7AfterClr: |
|
|
349 |
ifioset USBIN, USBMINUS ;[59] <--- sample 7 |
|
|
350 |
rjmp bit7IsSet ;[60] |
|
|
351 |
andi shift, ~(1 << 7) ;[61] |
|
|
352 |
cpi shift, 4 ;[62] |
|
|
353 |
in phase, USBIN ;[63] <- phase |
|
|
354 |
brlt unstuff7c ;[64] |
|
|
355 |
rjmp bit0AfterClr ;[65] -> [00] == [67] |
|
|
356 |
unstuff7c: |
|
|
357 |
andi fix, ~(1 << 7) ;[58] |
|
|
358 |
nop ;[59] |
|
|
359 |
rjmp bit7IsSet ;[60] |
|
|
360 |
|
|
|
361 |
bit7IsClr: |
|
|
362 |
ifrset phase, USBMINUS ;[62] check phase only if D- changed |
|
|
363 |
lpm ;[63] |
|
|
364 |
in phase, USBIN ;[64] <- phase (one cycle too late) |
|
|
365 |
ori shift, 1 << 7 ;[65] |
|
|
366 |
nop ;[66] |
|
|
367 |
;;;;rjmp bit0AfterClr ; -> [00] == [67] moved block up to save jump |
|
|
368 |
bit0AfterClr: |
|
|
369 |
eor fix, shift ;[00] |
|
|
370 |
#undef fix |
|
|
371 |
#define fix x2 |
|
|
372 |
#undef data |
|
|
373 |
#define data x1 /* we now have result in data, fix is reset to 0xff */ |
|
|
374 |
ifioset USBIN, USBMINUS ;[01] <--- sample 0 |
|
|
375 |
rjmp bit0IsSet ;[02] |
|
|
376 |
andi shift, ~(7 << 0) ;[03] |
|
|
377 |
breq unstuff0c ;[04] |
|
|
378 |
in phase, USBIN ;[05] <- phase |
|
|
379 |
rjmp bit1AfterClr ;[06] |
|
|
380 |
unstuff0c: |
|
|
381 |
in phase, USBIN ;[06] <- phase (one cycle too late) |
|
|
382 |
andi fix, ~(1 << 0) ;[07] |
|
|
383 |
ifioclr USBIN, USBMINUS ;[00] |
|
|
384 |
ifioset USBIN, USBPLUS ;[01] |
|
|
385 |
rjmp bit0IsSet ;[02] executed if first expr false or second true |
|
|
386 |
rjmp se0AndStore ;[03] executed only if both bits 0 |
|
|
387 |
bit0IsSet: |
|
|
388 |
ifrclr phase, USBMINUS ;[04] check phase only if D- changed |
|
|
389 |
lpm ;[05] |
|
|
390 |
in phase, USBIN ;[06] <- phase (one cycle too late) |
|
|
391 |
ori shift, 1 << 0 ;[07] |
|
|
392 |
bit1AfterSet: |
|
|
393 |
andi shift, ~(7 << 1) ;[08] compensated by "ori shift, 1<<1" if bit1IsClr |
|
|
394 |
ifioclr USBIN, USBMINUS ;[09] <--- sample 1 |
|
|
395 |
rjmp bit1IsClr ;[10] |
|
|
396 |
breq unstuff1s ;[11] |
|
|
397 |
nop2 ;[12] do not check for SE0 if bit 0 was 1 |
|
|
398 |
in phase, USBIN ;[14] <- phase (one cycle too late) |
|
|
399 |
rjmp bit2AfterSet ;[15] |
|
|
400 |
unstuff1s: |
|
|
401 |
in phase, USBIN ;[13] <- phase |
|
|
402 |
andi fix, ~(1 << 1) ;[14] |
|
|
403 |
lpm ;[07] |
|
|
404 |
nop2 ;[10] |
|
|
405 |
bit1IsClr: |
|
|
406 |
ifrset phase, USBMINUS ;[12] check phase only if D- changed |
|
|
407 |
lpm ;[13] |
|
|
408 |
in phase, USBIN ;[14] <- phase (one cycle too late) |
|
|
409 |
ori shift, 1 << 1 ;[15] |
|
|
410 |
nop ;[16] |
|
|
411 |
bit2AfterClr: |
|
|
412 |
ifioset USBIN, USBMINUS ;[17] <--- sample 2 |
|
|
413 |
rjmp bit2IsSet ;[18] |
|
|
414 |
andi shift, ~(7 << 2) ;[19] |
|
|
415 |
breq unstuff2c ;[20] |
|
|
416 |
in phase, USBIN ;[21] <- phase |
|
|
417 |
rjmp bit3AfterClr ;[22] |
|
|
418 |
unstuff2c: |
|
|
419 |
in phase, USBIN ;[22] <- phase (one cycle too late) |
|
|
420 |
andi fix, ~(1 << 2) ;[23] |
|
|
421 |
nop2 ;[16] |
|
|
422 |
nop2 ;[18] |
|
|
423 |
bit2IsSet: |
|
|
424 |
ifrclr phase, USBMINUS ;[20] check phase only if D- changed |
|
|
425 |
lpm ;[21] |
|
|
426 |
in phase, USBIN ;[22] <- phase (one cycle too late) |
|
|
427 |
ori shift, 1 << 2 ;[23] |
|
|
428 |
bit3AfterSet: |
|
|
429 |
st y+, data ;[24] |
|
|
430 |
entryAfterSet: |
|
|
431 |
ifioclr USBIN, USBMINUS ;[26] <--- sample 3 |
|
|
432 |
rjmp bit3IsClr ;[27] |
|
|
433 |
andi shift, ~(7 << 3) ;[28] |
|
|
434 |
breq unstuff3s ;[29] |
|
|
435 |
in phase, USBIN ;[30] <- phase |
|
|
436 |
rjmp bit4AfterSet ;[31] |
|
|
437 |
unstuff3s: |
|
|
438 |
in phase, USBIN ;[31] <- phase (one cycle too late) |
|
|
439 |
andi fix, ~(1 << 3) ;[32] |
|
|
440 |
nop2 ;[25] |
|
|
441 |
nop2 ;[27] |
|
|
442 |
bit3IsClr: |
|
|
443 |
ifrset phase, USBMINUS ;[29] check phase only if D- changed |
|
|
444 |
lpm ;[30] |
|
|
445 |
in phase, USBIN ;[31] <- phase (one cycle too late) |
|
|
446 |
ori shift, 1 << 3 ;[32] |
|
|
447 |
bit4AfterClr: |
|
|
448 |
mov data, fix ;[33] undo this move by swapping defines |
|
|
449 |
#undef fix |
|
|
450 |
#define fix x1 |
|
|
451 |
#undef data |
|
|
452 |
#define data x2 |
|
|
453 |
ifioset USBIN, USBMINUS ;[34] <--- sample 4 |
|
|
454 |
rjmp bit4IsSet ;[35] |
|
|
455 |
andi shift, ~(7 << 4) ;[36] |
|
|
456 |
breq unstuff4c ;[37] |
|
|
457 |
in phase, USBIN ;[38] <- phase |
|
|
458 |
rjmp bit5AfterClr ;[39] |
|
|
459 |
unstuff4c: |
|
|
460 |
in phase, USBIN ;[39] <- phase (one cycle too late) |
|
|
461 |
andi fix, ~(1 << 4) ;[40] |
|
|
462 |
nop2 ;[33] |
|
|
463 |
nop2 ;[35] |
|
|
464 |
bit4IsSet: |
|
|
465 |
ifrclr phase, USBMINUS ;[37] check phase only if D- changed |
|
|
466 |
lpm ;[38] |
|
|
467 |
in phase, USBIN ;[39] <- phase (one cycle too late) |
|
|
468 |
ori shift, 1 << 4 ;[40] |
|
|
469 |
bit5AfterSet: |
|
|
470 |
ser data ;[41] |
|
|
471 |
ifioclr USBIN, USBMINUS ;[42] <--- sample 5 |
|
|
472 |
rjmp bit5IsClr ;[43] |
|
|
473 |
andi shift, ~(7 << 5) ;[44] |
|
|
474 |
breq unstuff5s ;[45] |
|
|
475 |
in phase, USBIN ;[46] <- phase |
|
|
476 |
rjmp bit6AfterSet ;[47] |
|
|
477 |
unstuff5s: |
|
|
478 |
in phase, USBIN ;[47] <- phase (one cycle too late) |
|
|
479 |
andi fix, ~(1 << 5) ;[48] |
|
|
480 |
nop2 ;[41] |
|
|
481 |
nop2 ;[43] |
|
|
482 |
bit5IsClr: |
|
|
483 |
ifrset phase, USBMINUS ;[45] check phase only if D- changed |
|
|
484 |
lpm ;[46] |
|
|
485 |
in phase, USBIN ;[47] <- phase (one cycle too late) |
|
|
486 |
ori shift, 1 << 5 ;[48] |
|
|
487 |
bit6AfterClr: |
|
|
488 |
subi cnt, 1 ;[49] |
|
|
489 |
brcs overflow ;[50] |
|
|
490 |
ifioset USBIN, USBMINUS ;[51] <--- sample 6 |
|
|
491 |
rjmp bit6IsSet ;[52] |
|
|
492 |
andi shift, ~(3 << 6) ;[53] |
|
|
493 |
cpi shift, 2 ;[54] |
|
|
494 |
in phase, USBIN ;[55] <- phase |
|
|
495 |
brlt unstuff6c ;[56] |
|
|
496 |
rjmp bit7AfterClr ;[57] |
|
|
497 |
unstuff6c: |
|
|
498 |
andi fix, ~(1 << 6) ;[50] |
|
|
499 |
lpm ;[51] |
|
|
500 |
bit6IsSet: |
|
|
501 |
ifrclr phase, USBMINUS ;[54] check phase only if D- changed |
|
|
502 |
lpm ;[55] |
|
|
503 |
in phase, USBIN ;[56] <- phase (one cycle too late) |
|
|
504 |
ori shift, 1 << 6 ;[57] |
|
|
505 |
bit7AfterSet: |
|
|
506 |
ifioclr USBIN, USBMINUS ;[59] <--- sample 7 |
|
|
507 |
rjmp bit7IsClr ;[60] |
|
|
508 |
andi shift, ~(1 << 7) ;[61] |
|
|
509 |
cpi shift, 4 ;[62] |
|
|
510 |
in phase, USBIN ;[63] <- phase |
|
|
511 |
brlt unstuff7s ;[64] |
|
|
512 |
rjmp bit0AfterSet ;[65] -> [00] == [67] |
|
|
513 |
unstuff7s: |
|
|
514 |
andi fix, ~(1 << 7) ;[58] |
|
|
515 |
nop ;[59] |
|
|
516 |
rjmp bit7IsClr ;[60] |
|
|
517 |
|
|
|
518 |
macro POP_STANDARD ; 14 cycles |
|
|
519 |
pop r0 |
|
|
520 |
pop cnt |
|
|
521 |
pop x3 |
|
|
522 |
pop x2 |
|
|
523 |
pop x1 |
|
|
524 |
pop shift |
|
|
525 |
pop YH |
|
|
526 |
endm |
|
|
527 |
macro POP_RETI ; 5 cycles |
|
|
528 |
pop YL |
|
|
529 |
out SREG, YL |
|
|
530 |
pop YL |
|
|
531 |
endm |
|
|
532 |
|
|
|
533 |
#include "asmcommon.inc" |
|
|
534 |
|
|
|
535 |
;---------------------------------------------------------------------------- |
|
|
536 |
; Transmitting data |
|
|
537 |
;---------------------------------------------------------------------------- |
|
|
538 |
|
|
|
539 |
txByteLoop: |
|
|
540 |
txBitloop: |
|
|
541 |
stuffN1Delay: ; [03] |
|
|
542 |
ror shift ;[-5] [11] [63] |
|
|
543 |
brcc doExorN1 ;[-4] [64] |
|
|
544 |
subi x3, 1 ;[-3] |
|
|
545 |
brne commonN1 ;[-2] |
|
|
546 |
lsl shift ;[-1] compensate ror after rjmp stuffDelay |
|
|
547 |
nop ;[00] stuffing consists of just waiting 8 cycles |
|
|
548 |
rjmp stuffN1Delay ;[01] after ror, C bit is reliably clear |
|
|
549 |
|
|
|
550 |
sendNakAndReti: |
|
|
551 |
ldi cnt, USBPID_NAK ;[-19] |
|
|
552 |
rjmp sendCntAndReti ;[-18] |
|
|
553 |
sendAckAndReti: |
|
|
554 |
ldi cnt, USBPID_ACK ;[-17] |
|
|
555 |
sendCntAndReti: |
|
|
556 |
mov r0, cnt ;[-16] |
|
|
557 |
ldi YL, 0 ;[-15] R0 address is 0 |
|
|
558 |
ldi YH, 0 ;[-14] |
|
|
559 |
ldi cnt, 2 ;[-13] |
|
|
560 |
; rjmp usbSendAndReti fallthrough |
|
|
561 |
|
|
|
562 |
; USB spec says: |
|
|
563 |
; idle = J |
|
|
564 |
; J = (D+ = 0), (D- = 1) or USBOUT = 0x01 |
|
|
565 |
; K = (D+ = 1), (D- = 0) or USBOUT = 0x02 |
|
|
566 |
; Spec allows 7.5 bit times from EOP to SOP for replies (= 60 cycles) |
|
|
567 |
|
|
|
568 |
;usbSend: |
|
|
569 |
;pointer to data in 'Y' |
|
|
570 |
;number of bytes in 'cnt' -- including sync byte |
|
|
571 |
;uses: x1...x3, shift, cnt, Y [x1 = mirror USBOUT, x2 = USBMASK, x3 = bitstuff cnt] |
|
|
572 |
;Numbers in brackets are time since first bit of sync pattern is sent (start of instruction) |
|
|
573 |
usbSendAndReti: |
|
|
574 |
in x2, USBDDR ;[-10] 10 cycles until SOP |
|
|
575 |
ori x2, USBMASK ;[-9] |
|
|
576 |
sbi USBOUT, USBMINUS ;[-8] prepare idle state; D+ and D- must have been 0 (no pullups) |
|
|
577 |
out USBDDR, x2 ;[-6] <--- acquire bus |
|
|
578 |
in x1, USBOUT ;[-5] port mirror for tx loop |
|
|
579 |
ldi shift, 0x40 ;[-4] sync byte is first byte sent (we enter loop after ror) |
|
|
580 |
ldi x2, USBMASK ;[-3] |
|
|
581 |
doExorN1: |
|
|
582 |
eor x1, x2 ;[-2] [06] [62] |
|
|
583 |
ldi x3, 6 ;[-1] [07] [63] |
|
|
584 |
commonN1: |
|
|
585 |
stuffN2Delay: |
|
|
586 |
out USBOUT, x1 ;[00] [08] [64] <--- set bit |
|
|
587 |
ror shift ;[01] |
|
|
588 |
brcc doExorN2 ;[02] |
|
|
589 |
subi x3, 1 ;[03] |
|
|
590 |
brne commonN2 ;[04] |
|
|
591 |
lsl shift ;[05] compensate ror after rjmp stuffDelay |
|
|
592 |
rjmp stuffN2Delay ;[06] after ror, C bit is reliably clear |
|
|
593 |
doExorN2: |
|
|
594 |
eor x1, x2 ;[04] [12] |
|
|
595 |
ldi x3, 6 ;[05] [13] |
|
|
596 |
commonN2: |
|
|
597 |
nop2 ;[06] [14] |
|
|
598 |
subi cnt, 171 ;[08] [16] trick: (3 * 171) & 0xff = 1 |
|
|
599 |
out USBOUT, x1 ;[09] [17] <--- set bit |
|
|
600 |
brcs txBitloop ;[10] [27] [44] |
|
|
601 |
|
|
|
602 |
stuff6Delay: |
|
|
603 |
ror shift ;[45] [53] |
|
|
604 |
brcc doExor6 ;[46] |
|
|
605 |
subi x3, 1 ;[47] |
|
|
606 |
brne common6 ;[48] |
|
|
607 |
lsl shift ;[49] compensate ror after rjmp stuffDelay |
|
|
608 |
nop ;[50] stuffing consists of just waiting 8 cycles |
|
|
609 |
rjmp stuff6Delay ;[51] after ror, C bit is reliably clear |
|
|
610 |
doExor6: |
|
|
611 |
eor x1, x2 ;[48] [56] |
|
|
612 |
ldi x3, 6 ;[49] |
|
|
613 |
common6: |
|
|
614 |
stuff7Delay: |
|
|
615 |
ror shift ;[50] [58] |
|
|
616 |
out USBOUT, x1 ;[51] <--- set bit |
|
|
617 |
brcc doExor7 ;[52] |
|
|
618 |
subi x3, 1 ;[53] |
|
|
619 |
brne common7 ;[54] |
|
|
620 |
lsl shift ;[55] compensate ror after rjmp stuffDelay |
|
|
621 |
rjmp stuff7Delay ;[56] after ror, C bit is reliably clear |
|
|
622 |
doExor7: |
|
|
623 |
eor x1, x2 ;[54] [62] |
|
|
624 |
ldi x3, 6 ;[55] |
|
|
625 |
common7: |
|
|
626 |
ld shift, y+ ;[56] |
|
|
627 |
nop ;[58] |
|
|
628 |
tst cnt ;[59] |
|
|
629 |
out USBOUT, x1 ;[60] [00]<--- set bit |
|
|
630 |
brne txByteLoop ;[61] [01] |
|
|
631 |
;make SE0: |
|
|
632 |
cbr x1, USBMASK ;[02] prepare SE0 [spec says EOP may be 15 to 18 cycles] |
|
|
633 |
lds x2, usbNewDeviceAddr;[03] |
|
|
634 |
lsl x2 ;[05] we compare with left shifted address |
|
|
635 |
subi YL, 2 + 0 ;[06] Only assign address on data packets, not ACK/NAK in r0 |
|
|
636 |
sbci YH, 0 ;[07] |
|
|
637 |
out USBOUT, x1 ;[00] <-- out SE0 -- from now 2 bits = 16 cycles until bus idle |
|
|
638 |
;2006-03-06: moved transfer of new address to usbDeviceAddr from C-Code to asm: |
|
|
639 |
;set address only after data packet was sent, not after handshake |
|
|
640 |
breq skipAddrAssign ;[01] |
|
|
641 |
sts usbDeviceAddr, x2 ; if not skipped: SE0 is one cycle longer |
|
|
642 |
skipAddrAssign: |
|
|
643 |
;end of usbDeviceAddress transfer |
|
|
644 |
ldi x2, 1<<USB_INTR_PENDING_BIT;[03] int0 occurred during TX -- clear pending flag |
|
|
645 |
USB_STORE_PENDING(x2) ;[04] |
|
|
646 |
ori x1, USBIDLE ;[05] |
|
|
647 |
in x2, USBDDR ;[06] |
|
|
648 |
cbr x2, USBMASK ;[07] set both pins to input |
|
|
649 |
mov x3, x1 ;[08] |
|
|
650 |
cbr x3, USBMASK ;[09] configure no pullup on both pins |
|
|
651 |
lpm ;[10] |
|
|
652 |
lpm ;[13] |
|
|
653 |
out USBOUT, x1 ;[16] <-- out J (idle) -- end of SE0 (EOP signal) |
|
|
654 |
out USBDDR, x2 ;[17] <-- release bus now |
|
|
655 |
out USBOUT, x3 ;[18] <-- ensure no pull-up resistors are active |
|
|
656 |
rjmp doReturn |
|
|
657 |
|
|
|
658 |
|
|
|
659 |
|
|
|
660 |
/***************************************************************************** |
|
|
661 |
The following PHP script generates a code skeleton for the receiver routine: |
|
|
662 |
|
|
|
663 |
<?php |
|
|
664 |
|
|
|
665 |
function printCmdBuffer($thisBit) |
|
|
666 |
{ |
|
|
667 |
global $cycle; |
|
|
668 |
|
|
|
669 |
$nextBit = ($thisBit + 1) % 8; |
|
|
670 |
$s = ob_get_contents(); |
|
|
671 |
ob_end_clean(); |
|
|
672 |
$s = str_replace("#", $thisBit, $s); |
|
|
673 |
$s = str_replace("@", $nextBit, $s); |
|
|
674 |
$lines = explode("\n", $s); |
|
|
675 |
for($i = 0; $i < count($lines); $i++){ |
|
|
676 |
$s = $lines[$i]; |
|
|
677 |
if(ereg("\\[([0-9-][0-9])\\]", $s, $regs)){ |
|
|
678 |
$c = $cycle + (int)$regs[1]; |
|
|
679 |
$s = ereg_replace("\\[[0-9-][0-9]\\]", sprintf("[%02d]", $c), $s); |
|
|
680 |
} |
|
|
681 |
if(strlen($s) > 0) |
|
|
682 |
echo "$s\n"; |
|
|
683 |
} |
|
|
684 |
} |
|
|
685 |
|
|
|
686 |
function printBit($isAfterSet, $bitNum) |
|
|
687 |
{ |
|
|
688 |
ob_start(); |
|
|
689 |
if($isAfterSet){ |
|
|
690 |
?> |
|
|
691 |
ifioclr USBIN, USBMINUS ;[00] <--- sample |
|
|
692 |
rjmp bit#IsClr ;[01] |
|
|
693 |
andi shift, ~(7 << #) ;[02] |
|
|
694 |
breq unstuff#s ;[03] |
|
|
695 |
in phase, USBIN ;[04] <- phase |
|
|
696 |
rjmp bit@AfterSet ;[05] |
|
|
697 |
unstuff#s: |
|
|
698 |
in phase, USBIN ;[05] <- phase (one cycle too late) |
|
|
699 |
andi fix, ~(1 << #) ;[06] |
|
|
700 |
nop2 ;[-1] |
|
|
701 |
nop2 ;[01] |
|
|
702 |
bit#IsClr: |
|
|
703 |
ifrset phase, USBMINUS ;[03] check phase only if D- changed |
|
|
704 |
lpm ;[04] |
|
|
705 |
in phase, USBIN ;[05] <- phase (one cycle too late) |
|
|
706 |
ori shift, 1 << # ;[06] |
|
|
707 |
<?php |
|
|
708 |
}else{ |
|
|
709 |
?> |
|
|
710 |
ifioset USBIN, USBMINUS ;[00] <--- sample |
|
|
711 |
rjmp bit#IsSet ;[01] |
|
|
712 |
andi shift, ~(7 << #) ;[02] |
|
|
713 |
breq unstuff#c ;[03] |
|
|
714 |
in phase, USBIN ;[04] <- phase |
|
|
715 |
rjmp bit@AfterClr ;[05] |
|
|
716 |
unstuff#c: |
|
|
717 |
in phase, USBIN ;[05] <- phase (one cycle too late) |
|
|
718 |
andi fix, ~(1 << #) ;[06] |
|
|
719 |
nop2 ;[-1] |
|
|
720 |
nop2 ;[01] |
|
|
721 |
bit#IsSet: |
|
|
722 |
ifrclr phase, USBMINUS ;[03] check phase only if D- changed |
|
|
723 |
lpm ;[04] |
|
|
724 |
in phase, USBIN ;[05] <- phase (one cycle too late) |
|
|
725 |
ori shift, 1 << # ;[06] |
|
|
726 |
<?php |
|
|
727 |
} |
|
|
728 |
printCmdBuffer($bitNum); |
|
|
729 |
} |
|
|
730 |
|
|
|
731 |
$bitStartCycles = array(1, 9, 17, 26, 34, 42, 51, 59); |
|
|
732 |
for($i = 0; $i < 16; $i++){ |
|
|
733 |
$bit = $i % 8; |
|
|
734 |
$emitClrCode = ($i + (int)($i / 8)) % 2; |
|
|
735 |
$cycle = $bitStartCycles[$bit]; |
|
|
736 |
if($emitClrCode){ |
|
|
737 |
printf("bit%dAfterClr:\n", $bit); |
|
|
738 |
}else{ |
|
|
739 |
printf("bit%dAfterSet:\n", $bit); |
|
|
740 |
} |
|
|
741 |
ob_start(); |
|
|
742 |
echo " ***** ;[-1]\n"; |
|
|
743 |
printCmdBuffer($bit); |
|
|
744 |
printBit(!$emitClrCode, $bit); |
|
|
745 |
if($i == 7) |
|
|
746 |
echo "\n"; |
|
|
747 |
} |
|
|
748 |
|
|
|
749 |
?> |
|
|
750 |
*****************************************************************************/ |