1 | /*********************************************************************
|
---|
2 | * Copyright (C) 2003 Tord Lindstrom (pukko@home.se)
|
---|
3 | * Copyright (C) 2004 adresd (adresd_ps2dev@yahoo.com)
|
---|
4 | * This file is subject to the terms and conditions of the PS2Link License.
|
---|
5 | * See the file LICENSE in the main directory of this distribution for more
|
---|
6 | * details.
|
---|
7 | */
|
---|
8 |
|
---|
9 | // Fu*k knows why net_fio & net_fsys are separated..
|
---|
10 |
|
---|
11 | #include <types.h>
|
---|
12 | #include <ioman.h>
|
---|
13 | #include <sysclib.h>
|
---|
14 | #include <stdio.h>
|
---|
15 | #include <thbase.h>
|
---|
16 |
|
---|
17 | #include <io_common.h>
|
---|
18 |
|
---|
19 | #include "ps2ip.h"
|
---|
20 | #include "net_fio.h"
|
---|
21 | #include "hostlink.h"
|
---|
22 |
|
---|
23 | #define ntohl(x) htonl(x)
|
---|
24 | #define ntohs(x) htons(x)
|
---|
25 |
|
---|
26 | unsigned int remote_pc_addr = 0xffffffff;
|
---|
27 |
|
---|
28 | #define PACKET_MAXSIZE 4096
|
---|
29 |
|
---|
30 | static char send_packet[PACKET_MAXSIZE] __attribute__((aligned(16)));
|
---|
31 | static char recv_packet[PACKET_MAXSIZE] __attribute__((aligned(16)));
|
---|
32 |
|
---|
33 | static int pko_fileio_sock = -1;
|
---|
34 | static int pko_fileio_active = 0;
|
---|
35 |
|
---|
36 | #ifdef DEBUG
|
---|
37 | #define dbgprintf(args...) printf(args)
|
---|
38 | #else
|
---|
39 | #define dbgprintf(args...) do { } while(0)
|
---|
40 | #endif
|
---|
41 |
|
---|
42 | //----------------------------------------------------------------------
|
---|
43 | //
|
---|
44 | void
|
---|
45 | pko_close_socket(void)
|
---|
46 | {
|
---|
47 | int ret;
|
---|
48 |
|
---|
49 | ret = disconnect(pko_fileio_sock);
|
---|
50 | if (ret < 0) {
|
---|
51 | printf("pko_file: disconnect returned error %d\n", ret);
|
---|
52 | }
|
---|
53 | pko_fileio_sock = -1;
|
---|
54 | }
|
---|
55 |
|
---|
56 | //----------------------------------------------------------------------
|
---|
57 | //
|
---|
58 | void
|
---|
59 | pko_close_fsys(void)
|
---|
60 | {
|
---|
61 | if (pko_fileio_sock > 0) {
|
---|
62 | disconnect(pko_fileio_sock);
|
---|
63 | }
|
---|
64 | pko_fileio_active = 0;
|
---|
65 | return;
|
---|
66 | }
|
---|
67 |
|
---|
68 | //----------------------------------------------------------------------
|
---|
69 | // XXX: Hm, this func should behave sorta like pko_recv_bytes imho..
|
---|
70 | // i.e. check if it was able to send just a part of the packet etc..
|
---|
71 | static inline int
|
---|
72 | pko_lwip_send(int sock, void *buf, int len, int flag)
|
---|
73 | {
|
---|
74 | int ret;
|
---|
75 | ret = send(sock, buf, len, flag);
|
---|
76 | if (ret < 0) {
|
---|
77 | dbgprintf("pko_file: lwip_send() error %d\n", ret);
|
---|
78 | pko_close_socket();
|
---|
79 | return -1;
|
---|
80 | }
|
---|
81 | else {
|
---|
82 | return ret;
|
---|
83 | }
|
---|
84 | }
|
---|
85 |
|
---|
86 |
|
---|
87 | //----------------------------------------------------------------------
|
---|
88 | // Do repetetive recv() calles until 'bytes' bytes are received
|
---|
89 | // or error returned
|
---|
90 | int pko_recv_bytes(int sock, char *buf, int bytes)
|
---|
91 | {
|
---|
92 | int left;
|
---|
93 | int len;
|
---|
94 |
|
---|
95 | left = bytes;
|
---|
96 |
|
---|
97 | while (left > 0) {
|
---|
98 | len = recv(sock, &buf[bytes - left], left, 0);
|
---|
99 | if (len < 0) {
|
---|
100 | dbgprintf("pko_file: pko_recv_bytes error!!\n");
|
---|
101 | return -1;
|
---|
102 | }
|
---|
103 | left -= len;
|
---|
104 | }
|
---|
105 | return bytes;
|
---|
106 | }
|
---|
107 |
|
---|
108 |
|
---|
109 | //----------------------------------------------------------------------
|
---|
110 | // Receive a 'packet' of the expected type 'pkt_type', and lenght 'len'
|
---|
111 | int pko_accept_pkt(int sock, char *buf, int len, int pkt_type)
|
---|
112 | {
|
---|
113 | int length;
|
---|
114 | pko_pkt_hdr *hdr;
|
---|
115 | unsigned int hcmd;
|
---|
116 | unsigned short hlen;
|
---|
117 |
|
---|
118 |
|
---|
119 | length = pko_recv_bytes(sock, buf, sizeof(pko_pkt_hdr));
|
---|
120 | if (length < 0) {
|
---|
121 | dbgprintf("pko_file: accept_pkt recv error\n");
|
---|
122 | return -1;
|
---|
123 | }
|
---|
124 |
|
---|
125 | if (length < sizeof(pko_pkt_hdr)) {
|
---|
126 | dbgprintf("pko_file: XXX: did not receive a full header!!!! "
|
---|
127 | "Fix this! (%d)\n", length);
|
---|
128 | }
|
---|
129 |
|
---|
130 | hdr = (pko_pkt_hdr *)buf;
|
---|
131 | hcmd = ntohl(hdr->cmd);
|
---|
132 | hlen = ntohs(hdr->len);
|
---|
133 |
|
---|
134 | if (hcmd != pkt_type) {
|
---|
135 | dbgprintf("pko_file: pko_accept_pkt: Expected %x, got %x\n",
|
---|
136 | pkt_type, hcmd);
|
---|
137 | return 0;
|
---|
138 | }
|
---|
139 |
|
---|
140 | if (hlen > len) {
|
---|
141 | dbgprintf("pko_file: pko_accept_pkt: hdr->len is too large!! "
|
---|
142 | "(%d, can only receive %d)\n", hlen, len);
|
---|
143 | return 0;
|
---|
144 | }
|
---|
145 |
|
---|
146 | // get the actual packet data
|
---|
147 | length = pko_recv_bytes(sock, buf + sizeof(pko_pkt_hdr),
|
---|
148 | hlen - sizeof(pko_pkt_hdr));
|
---|
149 |
|
---|
150 | if (length < 0) {
|
---|
151 | dbgprintf("pko_file: accept recv2 error!!\n");
|
---|
152 | return 0;
|
---|
153 | }
|
---|
154 |
|
---|
155 | if (length < (hlen - sizeof(pko_pkt_hdr))) {
|
---|
156 | dbgprintf("pko_accept_pkt: Did not receive full packet!!! "
|
---|
157 | "Fix this! (%d)\n", length);
|
---|
158 | }
|
---|
159 |
|
---|
160 | return 1;
|
---|
161 | }
|
---|
162 |
|
---|
163 | //----------------------------------------------------------------------
|
---|
164 | //
|
---|
165 | int pko_open_file(char *path, int flags)
|
---|
166 | {
|
---|
167 | pko_pkt_open_req *openreq;
|
---|
168 | pko_pkt_file_rly *openrly;
|
---|
169 |
|
---|
170 | if (pko_fileio_sock < 0) {
|
---|
171 | return -1;
|
---|
172 | }
|
---|
173 |
|
---|
174 | dbgprintf("pko_file: file open req (%s, %x)\n", path, flags);
|
---|
175 |
|
---|
176 | openreq = (pko_pkt_open_req *)&send_packet[0];
|
---|
177 |
|
---|
178 | // Build packet
|
---|
179 | openreq->cmd = htonl(PKO_OPEN_CMD);
|
---|
180 | openreq->len = htons((unsigned short)sizeof(pko_pkt_open_req));
|
---|
181 | openreq->flags = htonl(flags);
|
---|
182 | strncpy(openreq->path, path, PKO_MAX_PATH);
|
---|
183 | openreq->path[PKO_MAX_PATH - 1] = 0; // Make sure it's null-terminated
|
---|
184 |
|
---|
185 | if (pko_lwip_send(pko_fileio_sock, openreq, sizeof(pko_pkt_open_req), 0) < 0) {
|
---|
186 | return -1;
|
---|
187 | }
|
---|
188 |
|
---|
189 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
190 | sizeof(pko_pkt_file_rly), PKO_OPEN_RLY)) {
|
---|
191 | dbgprintf("pko_file: pko_open_file: did not receive OPEN_RLY\n");
|
---|
192 | return -1;
|
---|
193 | }
|
---|
194 |
|
---|
195 | openrly = (pko_pkt_file_rly *)recv_packet;
|
---|
196 |
|
---|
197 | dbgprintf("pko_file: file open reply received (ret %d)\n", ntohl(openrly->retval));
|
---|
198 |
|
---|
199 | return ntohl(openrly->retval);
|
---|
200 | }
|
---|
201 |
|
---|
202 |
|
---|
203 | //----------------------------------------------------------------------
|
---|
204 | //
|
---|
205 | int pko_close_file(int fd)
|
---|
206 | {
|
---|
207 | pko_pkt_close_req *closereq;
|
---|
208 | pko_pkt_file_rly *closerly;
|
---|
209 |
|
---|
210 |
|
---|
211 | if (pko_fileio_sock < 0) {
|
---|
212 | return -1;
|
---|
213 | }
|
---|
214 |
|
---|
215 | dbgprintf("pko_file: file close req (fd: %d)\n", fd);
|
---|
216 |
|
---|
217 | closereq = (pko_pkt_close_req *)&send_packet[0];
|
---|
218 | closerly = (pko_pkt_file_rly *)&recv_packet[0];
|
---|
219 |
|
---|
220 | closereq->cmd = htonl(PKO_CLOSE_CMD);
|
---|
221 | closereq->len = htons((unsigned short)sizeof(pko_pkt_close_req));
|
---|
222 | closereq->fd = htonl(fd);
|
---|
223 |
|
---|
224 | if (pko_lwip_send(pko_fileio_sock, closereq, sizeof(pko_pkt_close_req), 0) < 0) {
|
---|
225 | return -1;
|
---|
226 | }
|
---|
227 |
|
---|
228 | if(!pko_accept_pkt(pko_fileio_sock, (char *)closerly,
|
---|
229 | sizeof(pko_pkt_file_rly), PKO_CLOSE_RLY)) {
|
---|
230 | dbgprintf("pko_file: pko_close_file: did not receive PKO_CLOSE_RLY\n");
|
---|
231 | return -1;
|
---|
232 | }
|
---|
233 |
|
---|
234 | dbgprintf("pko_file: pko_close_file: close reply received (ret %d)\n",
|
---|
235 | ntohl(closerly->retval));
|
---|
236 |
|
---|
237 | return ntohl(closerly->retval);
|
---|
238 | }
|
---|
239 |
|
---|
240 | //----------------------------------------------------------------------
|
---|
241 | //
|
---|
242 | int pko_lseek_file(int fd, unsigned int offset, int whence)
|
---|
243 | {
|
---|
244 | pko_pkt_lseek_req *lseekreq;
|
---|
245 | pko_pkt_file_rly *lseekrly;
|
---|
246 |
|
---|
247 |
|
---|
248 | if (pko_fileio_sock < 0) {
|
---|
249 | return -1;
|
---|
250 | }
|
---|
251 |
|
---|
252 | dbgprintf("pko_file: file lseek req (fd: %d)\n", fd);
|
---|
253 |
|
---|
254 | lseekreq = (pko_pkt_lseek_req *)&send_packet[0];
|
---|
255 | lseekrly = (pko_pkt_file_rly *)&recv_packet[0];
|
---|
256 |
|
---|
257 | lseekreq->cmd = htonl(PKO_LSEEK_CMD);
|
---|
258 | lseekreq->len = htons((unsigned short)sizeof(pko_pkt_lseek_req));
|
---|
259 | lseekreq->fd = htonl(fd);
|
---|
260 | lseekreq->offset = htonl(offset);
|
---|
261 | lseekreq->whence = htonl(whence);
|
---|
262 |
|
---|
263 | if(pko_lwip_send(pko_fileio_sock, lseekreq, sizeof(pko_pkt_lseek_req), 0) < 0) {
|
---|
264 | return -1;
|
---|
265 | }
|
---|
266 |
|
---|
267 | if(!pko_accept_pkt(pko_fileio_sock, (char *)lseekrly,
|
---|
268 | sizeof(pko_pkt_file_rly), PKO_LSEEK_RLY)) {
|
---|
269 | dbgprintf("pko_file: pko_lseek_file: did not receive PKO_LSEEK_RLY\n");
|
---|
270 | return -1;
|
---|
271 | }
|
---|
272 |
|
---|
273 | dbgprintf("pko_file: pko_lseek_file: lseek reply received (ret %d)\n",
|
---|
274 | ntohl(lseekrly->retval));
|
---|
275 |
|
---|
276 | return ntohl(lseekrly->retval);
|
---|
277 |
|
---|
278 | }
|
---|
279 |
|
---|
280 |
|
---|
281 | //----------------------------------------------------------------------
|
---|
282 | //
|
---|
283 | int pko_write_file(int fd, char *buf, int length)
|
---|
284 | {
|
---|
285 | pko_pkt_write_req *writecmd;
|
---|
286 | pko_pkt_file_rly *writerly;
|
---|
287 | int hlen;
|
---|
288 | int writtenbytes;
|
---|
289 | int nbytes;
|
---|
290 | int retval;
|
---|
291 |
|
---|
292 | if (pko_fileio_sock < 0) {
|
---|
293 | return -1;
|
---|
294 | }
|
---|
295 |
|
---|
296 | dbgprintf("pko_file: file write req (fd: %d)\n", fd);
|
---|
297 |
|
---|
298 | writecmd = (pko_pkt_write_req *)&send_packet[0];
|
---|
299 | writerly = (pko_pkt_file_rly *)&recv_packet[0];
|
---|
300 |
|
---|
301 | hlen = (unsigned short)sizeof(pko_pkt_write_req);
|
---|
302 | writecmd->cmd = htonl(PKO_WRITE_CMD);
|
---|
303 | writecmd->len = htons(hlen);
|
---|
304 | writecmd->fd = htonl(fd);
|
---|
305 |
|
---|
306 | // Divide the write request
|
---|
307 | writtenbytes = 0;
|
---|
308 | while (writtenbytes < length) {
|
---|
309 |
|
---|
310 | if ((length - writtenbytes) > PKO_MAX_WRITE_SEGMENT) {
|
---|
311 | // Need to split in several read reqs
|
---|
312 | nbytes = PKO_MAX_READ_SEGMENT;
|
---|
313 | }
|
---|
314 | else {
|
---|
315 | nbytes = length - writtenbytes;
|
---|
316 | }
|
---|
317 |
|
---|
318 | writecmd->nbytes = htonl(nbytes);
|
---|
319 | #ifdef ZEROCOPY
|
---|
320 | /* Send the packet header. */
|
---|
321 | if (pko_lwip_send(pko_fileio_sock, writecmd, hlen, 0) < 0)
|
---|
322 | return -1;
|
---|
323 | /* Send the write() data. */
|
---|
324 | if (pko_lwip_send(pko_fileio_sock, &buf[writtenbytes], nbytes, 0) < 0)
|
---|
325 | return -1;
|
---|
326 | #else
|
---|
327 | // Copy data to the acutal packet
|
---|
328 | memcpy(&send_packet[sizeof(pko_pkt_write_req)], &buf[writtenbytes],
|
---|
329 | nbytes);
|
---|
330 |
|
---|
331 | if (pko_lwip_send(pko_fileio_sock, writecmd, hlen + nbytes, 0) < 0)
|
---|
332 | return -1;
|
---|
333 | #endif
|
---|
334 |
|
---|
335 |
|
---|
336 | // Get reply
|
---|
337 | if(!pko_accept_pkt(pko_fileio_sock, (char *)writerly,
|
---|
338 | sizeof(pko_pkt_file_rly), PKO_WRITE_RLY)) {
|
---|
339 | dbgprintf("pko_file: pko_write_file: "
|
---|
340 | "did not receive PKO_WRITE_RLY\n");
|
---|
341 | return -1;
|
---|
342 | }
|
---|
343 | retval = ntohl(writerly->retval);
|
---|
344 |
|
---|
345 | dbgprintf("pko_file: wrote %d bytes (asked for %d)\n",
|
---|
346 | retval, nbytes);
|
---|
347 |
|
---|
348 | if (retval < 0) {
|
---|
349 | // Error
|
---|
350 | dbgprintf("pko_file: pko_write_file: received error on write req (%d)\n",
|
---|
351 | retval);
|
---|
352 | return retval;
|
---|
353 | }
|
---|
354 |
|
---|
355 | writtenbytes += retval;
|
---|
356 | if (retval < nbytes) {
|
---|
357 | // EOF?
|
---|
358 | break;
|
---|
359 | }
|
---|
360 | }
|
---|
361 | return writtenbytes;
|
---|
362 | }
|
---|
363 |
|
---|
364 | //----------------------------------------------------------------------
|
---|
365 | //
|
---|
366 | int pko_read_file(int fd, char *buf, int length)
|
---|
367 | {
|
---|
368 | int readbytes;
|
---|
369 | int nbytes;
|
---|
370 | int i;
|
---|
371 | pko_pkt_read_req *readcmd;
|
---|
372 | pko_pkt_read_rly *readrly;
|
---|
373 |
|
---|
374 |
|
---|
375 | if (pko_fileio_sock < 0) {
|
---|
376 | return -1;
|
---|
377 | }
|
---|
378 |
|
---|
379 | readcmd = (pko_pkt_read_req *)&send_packet[0];
|
---|
380 | readrly = (pko_pkt_read_rly *)&recv_packet[0];
|
---|
381 | readbytes = 0;
|
---|
382 |
|
---|
383 | readcmd->cmd = htonl(PKO_READ_CMD);
|
---|
384 | readcmd->len = htons((unsigned short)sizeof(pko_pkt_read_req));
|
---|
385 | readcmd->fd = htonl(fd);
|
---|
386 |
|
---|
387 | readbytes = 0;
|
---|
388 |
|
---|
389 | if (length < 0) {
|
---|
390 | dbgprintf("pko_read_file: illegal req!! (whish to read < 0 bytes!)\n");
|
---|
391 | return -1;
|
---|
392 | }
|
---|
393 |
|
---|
394 | readcmd->nbytes = htonl(length);
|
---|
395 |
|
---|
396 | i = send(pko_fileio_sock, readcmd, sizeof(pko_pkt_read_req), 0);
|
---|
397 | if (i<0)
|
---|
398 | {
|
---|
399 | dbgprintf("pko_file: pko_read_file: send failed (%d)\n", i);
|
---|
400 | return -1;
|
---|
401 | }
|
---|
402 |
|
---|
403 | if(!pko_accept_pkt(pko_fileio_sock, (char *)readrly,
|
---|
404 | sizeof(pko_pkt_read_rly), PKO_READ_RLY)) {
|
---|
405 | dbgprintf("pko_file: pko_read_file: "
|
---|
406 | "did not receive PKO_READ_RLY\n");
|
---|
407 | return -1;
|
---|
408 | }
|
---|
409 |
|
---|
410 | nbytes = ntohl(readrly->nbytes);
|
---|
411 | dbgprintf("pko_file: pko_read_file: Reply said there's %d bytes to read "
|
---|
412 | "(wanted %d)\n", nbytes, length);
|
---|
413 |
|
---|
414 | // Now read the actual file data
|
---|
415 | i = pko_recv_bytes(pko_fileio_sock, &buf[0], nbytes);
|
---|
416 | if (i < 0) {
|
---|
417 | dbgprintf("pko_file: pko_read_file: data read error\n");
|
---|
418 | return -1;
|
---|
419 | }
|
---|
420 | return nbytes;
|
---|
421 | return readbytes;
|
---|
422 | }
|
---|
423 |
|
---|
424 | //----------------------------------------------------------------------
|
---|
425 | //
|
---|
426 | int pko_ioctl(int fd, unsigned long request, void *data)
|
---|
427 | {
|
---|
428 | pko_pkt_ioctl_req *ioctlreq;
|
---|
429 | pko_pkt_file_rly *ioctlrly;
|
---|
430 |
|
---|
431 | if (pko_fileio_sock < 0) {
|
---|
432 | return -1;
|
---|
433 | }
|
---|
434 |
|
---|
435 | dbgprintf("pko_file: ioctl req (%x)\n", request);
|
---|
436 |
|
---|
437 | ioctlreq = (pko_pkt_ioctl_req *)&send_packet[0];
|
---|
438 |
|
---|
439 | // Build packet
|
---|
440 | ioctlreq->cmd = htonl(PKO_IOCTL_CMD);
|
---|
441 | ioctlreq->len = htons((unsigned short)sizeof(pko_pkt_ioctl_req));
|
---|
442 | ioctlreq->fd = htonl(fd);
|
---|
443 | ioctlreq->request = htonl(request);
|
---|
444 | memcpy(ioctlreq->data, data, 256);
|
---|
445 |
|
---|
446 | if (pko_lwip_send(pko_fileio_sock, ioctlreq, sizeof(pko_pkt_ioctl_req), 0) < 0) {
|
---|
447 | return -1;
|
---|
448 | }
|
---|
449 |
|
---|
450 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
451 | sizeof(pko_pkt_file_rly), PKO_IOCTL_RLY)) {
|
---|
452 | dbgprintf("pko_file: pko_ioctl: did not receive IOCTL_RLY\n");
|
---|
453 | return -1;
|
---|
454 | }
|
---|
455 |
|
---|
456 | ioctlrly = (pko_pkt_file_rly *)recv_packet;
|
---|
457 | dbgprintf("pko_file: ioctl reply received (ret %d)\n", ntohl(ioctlrly->retval));
|
---|
458 | return ntohl(ioctlrly->retval);
|
---|
459 | }
|
---|
460 |
|
---|
461 | //----------------------------------------------------------------------
|
---|
462 | //
|
---|
463 | int pko_remove(char *name)
|
---|
464 | {
|
---|
465 | pko_pkt_remove_req *removereq;
|
---|
466 | pko_pkt_file_rly *removerly;
|
---|
467 |
|
---|
468 | if (pko_fileio_sock < 0) {
|
---|
469 | return -1;
|
---|
470 | }
|
---|
471 |
|
---|
472 | dbgprintf("pko_file: file remove req (%s)\n", name);
|
---|
473 |
|
---|
474 | removereq = (pko_pkt_remove_req *)&send_packet[0];
|
---|
475 |
|
---|
476 | // Build packet
|
---|
477 | removereq->cmd = htonl(PKO_REMOVE_CMD);
|
---|
478 | removereq->len = htons((unsigned short)sizeof(pko_pkt_remove_req));
|
---|
479 | strncpy(removereq->name, name, PKO_MAX_PATH);
|
---|
480 | removereq->name[PKO_MAX_PATH - 1] = 0; // Make sure it's null-terminated
|
---|
481 |
|
---|
482 | if (pko_lwip_send(pko_fileio_sock, removereq, sizeof(pko_pkt_remove_req), 0) < 0) {
|
---|
483 | return -1;
|
---|
484 | }
|
---|
485 |
|
---|
486 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
487 | sizeof(pko_pkt_file_rly), PKO_REMOVE_RLY)) {
|
---|
488 | dbgprintf("pko_file: pko_remove: did not receive REMOVE_RLY\n");
|
---|
489 | return -1;
|
---|
490 | }
|
---|
491 |
|
---|
492 | removerly = (pko_pkt_file_rly *)recv_packet;
|
---|
493 | dbgprintf("pko_file: file remove reply received (ret %d)\n", ntohl(removerly->retval));
|
---|
494 | return ntohl(removerly->retval);
|
---|
495 | }
|
---|
496 |
|
---|
497 | //----------------------------------------------------------------------
|
---|
498 | //
|
---|
499 | int pko_mkdir(char *name, int mode)
|
---|
500 | {
|
---|
501 | pko_pkt_mkdir_req *mkdirreq;
|
---|
502 | pko_pkt_file_rly *mkdirrly;
|
---|
503 |
|
---|
504 | if (pko_fileio_sock < 0) {
|
---|
505 | return -1;
|
---|
506 | }
|
---|
507 |
|
---|
508 | dbgprintf("pko_file: make dir req (%s)\n", name);
|
---|
509 |
|
---|
510 | mkdirreq = (pko_pkt_mkdir_req *)&send_packet[0];
|
---|
511 |
|
---|
512 | // Build packet
|
---|
513 | mkdirreq->cmd = htonl(PKO_MKDIR_CMD);
|
---|
514 | mkdirreq->len = htons((unsigned short)sizeof(pko_pkt_mkdir_req));
|
---|
515 | mkdirreq->mode = mode;
|
---|
516 | strncpy(mkdirreq->name, name, PKO_MAX_PATH);
|
---|
517 | mkdirreq->name[PKO_MAX_PATH - 1] = 0; // Make sure it's null-terminated
|
---|
518 |
|
---|
519 | if (pko_lwip_send(pko_fileio_sock, mkdirreq, sizeof(pko_pkt_mkdir_req), 0) < 0) {
|
---|
520 | return -1;
|
---|
521 | }
|
---|
522 |
|
---|
523 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
524 | sizeof(pko_pkt_file_rly), PKO_MKDIR_RLY)) {
|
---|
525 | dbgprintf("pko_file: pko_mkdir: did not receive MKDIR_RLY\n");
|
---|
526 | return -1;
|
---|
527 | }
|
---|
528 |
|
---|
529 | mkdirrly = (pko_pkt_file_rly *)recv_packet;
|
---|
530 | dbgprintf("pko_file: make dir reply received (ret %d)\n", ntohl(mkdirrly->retval));
|
---|
531 | return ntohl(mkdirrly->retval);
|
---|
532 | }
|
---|
533 |
|
---|
534 | //----------------------------------------------------------------------
|
---|
535 | //
|
---|
536 | int pko_rmdir(char *name)
|
---|
537 | {
|
---|
538 | pko_pkt_rmdir_req *rmdirreq;
|
---|
539 | pko_pkt_file_rly *rmdirrly;
|
---|
540 |
|
---|
541 | if (pko_fileio_sock < 0) {
|
---|
542 | return -1;
|
---|
543 | }
|
---|
544 |
|
---|
545 | dbgprintf("pko_file: remove dir req (%s)\n", name);
|
---|
546 |
|
---|
547 | rmdirreq = (pko_pkt_rmdir_req *)&send_packet[0];
|
---|
548 |
|
---|
549 | // Build packet
|
---|
550 | rmdirreq->cmd = htonl(PKO_RMDIR_CMD);
|
---|
551 | rmdirreq->len = htons((unsigned short)sizeof(pko_pkt_rmdir_req));
|
---|
552 | strncpy(rmdirreq->name, name, PKO_MAX_PATH);
|
---|
553 | rmdirreq->name[PKO_MAX_PATH - 1] = 0; // Make sure it's null-terminated
|
---|
554 |
|
---|
555 | if (pko_lwip_send(pko_fileio_sock, rmdirreq, sizeof(pko_pkt_rmdir_req), 0) < 0) {
|
---|
556 | return -1;
|
---|
557 | }
|
---|
558 |
|
---|
559 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
560 | sizeof(pko_pkt_file_rly), PKO_RMDIR_RLY)) {
|
---|
561 | dbgprintf("pko_file: pko_rmdir: did not receive RMDIR_RLY\n");
|
---|
562 | return -1;
|
---|
563 | }
|
---|
564 |
|
---|
565 | rmdirrly = (pko_pkt_file_rly *)recv_packet;
|
---|
566 | dbgprintf("pko_file: remove dir reply received (ret %d)\n", ntohl(rmdirrly->retval));
|
---|
567 | return ntohl(rmdirrly->retval);
|
---|
568 | }
|
---|
569 |
|
---|
570 | //----------------------------------------------------------------------
|
---|
571 | //
|
---|
572 | int pko_open_dir(char *path)
|
---|
573 | {
|
---|
574 | pko_pkt_open_req *openreq;
|
---|
575 | pko_pkt_file_rly *openrly;
|
---|
576 |
|
---|
577 | if (pko_fileio_sock < 0) {
|
---|
578 | return -1;
|
---|
579 | }
|
---|
580 |
|
---|
581 | dbgprintf("pko_file: dir open req (%s)\n", path);
|
---|
582 |
|
---|
583 | openreq = (pko_pkt_open_req *)&send_packet[0];
|
---|
584 |
|
---|
585 | // Build packet
|
---|
586 | openreq->cmd = htonl(PKO_OPENDIR_CMD);
|
---|
587 | openreq->len = htons((unsigned short)sizeof(pko_pkt_open_req));
|
---|
588 | openreq->flags = htonl(0);
|
---|
589 | strncpy(openreq->path, path, PKO_MAX_PATH);
|
---|
590 | openreq->path[PKO_MAX_PATH - 1] = 0; // Make sure it's null-terminated
|
---|
591 |
|
---|
592 | if (pko_lwip_send(pko_fileio_sock, openreq, sizeof(pko_pkt_open_req), 0) < 0) {
|
---|
593 | return -1;
|
---|
594 | }
|
---|
595 |
|
---|
596 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
597 | sizeof(pko_pkt_file_rly), PKO_OPENDIR_RLY)) {
|
---|
598 | dbgprintf("pko_file: pko_open_dir: did not receive OPENDIR_RLY\n");
|
---|
599 | return -1;
|
---|
600 | }
|
---|
601 |
|
---|
602 | openrly = (pko_pkt_file_rly *)recv_packet;
|
---|
603 |
|
---|
604 | dbgprintf("pko_file: dir open reply received (ret %d)\n", ntohl(openrly->retval));
|
---|
605 |
|
---|
606 | return ntohl(openrly->retval);
|
---|
607 | }
|
---|
608 |
|
---|
609 | //----------------------------------------------------------------------
|
---|
610 | //
|
---|
611 | int pko_read_dir(int fd, void *buf)
|
---|
612 | {
|
---|
613 | pko_pkt_dread_req *dirreq;
|
---|
614 | pko_pkt_dread_rly *dirrly;
|
---|
615 | fio_dirent_t *dirent;
|
---|
616 |
|
---|
617 | if (pko_fileio_sock < 0) {
|
---|
618 | return -1;
|
---|
619 | }
|
---|
620 |
|
---|
621 | dbgprintf("pko_file: dir read req (%x)\n", fd);
|
---|
622 |
|
---|
623 | dirreq = (pko_pkt_dread_req *)&send_packet[0];
|
---|
624 |
|
---|
625 | // Build packet
|
---|
626 | dirreq->cmd = htonl(PKO_READDIR_CMD);
|
---|
627 | dirreq->len = htons((unsigned short)sizeof(pko_pkt_dread_req));
|
---|
628 | dirreq->fd = htonl(fd);
|
---|
629 |
|
---|
630 | if (pko_lwip_send(pko_fileio_sock, dirreq, sizeof(pko_pkt_dread_req), 0) < 0) {
|
---|
631 | return -1;
|
---|
632 | }
|
---|
633 |
|
---|
634 | if (!pko_accept_pkt(pko_fileio_sock, recv_packet,
|
---|
635 | sizeof(pko_pkt_dread_rly), PKO_READDIR_RLY)) {
|
---|
636 | dbgprintf("pko_file: pko_open_file: did not receive OPENDIR_RLY\n");
|
---|
637 | return -1;
|
---|
638 | }
|
---|
639 |
|
---|
640 | dirrly = (pko_pkt_dread_rly *)recv_packet;
|
---|
641 |
|
---|
642 | dbgprintf("pko_file: dir read reply received (ret %d)\n", ntohl(dirrly->retval));
|
---|
643 |
|
---|
644 | dirent = (fio_dirent_t *) buf;
|
---|
645 | // now handle the return buffer translation, to build reply bit
|
---|
646 | dirent->stat.mode = ntohl(dirrly->mode);
|
---|
647 | dirent->stat.attr = ntohl(dirrly->attr);
|
---|
648 | dirent->stat.size = ntohl(dirrly->size);
|
---|
649 | dirent->stat.hisize = ntohl(dirrly->hisize);
|
---|
650 | memcpy(dirent->stat.ctime,dirrly->ctime,8*3);
|
---|
651 | strncpy(dirent->name,dirrly->name,256);
|
---|
652 | dirent->unknown = 0;
|
---|
653 |
|
---|
654 | return ntohl(dirrly->retval);
|
---|
655 | }
|
---|
656 |
|
---|
657 |
|
---|
658 | //----------------------------------------------------------------------
|
---|
659 | //
|
---|
660 | int pko_close_dir(int fd)
|
---|
661 | {
|
---|
662 | pko_pkt_close_req *closereq;
|
---|
663 | pko_pkt_file_rly *closerly;
|
---|
664 |
|
---|
665 |
|
---|
666 | if (pko_fileio_sock < 0) {
|
---|
667 | return -1;
|
---|
668 | }
|
---|
669 |
|
---|
670 | dbgprintf("pko_file: dir close req (fd: %d)\n", fd);
|
---|
671 |
|
---|
672 | closereq = (pko_pkt_close_req *)&send_packet[0];
|
---|
673 | closerly = (pko_pkt_file_rly *)&recv_packet[0];
|
---|
674 |
|
---|
675 | closereq->cmd = htonl(PKO_CLOSEDIR_CMD);
|
---|
676 | closereq->len = htons((unsigned short)sizeof(pko_pkt_close_req));
|
---|
677 | closereq->fd = htonl(fd);
|
---|
678 |
|
---|
679 | if (pko_lwip_send(pko_fileio_sock, closereq, sizeof(pko_pkt_close_req), 0) < 0) {
|
---|
680 | return -1;
|
---|
681 | }
|
---|
682 |
|
---|
683 | if(!pko_accept_pkt(pko_fileio_sock, (char *)closerly,
|
---|
684 | sizeof(pko_pkt_file_rly), PKO_CLOSEDIR_RLY)) {
|
---|
685 | dbgprintf("pko_file: pko_close_dir: did not receive PKO_CLOSEDIR_RLY\n");
|
---|
686 | return -1;
|
---|
687 | }
|
---|
688 |
|
---|
689 | dbgprintf("pko_file: dir close reply received (ret %d)\n",
|
---|
690 | ntohl(closerly->retval));
|
---|
691 |
|
---|
692 | return ntohl(closerly->retval);
|
---|
693 | }
|
---|
694 |
|
---|
695 | //----------------------------------------------------------------------
|
---|
696 | // Thread that waits for a PC to connect/disconnect/reconnect blah..
|
---|
697 | int
|
---|
698 | pko_file_serv(void *argv)
|
---|
699 | {
|
---|
700 | struct sockaddr_in server_addr;
|
---|
701 | struct sockaddr_in client_addr;
|
---|
702 | int sock;
|
---|
703 | int client_sock;
|
---|
704 | int client_len;
|
---|
705 | int ret;
|
---|
706 |
|
---|
707 | dbgprintf(" - PS2 Side application -\n");
|
---|
708 |
|
---|
709 | memset((void *)&server_addr, 0, sizeof(server_addr));
|
---|
710 | // Should perhaps specify PC side ip..
|
---|
711 | server_addr.sin_family = AF_INET;
|
---|
712 | server_addr.sin_addr.s_addr = htonl(INADDR_ANY);
|
---|
713 | server_addr.sin_port = htons(PKO_PORT);
|
---|
714 |
|
---|
715 | while ((sock = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP)) < 0) {
|
---|
716 | dbgprintf("pko_file: socket creation error (%d)\n", sock);
|
---|
717 | return -1;
|
---|
718 | }
|
---|
719 |
|
---|
720 | ret = bind(sock, (struct sockaddr *)&server_addr,
|
---|
721 | sizeof(server_addr));
|
---|
722 | if (ret < 0) {
|
---|
723 | dbgprintf("pko_file: bind error (%d)\n", ret);
|
---|
724 | disconnect(sock);
|
---|
725 | return -1;
|
---|
726 | }
|
---|
727 |
|
---|
728 | ret = listen(sock, 5);
|
---|
729 |
|
---|
730 | if (ret < 0) {
|
---|
731 | dbgprintf("pko_file: listen error (%d)\n", ret);
|
---|
732 | disconnect(sock);
|
---|
733 | return -1;
|
---|
734 | }
|
---|
735 |
|
---|
736 | // Active flag kinda sux, cause it wont be checked until a new client has
|
---|
737 | // connected.. But it's better than nothing and good for now at least
|
---|
738 | pko_fileio_active = 1;
|
---|
739 |
|
---|
740 | // Connection loop
|
---|
741 | while(pko_fileio_active)
|
---|
742 | {
|
---|
743 | dbgprintf("Waiting for connection\n");
|
---|
744 |
|
---|
745 | client_len = sizeof(client_addr);
|
---|
746 | client_sock = accept(sock, (struct sockaddr *)&client_addr,
|
---|
747 | &client_len);
|
---|
748 | if (client_sock < 0) {
|
---|
749 | dbgprintf("pko_file: accept error (%d)", client_sock);
|
---|
750 | continue;
|
---|
751 | }
|
---|
752 |
|
---|
753 | dbgprintf("Client connected from %x\n",
|
---|
754 | client_addr.sin_addr.s_addr);
|
---|
755 |
|
---|
756 | remote_pc_addr = client_addr.sin_addr.s_addr;
|
---|
757 |
|
---|
758 | if (pko_fileio_sock > 0) {
|
---|
759 | dbgprintf("Client reconnected\n");
|
---|
760 | ret = disconnect(pko_fileio_sock);
|
---|
761 | dbgprintf("close ret %d\n", ret);
|
---|
762 | }
|
---|
763 | pko_fileio_sock = client_sock;
|
---|
764 | }
|
---|
765 |
|
---|
766 | if (pko_fileio_sock > 0) {
|
---|
767 | disconnect(pko_fileio_sock);
|
---|
768 | }
|
---|
769 |
|
---|
770 | disconnect(sock);
|
---|
771 |
|
---|
772 | ExitDeleteThread();
|
---|
773 | return 0;
|
---|
774 | }
|
---|