|
|
| version 1.4.2.1, 2014/02/21 08:32:33 | version 1.7.2.2, 2014/02/24 22:02:19 |
|---|---|
| Line 1 | Line 1 |
| /************************************************************************* | |
| * (C) 2014 AITNET ltd - Sofia/Bulgaria - <misho@aitnet.org> | |
| * by Michael Pounov <misho@elwix.org> | |
| * | |
| * $Author$ | |
| * $Id$ | |
| * | |
| ************************************************************************** | |
| The ELWIX and AITNET software is distributed under the following | |
| terms: | |
| All of the documentation and software included in the ELWIX and AITNET | |
| Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> | |
| Copyright 2004 - 2014 | |
| by Michael Pounov <misho@elwix.org>. All rights reserved. | |
| Redistribution and use in source and binary forms, with or without | |
| modification, are permitted provided that the following conditions | |
| are met: | |
| 1. Redistributions of source code must retain the above copyright | |
| notice, this list of conditions and the following disclaimer. | |
| 2. Redistributions in binary form must reproduce the above copyright | |
| notice, this list of conditions and the following disclaimer in the | |
| documentation and/or other materials provided with the distribution. | |
| 3. All advertising materials mentioning features or use of this software | |
| must display the following acknowledgement: | |
| This product includes software developed by Michael Pounov <misho@elwix.org> | |
| ELWIX - Embedded LightWeight unIX and its contributors. | |
| 4. Neither the name of AITNET nor the names of its contributors | |
| may be used to endorse or promote products derived from this software | |
| without specific prior written permission. | |
| THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND | |
| ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |
| ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE | |
| FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL | |
| DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS | |
| OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) | |
| HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT | |
| LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY | |
| OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |
| SUCH DAMAGE. | |
| */ | |
| #include "global.h" | #include "global.h" |
| #include "exec.h" | #include "exec.h" |
| #include "buf.h" | |
| #include "srv.h" | #include "srv.h" |
| Line 10 timeoutSession(sched_task_t *task) | Line 56 timeoutSession(sched_task_t *task) |
| ETRACE(); | ETRACE(); |
| if (bf) | |
| flushBuffer(cli.fd); | |
| /* drop session */ | /* drop session */ |
| if (cli.fd > 2) | if (cli.fd > 2) |
| close(cli.fd); | close(cli.fd); |
| Line 76 txData(sched_task_t *task) | Line 125 txData(sched_task_t *task) |
| len = pread(cli.fd, RPACK_NEXT(pkt), len, (cli.seq - 1) * cli.siz); | len = pread(cli.fd, RPACK_NEXT(pkt), len, (cli.seq - 1) * cli.siz); |
| if (len == -1) { | if (len == -1) { |
| ESYSERR(0); | ESYSERR(0); |
| code = htole16(3); | code = htons(3); |
| goto end; | goto end; |
| } else { | } else { |
| rpack_rnext(pkt, len); | rpack_rnext(pkt, len); |
| Line 94 end: | Line 143 end: |
| n = htons(TFTP_OPC_ERROR); | n = htons(TFTP_OPC_ERROR); |
| rpack_uint16(pkt, &n, 0); | rpack_uint16(pkt, &n, 0); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[le16toh(code)].err_msg, strlen(errs[le16toh(code)].err_msg) + 1); | rpack_rdata(pkt, errs[ntohs(code)].err_msg, strlen(errs[ntohs(code)].err_msg) + 1); |
| schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), | schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), |
| TASK_DATA(task), RPACK_OFF(pkt)); | TASK_DATA(task), RPACK_OFF(pkt)); |
| Line 122 txAck(sched_task_t *task) | Line 171 txAck(sched_task_t *task) |
| schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_CALL, timeoutSession, NULL); | schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_CALL, timeoutSession, NULL); |
| schedEvent(TASK_ROOT(task), timeoutSession, NULL, 0, TASK_DATA(task), 0); | schedEvent(TASK_ROOT(task), timeoutSession, NULL, 0, TASK_DATA(task), 0); |
| EVERBOSE(2, "Finish WRQ request"); | EVERBOSE(2, "Finish WRQ request"); |
| schedResumeby(TASK_ROOT(task), CRITERIA_ID, 0); | |
| } | } |
| taskExit(task, NULL); | taskExit(task, NULL); |
| } | } |
| Line 163 getOpts(rpack_t * __restrict pkt, int rlen) | Line 213 getOpts(rpack_t * __restrict pkt, int rlen) |
| cli.tsiz = strtoll(val, NULL, 10); | cli.tsiz = strtoll(val, NULL, 10); |
| else if (!strcasecmp(opt, TFTP_OPT_TIMEOUT)) | else if (!strcasecmp(opt, TFTP_OPT_TIMEOUT)) |
| cli.tout.tv_sec = strtol(val, NULL, 10); | cli.tout.tv_sec = strtol(val, NULL, 10); |
| else if (!strcasecmp(opt, TFTP_OPT_ROLLOVER)) | else if (!strcasecmp(opt, TFTP_OPT_ROLLOVER)) { |
| cli.roll = strtol(val, NULL, 10); | cli.roll = strtol(val, NULL, 10); |
| cli.roll++; | |
| } | |
| } while (rlen > 0); | } while (rlen > 0); |
| EVERBOSE(4, "blksize=%u tsize=%llu timeout=%u rollover=%u", | EVERBOSE(4, "blksize=%u tsize=%llu timeout=%d rollover=%u", |
| cli.siz, cli.tsiz, cli.tout.tv_sec, cli.roll); | cli.siz, cli.tsiz, (int) cli.tout.tv_sec, cli.roll - 1); |
| return 0; | return 0; |
| } | } |
| Line 203 txOack(sched_task_t *task) | Line 255 txOack(sched_task_t *task) |
| } | } |
| if (cli.tout.tv_sec) { | if (cli.tout.tv_sec) { |
| memset(szStr, 0, sizeof szStr); | memset(szStr, 0, sizeof szStr); |
| snprintf(szStr, sizeof szStr, "%u", cli.tout.tv_sec); | snprintf(szStr, sizeof szStr, "%d", (int) cli.tout.tv_sec); |
| rpack_rdata(pkt, TFTP_OPT_TIMEOUT, strlen(TFTP_OPT_TIMEOUT) + 1); | rpack_rdata(pkt, TFTP_OPT_TIMEOUT, strlen(TFTP_OPT_TIMEOUT) + 1); |
| rpack_rdata(pkt, szStr, strlen(szStr) + 1); | rpack_rdata(pkt, szStr, strlen(szStr) + 1); |
| } | } |
| if (cli.roll) { | if (cli.roll) { |
| memset(szStr, 0, sizeof szStr); | memset(szStr, 0, sizeof szStr); |
| snprintf(szStr, sizeof szStr, "%u", cli.roll); | snprintf(szStr, sizeof szStr, "%u", cli.roll - 1); |
| rpack_rdata(pkt, TFTP_OPT_ROLLOVER, strlen(TFTP_OPT_ROLLOVER) + 1); | rpack_rdata(pkt, TFTP_OPT_ROLLOVER, strlen(TFTP_OPT_ROLLOVER) + 1); |
| rpack_rdata(pkt, szStr, strlen(szStr) + 1); | rpack_rdata(pkt, szStr, strlen(szStr) + 1); |
| } | } |
| EVERBOSE(4, "blksize=%u tsize=%llu timeout=%u rollover=%u", | EVERBOSE(4, "blksize=%u tsize=%llu timeout=%d rollover=%u", |
| cli.siz, cli.tsiz, cli.tout.tv_sec, cli.roll); | cli.siz, cli.tsiz, (int) cli.tout.tv_sec, cli.roll - 1); |
| schedCallOnce(TASK_ROOT(task), txPkt, NULL, TASK_FD(task), | schedCallOnce(TASK_ROOT(task), txPkt, NULL, TASK_FD(task), |
| TASK_DATA(task), RPACK_OFF(pkt)); | TASK_DATA(task), RPACK_OFF(pkt)); |
| taskExit(task, NULL); | taskExit(task, NULL); |
| Line 234 RQ(sched_task_t *task) | Line 286 RQ(sched_task_t *task) |
| cli.siz = TFTP_LOAD_MAX; | cli.siz = TFTP_LOAD_MAX; |
| cli.opc = ntohs(rpack_uint16(pkt, NULL, 0)); | cli.opc = ntohs(rpack_uint16(pkt, NULL, 0)); |
| if (!RW && cli.opc == TFTP_OPC_WRQ) { | |
| code = 2; | |
| goto end; | |
| } | |
| len = str_getString(RPACK_NEXT(pkt), rlen, &str); | len = str_getString(RPACK_NEXT(pkt), rlen, &str); |
| if (len == -1) | if (len == -1) |
| goto end; | goto end; |
| Line 254 RQ(sched_task_t *task) | Line 310 RQ(sched_task_t *task) |
| strlcpy(cli.mode, TFTP_MODE_OCTET, sizeof cli.mode); | strlcpy(cli.mode, TFTP_MODE_OCTET, sizeof cli.mode); |
| else if (!strcasecmp(str, TFTP_MODE_MAIL)) { | else if (!strcasecmp(str, TFTP_MODE_MAIL)) { |
| strlcpy(cli.mode, TFTP_MODE_MAIL, sizeof cli.mode); | strlcpy(cli.mode, TFTP_MODE_MAIL, sizeof cli.mode); |
| code = htole16(4); | code = htons(4); |
| goto end; | goto end; |
| } else { | } else { |
| code = htole16(1); | code = htons(1); |
| goto end; | goto end; |
| } | } |
| } | } |
| Line 279 RQ(sched_task_t *task) | Line 335 RQ(sched_task_t *task) |
| cli.fd = open(cli.file, code, 0644); | cli.fd = open(cli.file, code, 0644); |
| if (cli.fd == -1) { | if (cli.fd == -1) { |
| if (errno == EACCES) | if (errno == EACCES) |
| code = htole16(2); | code = htons(2); |
| else if (errno == ENFILE) | else if (errno == ENFILE) |
| code = htole16(3); | code = htons(3); |
| else if (errno == EEXIST) | else if (errno == EEXIST) |
| code = htole16(6); | code = htons(6); |
| else if (errno == ENOENT) | |
| code = htons(1); | |
| else | else |
| code = htole16(0); | code = htons(0); |
| ESYSERR(0); | ESYSERR(0); |
| goto end; | goto end; |
| } else | } else |
| Line 328 end: | Line 386 end: |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| rpack_uint16(pkt, NULL, 0); | rpack_uint16(pkt, NULL, 0); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[le16toh(code)].err_msg, strlen(errs[le16toh(code)].err_msg) + 1); | rpack_rdata(pkt, errs[ntohs(code)].err_msg, strlen(errs[ntohs(code)].err_msg) + 1); |
| schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), | schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), |
| TASK_DATA(task), RPACK_OFF(pkt)); | TASK_DATA(task), RPACK_OFF(pkt)); |
| Line 347 ACK(sched_task_t *task) | Line 405 ACK(sched_task_t *task) |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| code = rpack_uint16(pkt, NULL, 0); | code = rpack_uint16(pkt, NULL, 0); |
| if (ntohs(code) != TFTP_OPC_ACK) { | if (ntohs(code) != TFTP_OPC_ACK) { |
| code = htole16(5); | code = htons(5); |
| goto end; | goto end; |
| } | } |
| code = rpack_uint16(pkt, NULL, 0); | code = rpack_uint16(pkt, NULL, 0); |
| if (ntohs(code) > cli.seq || (ntohs(code) < (cli.seq - 1))) { | if (ntohs(code) > cli.seq || (ntohs(code) < (cli.seq - 1))) { |
| code = htole16(5); | code = htons(5); |
| goto end; | goto end; |
| } else if (ntohs(code) == cli.seq) { | } else if (ntohs(code) == cli.seq) { |
| /* check for rollover seq id */ | /* check for rollover seq id */ |
| if (cli.roll && cli.seq == USHRT_MAX) | if (cli.roll && cli.seq == USHRT_MAX) |
| cli.seq = cli.roll; | cli.seq = cli.roll - 1; |
| else | else |
| cli.seq++; | cli.seq++; |
| } | } |
| Line 380 end: | Line 438 end: |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| rpack_uint16(pkt, NULL, 0); | rpack_uint16(pkt, NULL, 0); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[le16toh(code)].err_msg, strlen(errs[le16toh(code)].err_msg) + 1); | rpack_rdata(pkt, errs[ntohs(code)].err_msg, strlen(errs[ntohs(code)].err_msg) + 1); |
| schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), | schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), |
| TASK_DATA(task), RPACK_OFF(pkt)); | TASK_DATA(task), RPACK_OFF(pkt)); |
| Line 400 DATA(sched_task_t *task) | Line 458 DATA(sched_task_t *task) |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| code = rpack_uint16(pkt, NULL, 0); | code = rpack_uint16(pkt, NULL, 0); |
| if (ntohs(code) != TFTP_OPC_DATA) { | if (ntohs(code) != TFTP_OPC_DATA) { |
| code = htole16(5); | code = htons(5); |
| goto end; | goto end; |
| } | } |
| code = rpack_uint16(pkt, NULL, 0); | code = rpack_uint16(pkt, NULL, 0); |
| if (ntohs(code) < cli.seq || ntohs(code) > cli.seq + 1) { | if (ntohs(code) < cli.seq || ntohs(code) > cli.seq + 1) { |
| code = htole16(5); | code = htons(5); |
| goto end; | goto end; |
| } else | } else |
| cli.seq = ntohs(code); | cli.seq = ntohs(code); |
| Line 420 DATA(sched_task_t *task) | Line 478 DATA(sched_task_t *task) |
| EVERBOSE(3, "DATA:: seq=%hu; len=%d", cli.seq, len); | EVERBOSE(3, "DATA:: seq=%hu; len=%d", cli.seq, len); |
| len = pwrite(cli.fd, RPACK_NEXT(pkt), len, (cli.seq - 1) * cli.siz); | if (!bf) |
| len = pwrite(cli.fd, RPACK_NEXT(pkt), len, (cli.seq - 1) * cli.siz); | |
| else | |
| len = bfwrite(cli.fd, RPACK_NEXT(pkt), len); | |
| if (len == -1) { | if (len == -1) { |
| ESYSERR(0); | ESYSERR(0); |
| code = htole16(3); | code = htons(3); |
| goto end; | goto end; |
| } else { | } else { |
| rpack_rnext(pkt, len); | rpack_rnext(pkt, len); |
| Line 437 end: | Line 498 end: |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| rpack_uint16(pkt, NULL, 0); | rpack_uint16(pkt, NULL, 0); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[le16toh(code)].err_msg, strlen(errs[le16toh(code)].err_msg) + 1); | rpack_rdata(pkt, errs[ntohs(code)].err_msg, strlen(errs[ntohs(code)].err_msg) + 1); |
| schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), | schedEvent(TASK_ROOT(task), txPkt, (void*) -1, TASK_FD(task), |
| TASK_DATA(task), RPACK_OFF(pkt)); | TASK_DATA(task), RPACK_OFF(pkt)); |
| Line 475 rxPkt(sched_task_t *task) | Line 536 rxPkt(sched_task_t *task) |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| code = htons(TFTP_OPC_ERROR); | code = htons(TFTP_OPC_ERROR); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| code = htole16(4); | code = htons(4); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[4].err_msg, strlen(errs[4].err_msg) + 1); | rpack_rdata(pkt, errs[4].err_msg, strlen(errs[4].err_msg) + 1); |
| Line 503 rxPkt(sched_task_t *task) | Line 564 rxPkt(sched_task_t *task) |
| RPACK_REWIND(pkt); | RPACK_REWIND(pkt); |
| code = htons(TFTP_OPC_ERROR); | code = htons(TFTP_OPC_ERROR); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| code = htole16(4); | code = htons(4); |
| rpack_uint16(pkt, &code, 0); | rpack_uint16(pkt, &code, 0); |
| rpack_rdata(pkt, errs[4].err_msg, strlen(errs[4].err_msg) + 1); | rpack_rdata(pkt, errs[4].err_msg, strlen(errs[4].err_msg) + 1); |