| 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 | } |