| 3471 |
miho |
1 |
/* Name: usbdrvasm.S |
|
|
2 |
* Project: V-USB, virtual USB port for Atmel's(r) AVR(r) microcontrollers |
|
|
3 |
* Author: Christian Starkjohann |
|
|
4 |
* Creation Date: 2007-06-13 |
|
|
5 |
* Tabsize: 4 |
|
|
6 |
* Copyright: (c) 2007 by OBJECTIVE DEVELOPMENT Software GmbH |
|
|
7 |
* License: GNU GPL v2 (see License.txt), GNU GPL v3 or proprietary (CommercialLicense.txt) |
|
|
8 |
* Revision: $Id: usbdrvasm.S 785 2010-05-30 17:57:07Z cs $ |
|
|
9 |
*/ |
|
|
10 |
|
|
|
11 |
/* |
|
|
12 |
General Description: |
|
|
13 |
This module is the assembler part of the USB driver. This file contains |
|
|
14 |
general code (preprocessor acrobatics and CRC computation) and then includes |
|
|
15 |
the file appropriate for the given clock rate. |
|
|
16 |
*/ |
|
|
17 |
|
|
|
18 |
#define __SFR_OFFSET 0 /* used by avr-libc's register definitions */ |
|
|
19 |
#include "usbportability.h" |
|
|
20 |
#include "usbdrv.h" /* for common defs */ |
|
|
21 |
|
|
|
22 |
/* register names */ |
|
|
23 |
#define x1 r16 |
|
|
24 |
#define x2 r17 |
|
|
25 |
#define shift r18 |
|
|
26 |
#define cnt r19 |
|
|
27 |
#define x3 r20 |
|
|
28 |
#define x4 r21 |
|
|
29 |
#define x5 r22 |
|
|
30 |
#define bitcnt x5 |
|
|
31 |
#define phase x4 |
|
|
32 |
#define leap x4 |
|
|
33 |
|
|
|
34 |
/* Some assembler dependent definitions and declarations: */ |
|
|
35 |
|
|
|
36 |
#ifdef __IAR_SYSTEMS_ASM__ |
|
|
37 |
extern usbRxBuf, usbDeviceAddr, usbNewDeviceAddr, usbInputBufOffset |
|
|
38 |
extern usbCurrentTok, usbRxLen, usbRxToken, usbTxLen |
|
|
39 |
extern usbTxBuf, usbTxStatus1, usbTxStatus3 |
|
|
40 |
# if USB_COUNT_SOF |
|
|
41 |
extern usbSofCount |
|
|
42 |
# endif |
|
|
43 |
public usbCrc16 |
|
|
44 |
public usbCrc16Append |
|
|
45 |
|
|
|
46 |
COMMON INTVEC |
|
|
47 |
# ifndef USB_INTR_VECTOR |
|
|
48 |
ORG INT0_vect |
|
|
49 |
# else /* USB_INTR_VECTOR */ |
|
|
50 |
ORG USB_INTR_VECTOR |
|
|
51 |
# undef USB_INTR_VECTOR |
|
|
52 |
# endif /* USB_INTR_VECTOR */ |
|
|
53 |
# define USB_INTR_VECTOR usbInterruptHandler |
|
|
54 |
rjmp USB_INTR_VECTOR |
|
|
55 |
RSEG CODE |
|
|
56 |
|
|
|
57 |
#else /* __IAR_SYSTEMS_ASM__ */ |
|
|
58 |
|
|
|
59 |
# ifndef USB_INTR_VECTOR /* default to hardware interrupt INT0 */ |
|
|
60 |
# ifdef INT0_vect |
|
|
61 |
# define USB_INTR_VECTOR INT0_vect // this is the "new" define for the vector |
|
|
62 |
# else |
|
|
63 |
# define USB_INTR_VECTOR SIG_INTERRUPT0 // this is the "old" vector |
|
|
64 |
# endif |
|
|
65 |
# endif |
|
|
66 |
.text |
|
|
67 |
.global USB_INTR_VECTOR |
|
|
68 |
.type USB_INTR_VECTOR, @function |
|
|
69 |
.global usbCrc16 |
|
|
70 |
.global usbCrc16Append |
|
|
71 |
#endif /* __IAR_SYSTEMS_ASM__ */ |
|
|
72 |
|
|
|
73 |
|
|
|
74 |
#if USB_INTR_PENDING < 0x40 /* This is an I/O address, use in and out */ |
|
|
75 |
# define USB_LOAD_PENDING(reg) in reg, USB_INTR_PENDING |
|
|
76 |
# define USB_STORE_PENDING(reg) out USB_INTR_PENDING, reg |
|
|
77 |
#else /* It's a memory address, use lds and sts */ |
|
|
78 |
# define USB_LOAD_PENDING(reg) lds reg, USB_INTR_PENDING |
|
|
79 |
# define USB_STORE_PENDING(reg) sts USB_INTR_PENDING, reg |
|
|
80 |
#endif |
|
|
81 |
|
|
|
82 |
#define usbTxLen1 usbTxStatus1 |
|
|
83 |
#define usbTxBuf1 (usbTxStatus1 + 1) |
|
|
84 |
#define usbTxLen3 usbTxStatus3 |
|
|
85 |
#define usbTxBuf3 (usbTxStatus3 + 1) |
|
|
86 |
|
|
|
87 |
|
|
|
88 |
;---------------------------------------------------------------------------- |
|
|
89 |
; Utility functions |
|
|
90 |
;---------------------------------------------------------------------------- |
|
|
91 |
|
|
|
92 |
#ifdef __IAR_SYSTEMS_ASM__ |
|
|
93 |
/* Register assignments for usbCrc16 on IAR cc */ |
|
|
94 |
/* Calling conventions on IAR: |
|
|
95 |
* First parameter passed in r16/r17, second in r18/r19 and so on. |
|
|
96 |
* Callee must preserve r4-r15, r24-r29 (r28/r29 is frame pointer) |
|
|
97 |
* Result is passed in r16/r17 |
|
|
98 |
* In case of the "tiny" memory model, pointers are only 8 bit with no |
|
|
99 |
* padding. We therefore pass argument 1 as "16 bit unsigned". |
|
|
100 |
*/ |
|
|
101 |
RTMODEL "__rt_version", "3" |
|
|
102 |
/* The line above will generate an error if cc calling conventions change. |
|
|
103 |
* The value "3" above is valid for IAR 4.10B/W32 |
|
|
104 |
*/ |
|
|
105 |
# define argLen r18 /* argument 2 */ |
|
|
106 |
# define argPtrL r16 /* argument 1 */ |
|
|
107 |
# define argPtrH r17 /* argument 1 */ |
|
|
108 |
|
|
|
109 |
# define resCrcL r16 /* result */ |
|
|
110 |
# define resCrcH r17 /* result */ |
|
|
111 |
|
|
|
112 |
# define ptrL ZL |
|
|
113 |
# define ptrH ZH |
|
|
114 |
# define ptr Z |
|
|
115 |
# define byte r22 |
|
|
116 |
# define bitCnt r19 |
|
|
117 |
# define polyL r20 |
|
|
118 |
# define polyH r21 |
|
|
119 |
# define scratch r23 |
|
|
120 |
|
|
|
121 |
#else /* __IAR_SYSTEMS_ASM__ */ |
|
|
122 |
/* Register assignments for usbCrc16 on gcc */ |
|
|
123 |
/* Calling conventions on gcc: |
|
|
124 |
* First parameter passed in r24/r25, second in r22/23 and so on. |
|
|
125 |
* Callee must preserve r1-r17, r28/r29 |
|
|
126 |
* Result is passed in r24/r25 |
|
|
127 |
*/ |
|
|
128 |
# define argLen r22 /* argument 2 */ |
|
|
129 |
# define argPtrL r24 /* argument 1 */ |
|
|
130 |
# define argPtrH r25 /* argument 1 */ |
|
|
131 |
|
|
|
132 |
# define resCrcL r24 /* result */ |
|
|
133 |
# define resCrcH r25 /* result */ |
|
|
134 |
|
|
|
135 |
# define ptrL XL |
|
|
136 |
# define ptrH XH |
|
|
137 |
# define ptr x |
|
|
138 |
# define byte r18 |
|
|
139 |
# define bitCnt r19 |
|
|
140 |
# define polyL r20 |
|
|
141 |
# define polyH r21 |
|
|
142 |
# define scratch r23 |
|
|
143 |
|
|
|
144 |
#endif |
|
|
145 |
|
|
|
146 |
#if USB_USE_FAST_CRC |
|
|
147 |
|
|
|
148 |
; This implementation is faster, but has bigger code size |
|
|
149 |
; Thanks to Slawomir Fras (BoskiDialer) for this code! |
|
|
150 |
; It implements the following C pseudo-code: |
|
|
151 |
; unsigned table(unsigned char x) |
|
|
152 |
; { |
|
|
153 |
; unsigned value; |
|
|
154 |
; |
|
|
155 |
; value = (unsigned)x << 6; |
|
|
156 |
; value ^= (unsigned)x << 7; |
|
|
157 |
; if(parity(x)) |
|
|
158 |
; value ^= 0xc001; |
|
|
159 |
; return value; |
|
|
160 |
; } |
|
|
161 |
; unsigned usbCrc16(unsigned char *argPtr, unsigned char argLen) |
|
|
162 |
; { |
|
|
163 |
; unsigned crc = 0xffff; |
|
|
164 |
; |
|
|
165 |
; while(argLen--) |
|
|
166 |
; crc = table(lo8(crc) ^ *argPtr++) ^ hi8(crc); |
|
|
167 |
; return ~crc; |
|
|
168 |
; } |
|
|
169 |
|
|
|
170 |
; extern unsigned usbCrc16(unsigned char *argPtr, unsigned char argLen); |
|
|
171 |
; argPtr r24+25 / r16+r17 |
|
|
172 |
; argLen r22 / r18 |
|
|
173 |
; temp variables: |
|
|
174 |
; byte r18 / r22 |
|
|
175 |
; scratch r23 |
|
|
176 |
; resCrc r24+r25 / r16+r17 |
|
|
177 |
; ptr X / Z |
|
|
178 |
usbCrc16: |
|
|
179 |
mov ptrL, argPtrL |
|
|
180 |
mov ptrH, argPtrH |
|
|
181 |
ldi resCrcL, 0xFF |
|
|
182 |
ldi resCrcH, 0xFF |
|
|
183 |
rjmp usbCrc16LoopTest |
|
|
184 |
usbCrc16ByteLoop: |
|
|
185 |
ld byte, ptr+ |
|
|
186 |
eor resCrcL, byte ; resCrcL is now 'x' in table() |
|
|
187 |
mov byte, resCrcL ; compute parity of 'x' |
|
|
188 |
swap byte |
|
|
189 |
eor byte, resCrcL |
|
|
190 |
mov scratch, byte |
|
|
191 |
lsr byte |
|
|
192 |
lsr byte |
|
|
193 |
eor byte, scratch |
|
|
194 |
inc byte |
|
|
195 |
lsr byte |
|
|
196 |
andi byte, 1 ; byte is now parity(x) |
|
|
197 |
mov scratch, resCrcL |
|
|
198 |
mov resCrcL, resCrcH |
|
|
199 |
eor resCrcL, byte ; low byte of if(parity(x)) value ^= 0xc001; |
|
|
200 |
neg byte |
|
|
201 |
andi byte, 0xc0 |
|
|
202 |
mov resCrcH, byte ; high byte of if(parity(x)) value ^= 0xc001; |
|
|
203 |
clr byte |
|
|
204 |
lsr scratch |
|
|
205 |
ror byte |
|
|
206 |
eor resCrcH, scratch |
|
|
207 |
eor resCrcL, byte |
|
|
208 |
lsr scratch |
|
|
209 |
ror byte |
|
|
210 |
eor resCrcH, scratch |
|
|
211 |
eor resCrcL, byte |
|
|
212 |
usbCrc16LoopTest: |
|
|
213 |
subi argLen, 1 |
|
|
214 |
brsh usbCrc16ByteLoop |
|
|
215 |
com resCrcL |
|
|
216 |
com resCrcH |
|
|
217 |
ret |
|
|
218 |
|
|
|
219 |
#else /* USB_USE_FAST_CRC */ |
|
|
220 |
|
|
|
221 |
; This implementation is slower, but has less code size |
|
|
222 |
; |
|
|
223 |
; extern unsigned usbCrc16(unsigned char *argPtr, unsigned char argLen); |
|
|
224 |
; argPtr r24+25 / r16+r17 |
|
|
225 |
; argLen r22 / r18 |
|
|
226 |
; temp variables: |
|
|
227 |
; byte r18 / r22 |
|
|
228 |
; bitCnt r19 |
|
|
229 |
; poly r20+r21 |
|
|
230 |
; scratch r23 |
|
|
231 |
; resCrc r24+r25 / r16+r17 |
|
|
232 |
; ptr X / Z |
|
|
233 |
usbCrc16: |
|
|
234 |
mov ptrL, argPtrL |
|
|
235 |
mov ptrH, argPtrH |
|
|
236 |
ldi resCrcL, 0 |
|
|
237 |
ldi resCrcH, 0 |
|
|
238 |
ldi polyL, lo8(0xa001) |
|
|
239 |
ldi polyH, hi8(0xa001) |
|
|
240 |
com argLen ; argLen = -argLen - 1: modified loop to ensure that carry is set |
|
|
241 |
ldi bitCnt, 0 ; loop counter with starnd condition = end condition |
|
|
242 |
rjmp usbCrcLoopEntry |
|
|
243 |
usbCrcByteLoop: |
|
|
244 |
ld byte, ptr+ |
|
|
245 |
eor resCrcL, byte |
|
|
246 |
usbCrcBitLoop: |
|
|
247 |
ror resCrcH ; carry is always set here (see brcs jumps to here) |
|
|
248 |
ror resCrcL |
|
|
249 |
brcs usbCrcNoXor |
|
|
250 |
eor resCrcL, polyL |
|
|
251 |
eor resCrcH, polyH |
|
|
252 |
usbCrcNoXor: |
|
|
253 |
subi bitCnt, 224 ; (8 * 224) % 256 = 0; this loop iterates 8 times |
|
|
254 |
brcs usbCrcBitLoop |
|
|
255 |
usbCrcLoopEntry: |
|
|
256 |
subi argLen, -1 |
|
|
257 |
brcs usbCrcByteLoop |
|
|
258 |
usbCrcReady: |
|
|
259 |
ret |
|
|
260 |
; Thanks to Reimar Doeffinger for optimizing this CRC routine! |
|
|
261 |
|
|
|
262 |
#endif /* USB_USE_FAST_CRC */ |
|
|
263 |
|
|
|
264 |
; extern unsigned usbCrc16Append(unsigned char *data, unsigned char len); |
|
|
265 |
usbCrc16Append: |
|
|
266 |
rcall usbCrc16 |
|
|
267 |
st ptr+, resCrcL |
|
|
268 |
st ptr+, resCrcH |
|
|
269 |
ret |
|
|
270 |
|
|
|
271 |
#undef argLen |
|
|
272 |
#undef argPtrL |
|
|
273 |
#undef argPtrH |
|
|
274 |
#undef resCrcL |
|
|
275 |
#undef resCrcH |
|
|
276 |
#undef ptrL |
|
|
277 |
#undef ptrH |
|
|
278 |
#undef ptr |
|
|
279 |
#undef byte |
|
|
280 |
#undef bitCnt |
|
|
281 |
#undef polyL |
|
|
282 |
#undef polyH |
|
|
283 |
#undef scratch |
|
|
284 |
|
|
|
285 |
|
|
|
286 |
#if USB_CFG_HAVE_MEASURE_FRAME_LENGTH |
|
|
287 |
#ifdef __IAR_SYSTEMS_ASM__ |
|
|
288 |
/* Register assignments for usbMeasureFrameLength on IAR cc */ |
|
|
289 |
/* Calling conventions on IAR: |
|
|
290 |
* First parameter passed in r16/r17, second in r18/r19 and so on. |
|
|
291 |
* Callee must preserve r4-r15, r24-r29 (r28/r29 is frame pointer) |
|
|
292 |
* Result is passed in r16/r17 |
|
|
293 |
* In case of the "tiny" memory model, pointers are only 8 bit with no |
|
|
294 |
* padding. We therefore pass argument 1 as "16 bit unsigned". |
|
|
295 |
*/ |
|
|
296 |
# define resL r16 |
|
|
297 |
# define resH r17 |
|
|
298 |
# define cnt16L r30 |
|
|
299 |
# define cnt16H r31 |
|
|
300 |
# define cntH r18 |
|
|
301 |
|
|
|
302 |
#else /* __IAR_SYSTEMS_ASM__ */ |
|
|
303 |
/* Register assignments for usbMeasureFrameLength on gcc */ |
|
|
304 |
/* Calling conventions on gcc: |
|
|
305 |
* First parameter passed in r24/r25, second in r22/23 and so on. |
|
|
306 |
* Callee must preserve r1-r17, r28/r29 |
|
|
307 |
* Result is passed in r24/r25 |
|
|
308 |
*/ |
|
|
309 |
# define resL r24 |
|
|
310 |
# define resH r25 |
|
|
311 |
# define cnt16L r24 |
|
|
312 |
# define cnt16H r25 |
|
|
313 |
# define cntH r26 |
|
|
314 |
#endif |
|
|
315 |
# define cnt16 cnt16L |
|
|
316 |
|
|
|
317 |
; extern unsigned usbMeasurePacketLength(void); |
|
|
318 |
; returns time between two idle strobes in multiples of 7 CPU clocks |
|
|
319 |
.global usbMeasureFrameLength |
|
|
320 |
usbMeasureFrameLength: |
|
|
321 |
ldi cntH, 6 ; wait ~ 10 ms for D- == 0 |
|
|
322 |
clr cnt16L |
|
|
323 |
clr cnt16H |
|
|
324 |
usbMFTime16: |
|
|
325 |
dec cntH |
|
|
326 |
breq usbMFTimeout |
|
|
327 |
usbMFWaitStrobe: ; first wait for D- == 0 (idle strobe) |
|
|
328 |
sbiw cnt16, 1 ;[0] [6] |
|
|
329 |
breq usbMFTime16 ;[2] |
|
|
330 |
sbic USBIN, USBMINUS ;[3] |
|
|
331 |
rjmp usbMFWaitStrobe ;[4] |
|
|
332 |
usbMFWaitIdle: ; then wait until idle again |
|
|
333 |
sbis USBIN, USBMINUS ;1 wait for D- == 1 |
|
|
334 |
rjmp usbMFWaitIdle ;2 |
|
|
335 |
ldi cnt16L, 1 ;1 represents cycles so far |
|
|
336 |
clr cnt16H ;1 |
|
|
337 |
usbMFWaitLoop: |
|
|
338 |
in cntH, USBIN ;[0] [7] |
|
|
339 |
adiw cnt16, 1 ;[1] |
|
|
340 |
breq usbMFTimeout ;[3] |
|
|
341 |
andi cntH, USBMASK ;[4] |
|
|
342 |
brne usbMFWaitLoop ;[5] |
|
|
343 |
usbMFTimeout: |
|
|
344 |
#if resL != cnt16L |
|
|
345 |
mov resL, cnt16L |
|
|
346 |
mov resH, cnt16H |
|
|
347 |
#endif |
|
|
348 |
ret |
|
|
349 |
|
|
|
350 |
#undef resL |
|
|
351 |
#undef resH |
|
|
352 |
#undef cnt16 |
|
|
353 |
#undef cnt16L |
|
|
354 |
#undef cnt16H |
|
|
355 |
#undef cntH |
|
|
356 |
|
|
|
357 |
#endif /* USB_CFG_HAVE_MEASURE_FRAME_LENGTH */ |
|
|
358 |
|
|
|
359 |
;---------------------------------------------------------------------------- |
|
|
360 |
; Now include the clock rate specific code |
|
|
361 |
;---------------------------------------------------------------------------- |
|
|
362 |
|
|
|
363 |
#ifndef USB_CFG_CLOCK_KHZ |
|
|
364 |
# ifdef F_CPU |
|
|
365 |
# define USB_CFG_CLOCK_KHZ (F_CPU/1000) |
|
|
366 |
# else |
|
|
367 |
# error "USB_CFG_CLOCK_KHZ not defined in usbconfig.h and no F_CPU set!" |
|
|
368 |
# endif |
|
|
369 |
#endif |
|
|
370 |
|
|
|
371 |
#if USB_CFG_CHECK_CRC /* separate dispatcher for CRC type modules */ |
|
|
372 |
# if USB_CFG_CLOCK_KHZ == 18000 |
|
|
373 |
# include "usbdrvasm18-crc.inc" |
|
|
374 |
# else |
|
|
375 |
# error "USB_CFG_CLOCK_KHZ is not one of the supported crc-rates!" |
|
|
376 |
# endif |
|
|
377 |
#else /* USB_CFG_CHECK_CRC */ |
|
|
378 |
# if USB_CFG_CLOCK_KHZ == 12000 |
|
|
379 |
# include "usbdrvasm12.inc" |
|
|
380 |
# elif USB_CFG_CLOCK_KHZ == 12800 |
|
|
381 |
# include "usbdrvasm128.inc" |
|
|
382 |
# elif USB_CFG_CLOCK_KHZ == 15000 |
|
|
383 |
# include "usbdrvasm15.inc" |
|
|
384 |
# elif USB_CFG_CLOCK_KHZ == 16000 |
|
|
385 |
# include "usbdrvasm16.inc" |
|
|
386 |
# elif USB_CFG_CLOCK_KHZ == 16500 |
|
|
387 |
# include "usbdrvasm165.inc" |
|
|
388 |
# elif USB_CFG_CLOCK_KHZ == 20000 |
|
|
389 |
# include "usbdrvasm20.inc" |
|
|
390 |
# else |
|
|
391 |
# error "USB_CFG_CLOCK_KHZ is not one of the supported non-crc-rates!" |
|
|
392 |
# endif |
|
|
393 |
#endif /* USB_CFG_CHECK_CRC */ |