]>
Commit | Line | Data |
---|---|---|
3608c106 UH |
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 | #include <stdio.h> | |
19 | ||
20 | #include <fx2regs.h> | |
21 | #include <fx2macros.h> | |
22 | #include <serial.h> | |
23 | #include <delay.h> | |
24 | #include <autovector.h> | |
25 | #include <lights.h> | |
26 | #include <setupdat.h> | |
27 | #include <eputils.h> | |
28 | ||
29 | ||
30 | #define SYNCDELAY() SYNCDELAY4 | |
31 | #define REARMVAL 0x80 | |
32 | #define REARM() EP2BCL=REARMVAL | |
33 | ||
34 | ||
35 | ||
36 | volatile WORD bytes; | |
37 | volatile bit gotbuf; | |
38 | volatile BYTE icount; | |
39 | volatile bit got_sud; | |
40 | DWORD lcount; | |
41 | bit on; | |
42 | ||
43 | void main() { | |
44 | ||
45 | REVCTL=0; // not using advanced endpoint controls | |
46 | ||
47 | d2off(); | |
48 | on=0; | |
49 | lcount=0; | |
50 | got_sud=FALSE; | |
51 | icount=0; | |
52 | gotbuf=FALSE; | |
53 | bytes=0; | |
54 | ||
55 | // renumerate | |
56 | RENUMERATE_UNCOND(); | |
57 | ||
58 | ||
59 | SETCPUFREQ(CLK_48M); | |
60 | SETIF48MHZ(); | |
61 | sio0_init(57600); | |
62 | ||
63 | ||
64 | USE_USB_INTS(); | |
65 | ENABLE_SUDAV(); | |
66 | ENABLE_SOF(); | |
67 | ENABLE_HISPEED(); | |
68 | ENABLE_USBRESET(); | |
69 | ||
70 | ||
71 | // only valid endpoints are 2/6 | |
72 | EP2CFG = 0xA2; // 10100010 | |
73 | SYNCDELAY(); | |
74 | EP6CFG = 0xE2; // 11100010 | |
75 | SYNCDELAY(); | |
76 | EP1INCFG &= ~bmVALID; | |
77 | SYNCDELAY(); | |
78 | EP1OUTCFG &= ~bmVALID; | |
79 | SYNCDELAY(); | |
80 | EP4CFG &= ~bmVALID; | |
81 | SYNCDELAY(); | |
82 | EP8CFG &= ~bmVALID; | |
83 | SYNCDELAY(); | |
84 | ||
85 | ||
86 | // arm ep2 | |
87 | EP2BCL = 0x80; // write once | |
88 | SYNCDELAY(); | |
89 | EP2BCL = 0x80; // do it again | |
90 | ||
91 | ||
92 | // make it so we enumberate | |
93 | ||
94 | ||
95 | EA=1; // global interrupt enable | |
96 | printf ( "Done initializing stuff\n" ); | |
97 | ||
98 | ||
99 | d3off(); | |
100 | ||
101 | while(TRUE) { | |
102 | ||
103 | if ( got_sud ) { | |
104 | printf ( "Handle setupdata\n" ); | |
105 | handle_setupdata(); | |
106 | got_sud=FALSE; | |
107 | } | |
108 | ||
109 | if ( !(EP2468STAT & bmEP2EMPTY) ) { | |
110 | printf ( "ep2 out received data\n" ); | |
111 | if ( !(EP2468STAT & bmEP6FULL) ) { // wait for at least one empty in buffer | |
112 | WORD i; | |
113 | printf ( "Sending data to ep6 in\n"); | |
114 | ||
115 | bytes = MAKEWORD(EP2BCH,EP2BCL); | |
116 | ||
117 | for (i=0;i<bytes;++i) EP6FIFOBUF[i] = EP2FIFOBUF[i]; | |
118 | ||
119 | // can copy whole string w/ autoptr instead. | |
120 | // or copy directly from one buf to another | |
121 | ||
122 | // ARM ep6 out | |
123 | EP6BCH=MSB(bytes); | |
124 | SYNCDELAY(); | |
125 | EP6BCL=LSB(bytes); | |
126 | ||
127 | REARM(); // ep2 | |
128 | //printf ( "Re-Armed ep2\n" ); | |
129 | ||
130 | } | |
131 | } | |
132 | } | |
133 | ||
134 | } | |
135 | ||
136 | // copied routines from setupdat.h | |
137 | ||
138 | // value (low byte) = ep | |
139 | #define VC_EPSTAT 0xB1 | |
140 | ||
141 | BOOL handle_vendorcommand(BYTE cmd) { | |
142 | ||
143 | switch ( cmd ) { | |
144 | ||
145 | case VC_EPSTAT: | |
146 | { | |
147 | xdata BYTE* pep= ep_addr(SETUPDAT[2]); | |
148 | printf ( "ep %02x\n" , *pep ); | |
149 | if (pep) { | |
150 | EP0BUF[0] = *pep; | |
151 | EP0BCH=0; | |
152 | EP0BCL=1; | |
153 | return TRUE; | |
154 | } | |
155 | } | |
156 | default: | |
157 | printf ( "Need to implement vendor command: %02x\n", cmd ); | |
158 | } | |
159 | return FALSE; | |
160 | } | |
161 | ||
162 | // this firmware only supports 0,0 | |
163 | BOOL handle_get_interface(BYTE ifc, BYTE* alt_ifc) { | |
164 | printf ( "Get Interface\n" ); | |
165 | if (ifc==0) {*alt_ifc=0; return TRUE;} else { return FALSE;} | |
166 | } | |
167 | BOOL handle_set_interface(BYTE ifc, BYTE alt_ifc) { | |
168 | printf ( "Set interface %d to alt: %d\n" , ifc, alt_ifc ); | |
169 | ||
170 | if (ifc==0&&alt_ifc==0) { | |
171 | // SEE TRM 2.3.7 | |
172 | // reset toggles | |
173 | RESETTOGGLE(0x02); | |
174 | RESETTOGGLE(0x86); | |
175 | // restore endpoints to default condition | |
176 | RESETFIFO(0x02); | |
177 | EP2BCL=0x80; | |
178 | SYNCDELAY(); | |
179 | EP2BCL=0X80; | |
180 | SYNCDELAY(); | |
181 | RESETFIFO(0x86); | |
182 | return TRUE; | |
183 | } else | |
184 | return FALSE; | |
185 | } | |
186 | ||
187 | // get/set configuration | |
188 | BYTE handle_get_configuration() { | |
189 | return 1; | |
190 | } | |
191 | BOOL handle_set_configuration(BYTE cfg) { | |
192 | return cfg==1 ? TRUE : FALSE; // we only handle cfg 1 | |
193 | } | |
194 | ||
195 | ||
196 | // copied usb jt routines from usbjt.h | |
197 | void sudav_isr() interrupt SUDAV_ISR { | |
198 | ||
199 | got_sud=TRUE; | |
200 | CLEAR_SUDAV(); | |
201 | } | |
202 | ||
203 | bit on5; | |
204 | xdata WORD sofct=0; | |
205 | void sof_isr () interrupt SOF_ISR using 1 { | |
206 | ++sofct; | |
207 | if(sofct==8000) { // about 8000 sof interrupts per second at high speed | |
208 | on5=!on5; | |
209 | if (on5) {d5on();} else {d5off();} | |
210 | sofct=0; | |
211 | } | |
212 | CLEAR_SOF(); | |
213 | } | |
214 | ||
215 | void usbreset_isr() interrupt USBRESET_ISR { | |
216 | handle_hispeed(FALSE); | |
217 | CLEAR_USBRESET(); | |
218 | } | |
219 | void hispeed_isr() interrupt HISPEED_ISR { | |
220 | handle_hispeed(TRUE); | |
221 | CLEAR_HISPEED(); | |
222 | } | |
223 |