]>
Commit | Line | Data |
---|---|---|
1 | /** | |
2 | * Copyright (C) 2009 Ubixum, Inc. | |
3 | * | |
4 | * This library is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU Lesser General Public | |
6 | * License as published by the Free Software Foundation; either | |
7 | * version 2.1 of the License, or (at your option) any later version. | |
8 | * | |
9 | * This library is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
12 | * Lesser General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU Lesser General Public | |
15 | * License along with this library; if not, write to the Free Software | |
16 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA | |
17 | **/ | |
18 | ||
19 | ||
20 | ||
21 | ||
22 | #include <eputils.h> | |
23 | ||
24 | #include <fx2regs.h> | |
25 | ||
26 | #ifdef DEBUG_EPUTILS | |
27 | #include <stdio.h> | |
28 | #else | |
29 | #define printf(...) | |
30 | #endif | |
31 | ||
32 | void readep0( BYTE* dst, WORD len) { | |
33 | WORD read = 0; // n bytes read | |
34 | BYTE c,avail; | |
35 | while (read < len) { | |
36 | EP0BCH = 0; | |
37 | // NOTE need syncdelay? | |
38 | EP0BCL = 0; // re-arm ep so host can send more | |
39 | while (EP0CS & bmEPBUSY); | |
40 | avail = EP0BCL; // max size fits in one byte (64 bytes) | |
41 | for (c=0;c<avail;++c) | |
42 | dst[read+c] = EP0BUF[c]; | |
43 | read += avail; | |
44 | } | |
45 | } | |
46 | ||
47 | ||
48 | void writeep0( BYTE* src, WORD len) { | |
49 | WORD written = 0; | |
50 | BYTE c; | |
51 | while ( written < len ) { | |
52 | while ( EP0CS & bmEPBUSY ); // wait | |
53 | for (c=0;c<64 && written<len;++c ) { | |
54 | EP0BUF[c] = src[written++]; | |
55 | } | |
56 | EP0BCH = 0; | |
57 | EP0BCL= c; | |
58 | printf ( "Write %d bytes\n", c ); | |
59 | } | |
60 | } |