Rev 5363 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
4985 | gtament | 1 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
2 | ;; ;; |
||
5363 | yogev_ezra | 3 | ;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;; |
4985 | gtament | 4 | ;; Distributed under terms of the GNU General Public License ;; |
5 | ;; ;; |
||
5035 | gtament | 6 | ;; FTDI chips driver for KolibriOS ;; |
7 | ;; ;; |
||
8 | ;; Written by gtament@gmail.com ;; |
||
9 | ;; ;; |
||
10 | ;; GNU GENERAL PUBLIC LICENSE ;; |
||
11 | ;; Version 2, June 1991 ;; |
||
12 | ;; ;; |
||
4985 | gtament | 13 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
14 | |||
5087 | gtament | 15 | format PE DLL native 0.05 |
7552 | b00bl1k | 16 | entry START |
4975 | gtament | 17 | |
18 | DEBUG = 1 |
||
19 | |||
20 | __DEBUG__ = 1 |
||
21 | __DEBUG_LEVEL__ = 1 |
||
22 | |||
4997 | gtament | 23 | node equ ftdi_context |
24 | node.next equ ftdi_context.next_context |
||
25 | |||
5038 | gtament | 26 | include '../../proc32.inc' |
5087 | gtament | 27 | include '../../peimport.inc' |
5038 | gtament | 28 | include '../../fdo.inc' |
29 | include '../../struct.inc' |
||
4975 | gtament | 30 | |
31 | ; USB constants |
||
32 | DEVICE_DESCR_TYPE = 1 |
||
33 | CONFIG_DESCR_TYPE = 2 |
||
34 | STRING_DESCR_TYPE = 3 |
||
35 | INTERFACE_DESCR_TYPE = 4 |
||
36 | ENDPOINT_DESCR_TYPE = 5 |
||
37 | DEVICE_QUALIFIER_DESCR_TYPE = 6 |
||
38 | |||
39 | CONTROL_PIPE = 0 |
||
40 | ISOCHRONOUS_PIPE = 1 |
||
41 | BULK_PIPE = 2 |
||
42 | INTERRUPT_PIPE = 3 |
||
43 | |||
44 | ; USB HID constants |
||
45 | HID_DESCR_TYPE = 21h |
||
46 | REPORT_DESCR_TYPE = 22h |
||
47 | PHYSICAL_DESCR_TYPE = 23h |
||
48 | |||
49 | ; LibUSB constatnts |
||
50 | LIBUSB_REQUEST_TYPE_STANDARD = (0x00 shl 5) |
||
51 | LIBUSB_REQUEST_TYPE_CLASS = (0x01 shl 5) |
||
52 | LIBUSB_REQUEST_TYPE_VENDOR = (0x02 shl 5) |
||
53 | LIBUSB_REQUEST_TYPE_RESERVED = (0x03 shl 5) |
||
54 | |||
55 | LIBUSB_RECIPIENT_DEVICE = 0x00 |
||
56 | LIBUSB_RECIPIENT_INTERFACE = 0x01 |
||
57 | LIBUSB_RECIPIENT_ENDPOINT = 0x02 |
||
58 | LIBUSB_RECIPIENT_OTHER = 0x03 |
||
59 | |||
60 | LIBUSB_ENDPOINT_IN = 0x80 |
||
61 | LIBUSB_ENDPOINT_OUT = 0x00 |
||
62 | |||
63 | ; FTDI Constants |
||
64 | FTDI_DEVICE_OUT_REQTYPE = (LIBUSB_REQUEST_TYPE_VENDOR or LIBUSB_RECIPIENT_DEVICE or LIBUSB_ENDPOINT_OUT) |
||
65 | FTDI_DEVICE_IN_REQTYPE = (LIBUSB_REQUEST_TYPE_VENDOR or LIBUSB_RECIPIENT_DEVICE or LIBUSB_ENDPOINT_IN) |
||
66 | |||
67 | ; Requests |
||
68 | ;Definitions for flow control |
||
69 | SIO_RESET =0 ;Reset the port |
||
70 | SIO_MODEM_CTRL =1 ;Set the modem control register |
||
71 | SIO_SET_FLOW_CTRL =2 ;Set flow control register |
||
72 | SIO_SET_BAUD_RATE =3 ;Set baud rate |
||
73 | SIO_SET_DATA =4 ;Set the data characteristics of the port |
||
74 | |||
75 | SIO_RESET_REQUEST =SIO_RESET |
||
76 | SIO_SET_BAUDRATE_REQUEST =SIO_SET_BAUD_RATE |
||
77 | SIO_SET_DATA_REQUEST =SIO_SET_DATA |
||
78 | SIO_SET_FLOW_CTRL_REQUEST =SIO_SET_FLOW_CTRL |
||
79 | SIO_SET_MODEM_CTRL_REQUEST =SIO_MODEM_CTRL |
||
80 | SIO_POLL_MODEM_STATUS_REQUEST=0x05 |
||
81 | SIO_SET_EVENT_CHAR_REQUEST =0x06 |
||
82 | SIO_SET_ERROR_CHAR_REQUEST =0x07 |
||
83 | SIO_SET_LATENCY_TIMER_REQUEST=0x09 |
||
84 | SIO_GET_LATENCY_TIMER_REQUEST=0x0A |
||
85 | SIO_SET_BITMODE_REQUEST =0x0B |
||
86 | SIO_READ_PINS_REQUEST =0x0C |
||
87 | SIO_READ_EEPROM_REQUEST =0x90 |
||
88 | SIO_WRITE_EEPROM_REQUEST =0x91 |
||
89 | SIO_ERASE_EEPROM_REQUEST =0x92 |
||
90 | |||
91 | |||
92 | SIO_RESET_SIO=0 |
||
93 | SIO_RESET_PURGE_RX=1 |
||
94 | SIO_RESET_PURGE_TX=2 |
||
95 | |||
96 | SIO_DISABLE_FLOW_CTRL=0x0 |
||
97 | SIO_RTS_CTS_HS =(0x1 shl 8) |
||
98 | SIO_DTR_DSR_HS =(0x2 shl 8) |
||
99 | SIO_XON_XOFF_HS=(0x4 shl 8) |
||
100 | |||
101 | SIO_SET_DTR_MASK=0x1 |
||
102 | SIO_SET_DTR_HIGH=( 1 or ( SIO_SET_DTR_MASK shl 8)) |
||
103 | SIO_SET_DTR_LOW =( 0 or ( SIO_SET_DTR_MASK shl 8)) |
||
104 | SIO_SET_RTS_MASK=0x2 |
||
105 | SIO_SET_RTS_HIGH=( 2 or ( SIO_SET_RTS_MASK shl 8 )) |
||
106 | SIO_SET_RTS_LOW =( 0 or ( SIO_SET_RTS_MASK shl 8 )) |
||
107 | |||
108 | SIO_RTS_CTS_HS =(0x1 shl 8) |
||
109 | |||
4992 | gtament | 110 | ;FTDI chip type |
111 | TYPE_AM=0 |
||
112 | TYPE_BM=1 |
||
113 | TYPE_2232C=2 |
||
114 | TYPE_R=3 |
||
115 | TYPE_2232H=4 |
||
116 | TYPE_4232H=5 |
||
117 | TYPE_232H=6 |
||
118 | TYPE_230X=7 |
||
119 | |||
4975 | gtament | 120 | ;strings |
121 | my_driver db 'usbother',0 |
||
122 | nomemory_msg db 'K : no memory',13,10,0 |
||
123 | |||
124 | ; Structures |
||
125 | struct ftdi_context |
||
126 | chipType db ? |
||
127 | baudrate dd ? |
||
128 | bitbangEnabled db ? |
||
129 | readBufChunkSize dd ? |
||
130 | writeBufChunkSize dd ? |
||
5023 | gtament | 131 | readBufPtr dd ? |
132 | writeBufPtr dd ? |
||
133 | readBufSize dd ? |
||
134 | writeBufSize dd ? |
||
5018 | gtament | 135 | maxPacketSize dd ? |
4975 | gtament | 136 | interface dd ? |
137 | index dd ? |
||
138 | inEP dd ? |
||
139 | outEP dd ? |
||
140 | nullP dd ? |
||
4997 | gtament | 141 | lockPID dd ? |
4975 | gtament | 142 | next_context dd ? |
143 | ends |
||
144 | |||
145 | struct IOCTL |
||
146 | handle dd ? |
||
147 | io_code dd ? |
||
148 | input dd ? |
||
149 | inp_size dd ? |
||
150 | output dd ? |
||
151 | out_size dd ? |
||
152 | ends |
||
153 | |||
154 | struct usb_descr |
||
4979 | gtament | 155 | bLength db ? |
156 | bDescriptorType db ? |
||
4975 | gtament | 157 | bcdUSB dw ? |
158 | bDeviceClass db ? |
||
159 | bDeviceSubClass db ? |
||
160 | bDeviceProtocol db ? |
||
161 | bMaxPacketSize0 db ? |
||
162 | idVendor dw ? |
||
163 | idProduct dw ? |
||
164 | bcdDevice dw ? |
||
165 | iManufacturer db ? |
||
166 | iProduct db ? |
||
167 | iSerialNumber db ? |
||
168 | bNumConfigurations db ? |
||
169 | ends |
||
170 | |||
4979 | gtament | 171 | struct conf_packet |
172 | bmRequestType db ? |
||
173 | bRequest db ? |
||
174 | wValue dw ? |
||
175 | wIndex dw ? |
||
176 | wLength dw ? |
||
177 | ends |
||
178 | |||
5087 | gtament | 179 | section '.flat' code readable executable |
4975 | gtament | 180 | ; The start procedure. |
5087 | gtament | 181 | proc START c, .reason:DWORD, .cmdline:DWORD |
4975 | gtament | 182 | |
183 | xor eax, eax ; initialize return value |
||
184 | cmp [.reason], 1 ; compare the argument |
||
185 | jnz .nothing |
||
5087 | gtament | 186 | invoke RegUSBDriver, my_driver, service_proc, usb_functions |
4975 | gtament | 187 | |
188 | .nothing: |
||
4979 | gtament | 189 | ret |
4975 | gtament | 190 | endp |
191 | |||
192 | |||
5018 | gtament | 193 | proc AddDevice stdcall uses ebx esi edi, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD |
4975 | gtament | 194 | |
5087 | gtament | 195 | invoke USBGetParam, [.config_pipe], 0 |
4997 | gtament | 196 | mov edx, eax |
5087 | gtament | 197 | DEBUGF 2,'K : Detected device vendor: 0x%x\n', [eax+usb_descr.idVendor] |
4979 | gtament | 198 | cmp word[eax+usb_descr.idVendor], 0x0403 |
4975 | gtament | 199 | jnz .notftdi |
5023 | gtament | 200 | mov eax, sizeof.ftdi_context |
5087 | gtament | 201 | invoke Kmalloc |
4975 | gtament | 202 | test eax, eax |
203 | jnz @f |
||
204 | mov esi, nomemory_msg |
||
5087 | gtament | 205 | invoke SysMsgBoardStr |
4975 | gtament | 206 | jmp .nothing |
4997 | gtament | 207 | @@: |
5087 | gtament | 208 | DEBUGF 2,'K : Adding struct to list 0x%x\n', eax |
4997 | gtament | 209 | call linkedlist_add |
4975 | gtament | 210 | |
211 | mov ebx, [.config_pipe] |
||
212 | mov [eax + ftdi_context.nullP], ebx |
||
4992 | gtament | 213 | mov [eax + ftdi_context.index], 0 |
4997 | gtament | 214 | mov [eax + ftdi_context.lockPID], 0 |
5018 | gtament | 215 | mov [eax + ftdi_context.maxPacketSize], 64 |
5014 | gtament | 216 | mov [eax + ftdi_context.readBufChunkSize], 64 |
217 | mov [eax + ftdi_context.writeBufChunkSize], 64 |
||
5023 | gtament | 218 | |
219 | mov [eax + ftdi_context.chipType], TYPE_R |
||
220 | jmp .slow |
||
4975 | gtament | 221 | |
5018 | gtament | 222 | mov cx, [edx+usb_descr.bcdDevice] |
5087 | gtament | 223 | DEBUGF 2, 'K : Chip type 0x%x\n', ecx |
5018 | gtament | 224 | cmp cx, 0x400 |
4997 | gtament | 225 | jnz @f |
226 | mov [eax + ftdi_context.chipType], TYPE_BM |
||
5018 | gtament | 227 | jmp .slow |
4997 | gtament | 228 | @@: |
5018 | gtament | 229 | cmp cx, 0x200 |
4997 | gtament | 230 | jnz @f |
231 | mov [eax + ftdi_context.chipType], TYPE_AM |
||
5018 | gtament | 232 | jmp .slow |
4997 | gtament | 233 | @@: |
5018 | gtament | 234 | cmp cx, 0x500 |
4997 | gtament | 235 | jnz @f |
5018 | gtament | 236 | mov [eax + ftdi_context.chipType], TYPE_2232C |
237 | jmp .slow |
||
4997 | gtament | 238 | @@: |
5018 | gtament | 239 | cmp cx, 0x600 |
4997 | gtament | 240 | jnz @f |
241 | mov [eax + ftdi_context.chipType], TYPE_R |
||
5018 | gtament | 242 | jmp .slow |
4997 | gtament | 243 | @@: |
5018 | gtament | 244 | cmp cx, 0x700 |
4997 | gtament | 245 | jnz @f |
246 | mov [eax + ftdi_context.chipType], TYPE_2232H |
||
5018 | gtament | 247 | jmp .fast |
4997 | gtament | 248 | @@: |
5018 | gtament | 249 | cmp cx, 0x900 |
4997 | gtament | 250 | jnz @f |
251 | mov [eax + ftdi_context.chipType], TYPE_232H |
||
5018 | gtament | 252 | jmp .fast |
4997 | gtament | 253 | @@: |
5018 | gtament | 254 | cmp cx, 0x1000 |
255 | jnz .slow |
||
256 | mov [eax + ftdi_context.chipType], TYPE_230X |
||
257 | jmp .fast |
||
258 | |||
259 | .fast: |
||
260 | add [eax + ftdi_context.maxPacketSize], 512-64 |
||
261 | .slow: |
||
4975 | gtament | 262 | mov ebx, eax |
5087 | gtament | 263 | invoke USBOpenPipe, [.config_pipe], 0x81, \ |
264 | [ebx + ftdi_context.maxPacketSize], BULK_PIPE, 0 |
||
5018 | gtament | 265 | test eax, eax |
266 | jz .nothing |
||
5020 | gtament | 267 | mov [ebx + ftdi_context.outEP], eax |
5087 | gtament | 268 | invoke USBOpenPipe, [.config_pipe], 0x02, \ |
269 | [ebx + ftdi_context.maxPacketSize], BULK_PIPE, 0 |
||
5018 | gtament | 270 | test eax, eax |
271 | jz .nothing |
||
5020 | gtament | 272 | mov [ebx + ftdi_context.inEP], eax |
5014 | gtament | 273 | mov eax, ebx |
274 | ret |
||
4997 | gtament | 275 | |
4975 | gtament | 276 | .notftdi: |
277 | DEBUGF 1,'K : Skipping not FTDI device\n' |
||
4997 | gtament | 278 | .nothing: |
4975 | gtament | 279 | xor eax, eax |
280 | ret |
||
281 | endp |
||
282 | |||
283 | |||
284 | handle equ IOCTL.handle |
||
285 | io_code equ IOCTL.io_code |
||
286 | input equ IOCTL.input |
||
287 | inp_size equ IOCTL.inp_size |
||
288 | output equ IOCTL.output |
||
289 | out_size equ IOCTL.out_size |
||
290 | |||
291 | proc service_proc stdcall uses ebx esi edi, ioctl:DWORD |
||
292 | locals |
||
5042 | gtament | 293 | ConfPacket rb 10 |
5014 | gtament | 294 | EventData rd 3 |
4975 | gtament | 295 | endl |
4979 | gtament | 296 | mov edi, [ioctl] |
4997 | gtament | 297 | mov eax, [edi+io_code] |
4975 | gtament | 298 | DEBUGF 1,'K : FTDI got the request: %d\n', eax |
5087 | gtament | 299 | test eax, eax ;0 |
4979 | gtament | 300 | jz .version |
301 | dec eax ;1 |
||
302 | jz .ftdi_get_list |
||
4985 | gtament | 303 | |
4997 | gtament | 304 | push eax |
305 | mov esi, [edi+input] |
||
306 | mov eax, [esi+4] |
||
307 | call linkedlist_isvalid |
||
308 | test eax, eax |
||
309 | pop eax |
||
310 | jnz .endswitch |
||
311 | |||
312 | dec eax |
||
313 | jz .ftdi_lock ;2 |
||
314 | dec eax |
||
315 | jz .ftdi_unlock ;3 |
||
316 | |||
317 | mov ebx, [esi+4] |
||
5035 | gtament | 318 | mov ecx, [ebx + ftdi_context.lockPID] |
319 | cmp dword[esi], 0 |
||
320 | jz .error |
||
4997 | gtament | 321 | cmp ecx, [esi] |
322 | jz .pid_ok |
||
323 | mov esi, [edi+output] |
||
324 | mov dword[esi], 'LCKD' |
||
325 | jmp .endswitch |
||
326 | |||
5018 | gtament | 327 | .pid_ok: |
328 | dec eax |
||
5023 | gtament | 329 | jz .ftdi_get_wchunksize ;4 |
5018 | gtament | 330 | dec eax |
5023 | gtament | 331 | jz .ftdi_get_rchunksize ;5 |
5018 | gtament | 332 | |
333 | mov edi, [edi+input] |
||
334 | |||
335 | dec eax |
||
336 | jz .ftdi_set_rchunksize ;6 |
||
337 | dec eax |
||
5023 | gtament | 338 | jz .ftdi_set_wchunksize ;7 |
5018 | gtament | 339 | |
4985 | gtament | 340 | push eax edi |
5014 | gtament | 341 | mov ecx, 0x80000000 |
5023 | gtament | 342 | cmp eax, 8-7 |
5018 | gtament | 343 | je .bulkevent |
5023 | gtament | 344 | cmp eax, 9-7 |
5014 | gtament | 345 | je .bulkevent |
4985 | gtament | 346 | xor ecx, ecx |
5014 | gtament | 347 | .bulkevent: |
4985 | gtament | 348 | xor esi, esi |
5087 | gtament | 349 | invoke CreateEvent |
4985 | gtament | 350 | mov [EventData], eax |
351 | mov [EventData+4], edx |
||
5018 | gtament | 352 | pop edi eax |
4985 | gtament | 353 | |
5018 | gtament | 354 | dec eax ;8 |
5023 | gtament | 355 | jz .ftdi_write_data |
5018 | gtament | 356 | dec eax ;9 |
5023 | gtament | 357 | jz .ftdi_read_data |
5018 | gtament | 358 | dec eax ;10 |
5023 | gtament | 359 | jz .ftdi_set_baudrate |
5018 | gtament | 360 | dec eax ;11 |
5023 | gtament | 361 | jz .ftdi_set_bitmode |
5018 | gtament | 362 | dec eax ;12 |
5023 | gtament | 363 | jz .ftdi_setrtshigh |
5018 | gtament | 364 | dec eax ;13 |
5023 | gtament | 365 | jz .ftdi_setrtslow |
5018 | gtament | 366 | dec eax ;14 |
5023 | gtament | 367 | jz .ftdi_setdtrhigh |
5018 | gtament | 368 | dec eax ;15 |
5023 | gtament | 369 | jz .ftdi_setdtrlow |
5018 | gtament | 370 | dec eax ;16 |
5023 | gtament | 371 | jz .ftdi_usb_reset |
5018 | gtament | 372 | dec eax ;17 |
5023 | gtament | 373 | jz .ftdi_setflowctrl |
5018 | gtament | 374 | dec eax ;18 |
5023 | gtament | 375 | jz .ftdi_set_event_char |
5018 | gtament | 376 | dec eax ;19 |
5023 | gtament | 377 | jz .ftdi_set_error_char |
5018 | gtament | 378 | dec eax ;20 |
5023 | gtament | 379 | jz .ftdi_set_latency_timer |
5018 | gtament | 380 | dec eax ;21 |
5023 | gtament | 381 | jz .ftdi_get_latency_timer |
5018 | gtament | 382 | dec eax ;22 |
5023 | gtament | 383 | jz .ftdi_read_pins |
5018 | gtament | 384 | dec eax ;23 |
5023 | gtament | 385 | jz .ftdi_poll_modem_status |
5018 | gtament | 386 | dec eax ;24 |
4997 | gtament | 387 | jz .ftdi_set_line_property |
5018 | gtament | 388 | dec eax ;25 |
4997 | gtament | 389 | jz .ftdi_purge_rx_buf |
5018 | gtament | 390 | dec eax ;26 |
4997 | gtament | 391 | jz .ftdi_purge_tx_buf |
5018 | gtament | 392 | jmp .error |
393 | |||
4975 | gtament | 394 | .version: |
5018 | gtament | 395 | jmp .endswitch |
396 | .error: |
||
5042 | gtament | 397 | DEBUGF 1, 'K : FTDI error occured! %d\n', eax |
398 | ;mov esi, [edi+output] |
||
399 | ;mov [esi], dword 'ERR0' |
||
400 | ;or [esi], eax |
||
5035 | gtament | 401 | ret |
4975 | gtament | 402 | .endswitch: |
4979 | gtament | 403 | xor eax, eax |
5087 | gtament | 404 | ret |
4985 | gtament | 405 | |
5018 | gtament | 406 | .eventdestroy: |
5023 | gtament | 407 | ;---Dirty hack begin |
408 | test eax, eax |
||
409 | jz @f |
||
410 | mov eax, dword[ConfPacket] |
||
5087 | gtament | 411 | invoke Kfree |
5023 | gtament | 412 | @@: |
413 | ;---Dirty hack end |
||
5018 | gtament | 414 | mov eax, [EventData] |
415 | mov ebx, [EventData+4] |
||
5087 | gtament | 416 | invoke DestroyEvent |
5018 | gtament | 417 | jmp .endswitch |
418 | |||
419 | .ftdi_out_control_transfer_withinp: |
||
5035 | gtament | 420 | mov dx, word[edi+8] |
5018 | gtament | 421 | mov word[ConfPacket+2], dx |
422 | .ftdi_out_control_transfer_noinp: |
||
423 | mov ebx, [edi+4] |
||
4992 | gtament | 424 | mov cx, word[ebx + ftdi_context.index] |
425 | mov word[ConfPacket+4], cx |
||
426 | xor cx, cx |
||
427 | mov word[ConfPacket+6], cx |
||
428 | .own_index: |
||
5018 | gtament | 429 | mov ebx, [edi+4] |
5087 | gtament | 430 | DEBUGF 2,'K : ConfPacket 0x%x 0x%x\n', [ConfPacket], [ConfPacket+4] |
4975 | gtament | 431 | lea esi, [ConfPacket] |
4979 | gtament | 432 | lea edi, [EventData] |
5087 | gtament | 433 | invoke USBControlTransferAsync, [ebx + ftdi_context.nullP], esi, 0,\ |
434 | 0, control_callback, edi, 0 |
||
5018 | gtament | 435 | test eax, eax |
436 | jz .error |
||
4979 | gtament | 437 | mov eax, [EventData] |
438 | mov ebx, [EventData+4] |
||
5087 | gtament | 439 | invoke WaitEvent |
5042 | gtament | 440 | mov eax, [EventData+8] |
441 | test eax, eax |
||
442 | jz .endswitch |
||
443 | jmp .error |
||
4985 | gtament | 444 | |
4984 | gtament | 445 | .ftdi_setrtshigh: |
5087 | gtament | 446 | DEBUGF 2,'K : FTDI Setting RTS pin HIGH PID: %d Dev handler 0x0x%x\n', [edi],\ |
447 | [edi+4] |
||
448 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
449 | + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \ |
||
450 | + (SIO_SET_RTS_HIGH shl 16) |
||
5018 | gtament | 451 | jmp .ftdi_out_control_transfer_noinp |
4984 | gtament | 452 | |
453 | .ftdi_setrtslow: |
||
5087 | gtament | 454 | DEBUGF 2,'K : FTDI Setting RTS pin LOW PID: %d Dev handler 0x0x%x\n', [edi],\ |
455 | [edi+4] |
||
456 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
457 | + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \ |
||
458 | + (SIO_SET_RTS_LOW shl 16) |
||
5018 | gtament | 459 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 460 | |
461 | .ftdi_setdtrhigh: |
||
5087 | gtament | 462 | DEBUGF 2,'K : FTDI Setting DTR pin HIGH PID: %d Dev handler 0x0x%x\n', [edi],\ |
463 | [edi+4] |
||
464 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
465 | + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \ |
||
466 | + (SIO_SET_DTR_HIGH shl 16) |
||
5018 | gtament | 467 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 468 | |
469 | .ftdi_setdtrlow: |
||
5087 | gtament | 470 | DEBUGF 2,'K : FTDI Setting DTR pin LOW PID: %d Dev handler 0x0x%x\n', [edi],\ |
471 | [edi+4] |
||
472 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
473 | + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \ |
||
474 | + (SIO_SET_DTR_LOW shl 16) |
||
5018 | gtament | 475 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 476 | |
477 | .ftdi_usb_reset: |
||
5087 | gtament | 478 | DEBUGF 2,'K : FTDI Reseting PID: %d Dev handler 0x0x%x\n', [edi],\ |
479 | [edi+4] |
||
480 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
7552 | b00bl1k | 481 | + (SIO_RESET_REQUEST shl 8) \ |
482 | + (SIO_RESET_SIO shl 16) |
||
5018 | gtament | 483 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 484 | |
485 | .ftdi_purge_rx_buf: |
||
5087 | gtament | 486 | DEBUGF 2, 'K : FTDI Purge TX buffer PID: %d Dev handler 0x0x%x\n', [edi],\ |
487 | [edi+4] |
||
488 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
489 | + (SIO_RESET_REQUEST shl 8) \ |
||
490 | + (SIO_RESET_PURGE_RX shl 16) |
||
5018 | gtament | 491 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 492 | |
493 | .ftdi_purge_tx_buf: |
||
5087 | gtament | 494 | DEBUGF 2, 'K : FTDI Purge RX buffer PID: %d Dev handler 0x0x%x\n', [edi],\ |
495 | [edi+4] |
||
496 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
497 | + (SIO_RESET_REQUEST shl 8) \ |
||
498 | + (SIO_RESET_PURGE_TX shl 16) |
||
5018 | gtament | 499 | jmp .ftdi_out_control_transfer_noinp |
4985 | gtament | 500 | |
5018 | gtament | 501 | .ftdi_set_bitmode: |
5087 | gtament | 502 | DEBUGF 2, 'K : FTDI Set bitmode 0x%x, bitmask 0x%x %d PID: %d Dev handler 0x0x%x\n', \ |
503 | [edi+8]:2,[edi+10]:2,[edi],[edi+4] |
||
504 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
505 | + (SIO_SET_BITMODE_REQUEST shl 8) |
||
5018 | gtament | 506 | jmp .ftdi_out_control_transfer_withinp |
4992 | gtament | 507 | |
4985 | gtament | 508 | .ftdi_set_line_property: |
5087 | gtament | 509 | DEBUGF 2, 'K : FTDI Set line property 0x%x PID: %d Dev handler 0x0x%x\n', \ |
510 | [edi+8]:4,[edi],[edi+4] |
||
511 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
512 | + (SIO_SET_DATA_REQUEST shl 8) |
||
5018 | gtament | 513 | jmp .ftdi_out_control_transfer_withinp |
4985 | gtament | 514 | |
515 | .ftdi_set_latency_timer: |
||
5087 | gtament | 516 | DEBUGF 2, 'K : FTDI Set latency %d PID: %d Dev handler 0x0x%x\n', \ |
517 | [edi+8],[edi],[edi+4] |
||
518 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
519 | + (SIO_SET_LATENCY_TIMER_REQUEST shl 8) |
||
5018 | gtament | 520 | jmp .ftdi_out_control_transfer_withinp |
4985 | gtament | 521 | |
522 | .ftdi_set_event_char: |
||
5087 | gtament | 523 | DEBUGF 2, 'K : FTDI Set event char %c PID: %d Dev handler 0x0x%x\n', \ |
524 | [edi+8],[edi],[edi+4] |
||
525 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
526 | + (SIO_SET_EVENT_CHAR_REQUEST shl 8) |
||
5018 | gtament | 527 | jmp .ftdi_out_control_transfer_withinp |
4985 | gtament | 528 | |
529 | .ftdi_set_error_char: |
||
5087 | gtament | 530 | DEBUGF 2, 'K : FTDI Set error char %c PID: %d Dev handler 0x0x%x\n', \ |
531 | [edi+8],[edi],[edi+4] |
||
532 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
533 | + (SIO_SET_ERROR_CHAR_REQUEST shl 8) |
||
5018 | gtament | 534 | jmp .ftdi_out_control_transfer_withinp |
4985 | gtament | 535 | |
4992 | gtament | 536 | .ftdi_setflowctrl: |
5087 | gtament | 537 | DEBUGF 2, 'K : FTDI Set flow control PID: %d Dev handler 0x0x%x\n', [edi],\ |
538 | [edi+4] |
||
539 | mov dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
||
540 | + (SIO_SET_FLOW_CTRL_REQUEST shl 8) + (0 shl 16) |
||
5018 | gtament | 541 | mov ebx, [edi+4] |
4997 | gtament | 542 | mov cx, word[edi+8] |
4992 | gtament | 543 | or ecx, [ebx + ftdi_context.index] |
544 | mov word[ConfPacket+4], cx |
||
545 | xor cx, cx |
||
546 | mov word[ConfPacket+6], cx |
||
547 | jmp .own_index |
||
4985 | gtament | 548 | |
5087 | gtament | 549 | .ftdi_read_pins: |
550 | DEBUGF 2, 'K : FTDI Read pins PID: %d Dev handler 0x0x%x\n', [edi],\ |
||
551 | [edi+4] |
||
5042 | gtament | 552 | mov ebx, [edi+4] |
7552 | b00bl1k | 553 | mov dword[ConfPacket], (FTDI_DEVICE_IN_REQTYPE) \ |
5087 | gtament | 554 | + (SIO_READ_PINS_REQUEST shl 8) + (0 shl 16) |
4997 | gtament | 555 | mov ecx, [ebx + ftdi_context.index] |
556 | mov word[ConfPacket+4], cx |
||
557 | mov word[ConfPacket+6], 1 |
||
4984 | gtament | 558 | lea esi, [ConfPacket] |
4985 | gtament | 559 | lea edi, [EventData] |
5042 | gtament | 560 | mov ecx, esi |
561 | add ecx, 8 |
||
562 | mov word[ConfPacket+8], 0 |
||
7552 | b00bl1k | 563 | invoke USBControlTransferAsync, [ebx + ftdi_context.nullP], esi, ecx, \ |
5087 | gtament | 564 | 1, control_callback, edi, 0 |
4984 | gtament | 565 | mov eax, [EventData] |
566 | mov ebx, [EventData+4] |
||
5087 | gtament | 567 | invoke WaitEvent |
5042 | gtament | 568 | xor ebx, ebx |
569 | mov bx, word[ConfPacket+8] |
||
570 | mov ecx, [ioctl] |
||
571 | mov ecx, [ecx+output] |
||
572 | mov [ecx], ebx |
||
573 | mov eax, [EventData+8] |
||
574 | test eax, eax |
||
575 | jz .endswitch |
||
576 | jmp .error |
||
5018 | gtament | 577 | |
578 | .ftdi_set_wchunksize: |
||
5087 | gtament | 579 | DEBUGF 2, 'K : FTDI Set write chunksize %d bytes PID: %d Dev handler 0x0x%x\n', \ |
580 | [edi+8], [edi], [edi+4] |
||
5018 | gtament | 581 | mov ebx, [edi+4] |
5023 | gtament | 582 | mov ecx, [edi+8] |
5018 | gtament | 583 | cmp [ebx + ftdi_context.maxPacketSize], ecx |
584 | jg .error |
||
585 | mov [ebx + ftdi_context.writeBufChunkSize], ecx |
||
586 | jmp .endswitch |
||
587 | |||
588 | .ftdi_get_wchunksize: |
||
5087 | gtament | 589 | DEBUGF 2, 'K : FTDI Get write chunksize PID: %d Dev handler 0x0x%x\n', [edi],\ |
590 | [edi+4] |
||
5018 | gtament | 591 | mov esi, [edi+output] |
592 | mov edi, [edi+input] |
||
593 | mov ebx, [edi+4] |
||
594 | mov ecx, [ebx + ftdi_context.writeBufChunkSize] |
||
595 | mov [esi], ecx |
||
596 | jmp .endswitch |
||
4997 | gtament | 597 | |
5018 | gtament | 598 | .ftdi_set_rchunksize: |
5087 | gtament | 599 | DEBUGF 2, 'K : FTDI Set read chunksize %d bytes PID: %d Dev handler 0x0x%x\n', \ |
600 | [edi+8], [edi], [edi+4] |
||
5018 | gtament | 601 | mov ebx, [edi+4] |
602 | mov ecx, [edi+8] |
||
603 | cmp [ebx + ftdi_context.maxPacketSize], ecx |
||
604 | jg .error |
||
605 | mov [ebx + ftdi_context.readBufChunkSize], ecx |
||
606 | jmp .endswitch |
||
607 | |||
608 | .ftdi_get_rchunksize: |
||
5087 | gtament | 609 | DEBUGF 2, 'K : FTDI Get read chunksize PID: %d Dev handler 0x0x%x\n', [edi],\ |
610 | [edi+4] |
||
5018 | gtament | 611 | mov esi, [edi+output] |
612 | mov edi, [edi+input] |
||
613 | mov ebx, [edi+4] |
||
614 | mov ecx, [ebx + ftdi_context.readBufChunkSize] |
||
615 | mov [esi], ecx |
||
616 | jmp .endswitch |
||
617 | |||
4997 | gtament | 618 | .ftdi_write_data: |
5087 | gtament | 619 | DEBUGF 2, 'K : FTDI Write %d bytes PID: %d Dev handler 0x%x\n', [edi+8],\ |
620 | [edi], [edi+4] |
||
5018 | gtament | 621 | mov esi, edi |
622 | add esi, 12 |
||
4997 | gtament | 623 | mov ebx, [edi+4] |
5023 | gtament | 624 | ;---Dirty hack begin |
625 | mov eax, [edi+8] |
||
5087 | gtament | 626 | invoke Kmalloc |
5023 | gtament | 627 | test eax, eax |
628 | jnz @f |
||
629 | mov esi, nomemory_msg |
||
5087 | gtament | 630 | invoke SysMsgBoardStr |
5023 | gtament | 631 | jmp .eventdestroy |
632 | @@: |
||
633 | mov dword[ConfPacket], eax |
||
634 | mov ecx, [edi+8] |
||
5042 | gtament | 635 | push edi |
5023 | gtament | 636 | mov edi, eax |
637 | rep movsb |
||
5042 | gtament | 638 | pop edi |
639 | mov esi, dword[ConfPacket] |
||
5087 | gtament | 640 | ;---Dirty hack end |
5018 | gtament | 641 | xor ecx, ecx ; ecx - offset |
642 | .write_loop: |
||
643 | mov edx, [edi+8] ; edx - write_size |
||
4997 | gtament | 644 | sub edx, ecx |
5018 | gtament | 645 | cmp edx, [ebx + ftdi_context.writeBufChunkSize] |
646 | jle .lessthanchunk_write |
||
647 | mov edx, [ebx + ftdi_context.writeBufChunkSize] |
||
648 | .lessthanchunk_write: |
||
649 | add esi, ecx |
||
5014 | gtament | 650 | lea eax, [EventData] |
5018 | gtament | 651 | push ecx ebx esi edi |
5087 | gtament | 652 | invoke USBNormalTransferAsync, [ebx + ftdi_context.inEP], esi, edx, \ |
653 | bulk_callback, eax, 1 |
||
4997 | gtament | 654 | mov eax, [EventData] |
655 | mov ebx, [EventData+4] |
||
5087 | gtament | 656 | invoke WaitEvent |
5018 | gtament | 657 | pop edi esi ebx ecx |
5014 | gtament | 658 | cmp [EventData+8], -1 |
5023 | gtament | 659 | jz .error |
5014 | gtament | 660 | add ecx, [EventData+8] |
4997 | gtament | 661 | cmp ecx, [edi+8] |
5018 | gtament | 662 | jge .eventdestroy |
663 | jmp .write_loop |
||
4985 | gtament | 664 | |
5014 | gtament | 665 | .ftdi_read_data: |
5087 | gtament | 666 | DEBUGF 2, 'K : FTDI Read %d bytes PID: %d Dev handler 0x%x\n', [edi+8],\ |
667 | [edi], [edi+4] |
||
5018 | gtament | 668 | mov edi, [ioctl] |
5014 | gtament | 669 | mov esi, [edi+input] |
670 | mov edi, [edi+output] |
||
5035 | gtament | 671 | mov ebx, [esi+4] |
5023 | gtament | 672 | ;---Dirty hack begin |
673 | mov eax, [esi+8] |
||
5087 | gtament | 674 | invoke Kmalloc |
5023 | gtament | 675 | test eax, eax |
676 | jnz @f |
||
677 | mov esi, nomemory_msg |
||
5087 | gtament | 678 | invoke SysMsgBoardStr |
5023 | gtament | 679 | jmp .eventdestroy |
680 | @@: |
||
681 | mov edi, eax |
||
5087 | gtament | 682 | ; push edi eax |
683 | ; mov ecx, [esi+8] |
||
684 | ; xor eax, eax |
||
685 | ; rep stosb |
||
686 | ; pop eax edi |
||
687 | mov dword[ConfPacket], eax ; Store in ConfPacket ptr to allocated memory |
||
5023 | gtament | 688 | ;---Dirty hack end |
5014 | gtament | 689 | xor ecx, ecx |
5023 | gtament | 690 | .read_loop: |
5014 | gtament | 691 | mov edx, [esi+8] |
5018 | gtament | 692 | cmp ecx, edx |
5023 | gtament | 693 | jge .read_end;jge .eventdestroy ;part of Dirty hack |
5014 | gtament | 694 | sub edx, ecx |
695 | cmp edx, [ebx + ftdi_context.readBufChunkSize] |
||
696 | jl .lessthanchunk_read |
||
697 | mov edx, [ebx + ftdi_context.readBufChunkSize] |
||
698 | .lessthanchunk_read: |
||
699 | lea eax, [EventData] |
||
5018 | gtament | 700 | add edi, ecx |
5014 | gtament | 701 | push esi edi ecx ebx |
5087 | gtament | 702 | invoke USBNormalTransferAsync, [ebx + ftdi_context.outEP], edi, edx, \ |
703 | bulk_callback, eax, 1 |
||
5014 | gtament | 704 | mov eax, [EventData] |
705 | mov ebx, [EventData+4] |
||
5087 | gtament | 706 | invoke WaitEvent |
5014 | gtament | 707 | pop ebx ecx edi esi |
5023 | gtament | 708 | cmp [EventData+8], -1 |
5018 | gtament | 709 | jz .error |
5014 | gtament | 710 | add ecx, [EventData+8] |
711 | jmp .read_loop |
||
5023 | gtament | 712 | ;---Dirty hack begin |
713 | .read_end: |
||
714 | mov esi, dword[ConfPacket] |
||
715 | mov edi, [ioctl] |
||
716 | mov ecx, [edi+input] |
||
717 | mov ecx, [ecx+8] |
||
718 | mov edi, [edi+output] |
||
719 | rep movsb |
||
720 | jmp .eventdestroy |
||
721 | ;---Dirty hack end |
||
5014 | gtament | 722 | |
5087 | gtament | 723 | .ftdi_poll_modem_status: |
724 | DEBUGF 2, 'K : FTDI Poll modem status PID: %d Dev handler 0x0x%x\n', [edi],\ |
||
725 | [edi+4] |
||
4997 | gtament | 726 | mov ebx, [edi+4] |
5087 | gtament | 727 | mov dword[ConfPacket], (FTDI_DEVICE_IN_REQTYPE) \ |
728 | + (SIO_POLL_MODEM_STATUS_REQUEST shl 8) + (0 shl 16) |
||
4997 | gtament | 729 | mov ecx, [ebx + ftdi_context.index] |
730 | mov word[ConfPacket+4], cx |
||
731 | mov word[ConfPacket+6], 1 |
||
732 | lea esi, [ConfPacket] |
||
733 | lea edi, [EventData] |
||
734 | mov ecx, [ioctl] |
||
735 | mov ecx, [ecx+output] |
||
5087 | gtament | 736 | invoke USBControlTransferAsync, [ebx + ftdi_context.nullP], esi, ecx, \ |
737 | 2, control_callback, edi, 0 |
||
4997 | gtament | 738 | mov eax, [EventData] |
739 | mov ebx, [EventData+4] |
||
5087 | gtament | 740 | invoke WaitEvent |
4997 | gtament | 741 | mov ax, word[ecx] |
742 | xchg ah, al |
||
743 | and ah, 0xFF |
||
744 | mov word[ecx], ax |
||
745 | jmp .endswitch |
||
746 | |||
5087 | gtament | 747 | .ftdi_get_latency_timer: |
748 | DEBUGF 2, 'K : FTDI Get latency timer PID: %d Dev handler 0x0x%x\n', [edi],\ |
||
749 | [edi+4] |
||
4997 | gtament | 750 | mov ebx, [edi+4] |
5087 | gtament | 751 | mov dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE \ |
752 | + (SIO_GET_LATENCY_TIMER_REQUEST shl 8) + (0 shl 16) |
||
4997 | gtament | 753 | mov ecx, [ebx + ftdi_context.index] |
754 | mov word[ConfPacket+4], cx |
||
755 | mov word[ConfPacket+6], 1 |
||
756 | lea esi, [ConfPacket] |
||
757 | lea edi, [EventData] |
||
758 | mov ecx, [ioctl] |
||
759 | mov ecx, [ecx+output] |
||
5087 | gtament | 760 | invoke USBControlTransferAsync, [ebx + ftdi_context.nullP], esi, ecx, \ |
761 | 2, control_callback, edi, 0 |
||
4997 | gtament | 762 | mov eax, [EventData] |
763 | mov ebx, [EventData+4] |
||
5087 | gtament | 764 | invoke WaitEvent |
4997 | gtament | 765 | jmp .endswitch |
766 | |||
5087 | gtament | 767 | .ftdi_get_list: |
7552 | b00bl1k | 768 | DEBUGF 2, 'K : FTDI devices list request\n' |
5037 | gtament | 769 | mov edi, [edi+output] |
770 | xor ecx, ecx |
||
5018 | gtament | 771 | call linkedlist_gethead |
772 | test eax, eax |
||
5037 | gtament | 773 | jz .emptylist |
5014 | gtament | 774 | push edi |
5037 | gtament | 775 | add edi, 4 |
4997 | gtament | 776 | .nextdev: |
5014 | gtament | 777 | inc ecx |
4997 | gtament | 778 | cmp [eax + ftdi_context.lockPID], 0 |
779 | jnz .dev_is_locked |
||
780 | mov dword[edi], 'NLKD' |
||
781 | jmp .nextfields |
||
782 | .dev_is_locked: |
||
783 | mov dword[edi], 'LCKD' |
||
784 | .nextfields: |
||
785 | mov bl, [eax + ftdi_context.chipType] |
||
786 | mov [edi+4], ebx |
||
787 | mov [edi+8], eax |
||
788 | add edi, 12 |
||
789 | mov eax, [eax + ftdi_context.next_context] |
||
790 | test eax, eax |
||
791 | jnz .nextdev |
||
5014 | gtament | 792 | pop edi |
5037 | gtament | 793 | .emptylist: |
5014 | gtament | 794 | mov [edi], ecx |
4997 | gtament | 795 | jmp .endswitch |
5087 | gtament | 796 | |
4997 | gtament | 797 | .ftdi_lock: |
5087 | gtament | 798 | DEBUGF 2, 'K : FTDI Lock PID: %d Dev handler 0x0x%x\n', [edi], [edi+4] |
4997 | gtament | 799 | mov esi, [edi+input] |
800 | mov ebx, [esi+4] |
||
801 | mov eax, [ebx + ftdi_context.lockPID] |
||
802 | test eax, eax |
||
803 | jnz .lockedby |
||
804 | mov eax, [esi] |
||
805 | mov [ebx + ftdi_context.lockPID], eax |
||
806 | .lockedby: |
||
807 | mov edi, [edi+output] |
||
4979 | gtament | 808 | mov [edi], eax |
4985 | gtament | 809 | jmp .endswitch |
4997 | gtament | 810 | |
811 | .ftdi_unlock: |
||
5087 | gtament | 812 | DEBUGF 2, 'K : FTDI Unlock PID: %d Dev handler 0x0x%x\n', [edi], [edi+4] |
4997 | gtament | 813 | mov esi, [edi+input] |
814 | mov edi, [edi+output] |
||
815 | mov ebx, [esi+4] |
||
816 | mov eax, [ebx + ftdi_context.lockPID] |
||
817 | cmp eax, [esi] |
||
818 | jnz .unlockimp |
||
819 | mov [ebx + ftdi_context.lockPID], 0 |
||
820 | mov dword[edi], 0 |
||
821 | jmp .endswitch |
||
822 | .unlockimp: |
||
823 | mov [edi], eax |
||
5018 | gtament | 824 | jmp .endswitch |
825 | |||
826 | H_CLK = 120000000 |
||
827 | C_CLK = 48000000 |
||
828 | .ftdi_set_baudrate: |
||
5087 | gtament | 829 | DEBUGF 2, 'K : FTDI Set baudrate to %d PID: %d Dev handle: 0x%x\n',\ |
830 | [edi+8], [edi], [edi+4] |
||
5018 | gtament | 831 | mov ebx, [edi+4] |
832 | cmp [ebx + ftdi_context.chipType], TYPE_2232H |
||
833 | jl .c_clk |
||
834 | imul eax, [edi+8], 10 |
||
835 | cmp eax, H_CLK / 0x3FFF |
||
836 | jle .c_clk |
||
5023 | gtament | 837 | .h_clk: |
5018 | gtament | 838 | cmp dword[edi+8], H_CLK/10 |
839 | jl .h_nextbaud1 |
||
840 | xor edx, edx |
||
841 | mov ecx, H_CLK/10 |
||
842 | jmp .calcend |
||
4997 | gtament | 843 | |
5018 | gtament | 844 | .c_clk: |
5023 | gtament | 845 | cmp dword[edi+8], C_CLK/16 |
5018 | gtament | 846 | jl .c_nextbaud1 |
847 | xor edx, edx |
||
5023 | gtament | 848 | mov ecx, C_CLK/16 |
5018 | gtament | 849 | jmp .calcend |
850 | |||
851 | .h_nextbaud1: |
||
852 | cmp dword[edi+8], H_CLK/(10 + 10/2) |
||
853 | jl .h_nextbaud2 |
||
854 | mov edx, 1 |
||
855 | mov ecx, H_CLK/(10 + 10/2) |
||
856 | jmp .calcend |
||
857 | |||
858 | .c_nextbaud1: |
||
5023 | gtament | 859 | cmp dword[edi+8], C_CLK/(16 + 16/2) |
5018 | gtament | 860 | jl .c_nextbaud2 |
861 | mov edx, 1 |
||
5023 | gtament | 862 | mov ecx, C_CLK/(16 + 16/2) |
5018 | gtament | 863 | jmp .calcend |
864 | |||
5023 | gtament | 865 | .h_nextbaud2: |
5018 | gtament | 866 | cmp dword[edi+8], H_CLK/(2*10) |
867 | jl .h_nextbaud3 |
||
868 | mov edx, 2 |
||
869 | mov ecx, H_CLK/(2*10) |
||
870 | jmp .calcend |
||
871 | |||
5023 | gtament | 872 | .c_nextbaud2: |
873 | cmp dword[edi+8], C_CLK/(2*16) |
||
5018 | gtament | 874 | jl .c_nextbaud3 |
875 | mov edx, 2 |
||
5023 | gtament | 876 | mov ecx, C_CLK/(2*16) |
5018 | gtament | 877 | jmp .calcend |
878 | |||
879 | .h_nextbaud3: |
||
880 | mov eax, H_CLK*16/10 ; eax - best_divisor |
||
5023 | gtament | 881 | xor edx, edx |
5018 | gtament | 882 | div dword[edi+8] ; [edi+8] - baudrate |
883 | push eax |
||
884 | and eax, 1 |
||
885 | pop eax |
||
886 | shr eax, 1 |
||
887 | jz .h_rounddowndiv ; jump by result of and eax, 1 |
||
888 | inc eax |
||
889 | .h_rounddowndiv: |
||
890 | cmp eax, 0x20000 |
||
891 | jle .h_best_divok |
||
892 | mov eax, 0x1FFFF |
||
893 | .h_best_divok: |
||
894 | mov ecx, eax |
||
895 | mov eax, H_CLK*16/10 |
||
5023 | gtament | 896 | xor edx, edx |
5018 | gtament | 897 | div ecx |
898 | xchg ecx, eax ; ecx - best_baud |
||
899 | push ecx |
||
900 | and ecx, 1 |
||
901 | pop ecx |
||
902 | shr ecx, 1 |
||
903 | jz .rounddownbaud |
||
904 | inc ecx |
||
905 | jmp .rounddownbaud |
||
906 | |||
907 | .c_nextbaud3: |
||
5023 | gtament | 908 | mov eax, C_CLK ; eax - best_divisor |
909 | xor edx, edx |
||
5018 | gtament | 910 | div dword[edi+8] ; [edi+8] - baudrate |
911 | push eax |
||
912 | and eax, 1 |
||
913 | pop eax |
||
914 | shr eax, 1 |
||
5023 | gtament | 915 | jnz .c_rounddowndiv ; jump by result of and eax, 1 |
5018 | gtament | 916 | inc eax |
917 | .c_rounddowndiv: |
||
918 | cmp eax, 0x20000 |
||
919 | jle .c_best_divok |
||
920 | mov eax, 0x1FFFF |
||
921 | .c_best_divok: |
||
922 | mov ecx, eax |
||
5023 | gtament | 923 | mov eax, C_CLK |
924 | xor edx, edx |
||
5018 | gtament | 925 | div ecx |
926 | xchg ecx, eax ; ecx - best_baud |
||
927 | push ecx |
||
928 | and ecx, 1 |
||
929 | pop ecx |
||
930 | shr ecx, 1 |
||
5023 | gtament | 931 | jnz .rounddownbaud |
5018 | gtament | 932 | inc ecx |
933 | |||
934 | .rounddownbaud: |
||
935 | mov edx, eax ; edx - encoded_divisor |
||
936 | shr edx, 3 |
||
5035 | gtament | 937 | and eax, 0x7 |
938 | push 7 6 5 1 4 2 3 0 |
||
5018 | gtament | 939 | mov eax, [esp+eax*4] |
940 | shl eax, 14 |
||
5035 | gtament | 941 | or edx, eax |
942 | add esp, 32 |
||
5018 | gtament | 943 | |
944 | .calcend: |
||
945 | mov eax, edx ; eax - *value |
||
946 | mov ecx, edx ; ecx - *index |
||
947 | and eax, 0xFFFF |
||
948 | cmp [ebx + ftdi_context.chipType], TYPE_2232H |
||
949 | jge .foxyindex |
||
950 | shr ecx, 16 |
||
951 | jmp .preparepacket |
||
952 | .foxyindex: |
||
953 | shr ecx, 8 |
||
954 | and ecx, 0xFF00 |
||
955 | or ecx, [ebx + ftdi_context.index] |
||
956 | |||
957 | .preparepacket: |
||
5087 | gtament | 958 | mov word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \ |
959 | + (SIO_SET_BAUDRATE_REQUEST shl 8) |
||
5018 | gtament | 960 | mov word[ConfPacket+2], ax |
961 | mov word[ConfPacket+4], cx |
||
962 | mov word[ConfPacket+6], 0 |
||
963 | jmp .own_index |
||
964 | |||
4975 | gtament | 965 | endp |
966 | restore handle |
||
967 | restore io_code |
||
968 | restore input |
||
969 | restore inp_size |
||
970 | restore output |
||
971 | restore out_size |
||
972 | |||
973 | |||
5087 | gtament | 974 | proc control_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, \ |
975 | .buffer:DWORD, .length:DWORD, .calldata:DWORD |
||
4975 | gtament | 976 | |
4985 | gtament | 977 | DEBUGF 1, 'K : status is %d\n', [.status] |
4980 | gtament | 978 | mov ecx, [.calldata] |
979 | mov eax, [ecx] |
||
980 | mov ebx, [ecx+4] |
||
5014 | gtament | 981 | mov edx, [.status] |
982 | mov [ecx+8], edx |
||
4997 | gtament | 983 | xor esi, esi |
4979 | gtament | 984 | xor edx, edx |
5087 | gtament | 985 | invoke RaiseEvent |
4975 | gtament | 986 | ret |
987 | endp |
||
988 | |||
5087 | gtament | 989 | proc bulk_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, \ |
990 | .buffer:DWORD, .length:DWORD, .calldata:DWORD |
||
4975 | gtament | 991 | |
5014 | gtament | 992 | DEBUGF 1, 'K : status is %d\n', [.status] |
4997 | gtament | 993 | mov ecx, [.calldata] |
994 | mov eax, [ecx] |
||
995 | mov ebx, [ecx+4] |
||
5014 | gtament | 996 | cmp [.status], 0 |
5018 | gtament | 997 | jz .normal |
5014 | gtament | 998 | cmp [.status], 9 |
999 | jne .error |
||
5018 | gtament | 1000 | .normal: |
4997 | gtament | 1001 | mov edx, [.length] |
5014 | gtament | 1002 | mov [ecx+8], edx |
1003 | jmp .ok |
||
1004 | .error: |
||
1005 | mov [ecx+8], dword -1 |
||
5018 | gtament | 1006 | .ok: |
4997 | gtament | 1007 | xor esi, esi |
5014 | gtament | 1008 | xor edx, edx |
5087 | gtament | 1009 | invoke RaiseEvent |
4997 | gtament | 1010 | ret |
1011 | endp |
||
1012 | |||
4975 | gtament | 1013 | proc DeviceDisconnected stdcall uses ebx esi edi, .device_data:DWORD |
1014 | |||
5087 | gtament | 1015 | DEBUGF 1, 'K : FTDI deleting device data 0x%x\n', [.device_data] |
4975 | gtament | 1016 | mov eax, [.device_data] |
5087 | gtament | 1017 | call linkedlist_unlink |
1018 | invoke Kfree |
||
4979 | gtament | 1019 | ret |
4975 | gtament | 1020 | endp |
1021 | |||
1022 | include 'linkedlist.inc' |
||
5087 | gtament | 1023 | |
4975 | gtament | 1024 | align 4 |
5087 | gtament | 1025 | |
4975 | gtament | 1026 | ; Structure with callback functions. |
1027 | usb_functions: |
||
1028 | dd 12 |
||
1029 | dd AddDevice |
||
1030 | dd DeviceDisconnected |
||
1031 | |||
5087 | gtament | 1032 | data fixups |
1033 | end data |
||
1034 | |||
4975 | gtament | 1035 | ;for DEBUGF macro |
5087 | gtament | 1036 | include_debug_strings |