123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159 |
- /*
- * Copyright 2001-2019 Georges Menie (www.menie.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:
- *
- * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * * 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.
- * * Neither the name of the University of California, Berkeley 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 THE REGENTS 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 AND 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.
- */
- /* this code needs standard functions memcpy() and memset()
- and input/output functions _inbyte() and _outbyte().
- the prototypes of the input/output functions are:
- int _inbyte(unsigned short timeout); // msec timeout
- void _outbyte(int c);
- */
- #include "crc16.h"
- #include <sys.h>
- #include <uart.h>
- #define SOH 0x01
- #define STX 0x02
- #define EOT 0x04
- #define ACK 0x06
- #define NAK 0x15
- #define CAN 0x18
- #define CTRLZ 0x1A
- #define DLY_1S 1000
- #define MAXRETRANS 1000
- static int check(int crc, const unsigned char *buf, int sz)
- {
- if (crc) {
- unsigned short crc = crc16_ccitt(buf, sz);
- unsigned short tcrc = (buf[sz]<<8)+buf[sz+1];
- if (crc == tcrc)
- return 1;
- }
- else {
- int i;
- unsigned char cks = 0;
- for (i = 0; i < sz; ++i) {
- cks += buf[i];
- }
- if (cks == buf[sz])
- return 1;
- }
- return 0;
- }
- static void flushinput(void)
- {
- while (_inbyte(((DLY_1S)*3)>>1) >= 0)
- ;
- }
- int xmodemReceive(unsigned char *dest, int destsz)
- {
- unsigned char xbuff[1030]; /* 1024 for XModem 1k + 3 head chars + 2 crc + nul */
- unsigned char *p;
- int bufsz, crc = 0;
- unsigned char trychar = 'C';
- unsigned char packetno = 1;
- int i, c, len = 0;
- int retry, retrans = MAXRETRANS;
- for(;;) {
- for( retry = 0; retry < MAXRETRANS; ++retry) {
- if (trychar) _outbyte(trychar);
- if ((c = _inbyte((DLY_1S))) >= 0) {
- switch (c) {
- case SOH:
- bufsz = 128;
- goto start_recv;
- case STX:
- bufsz = 1024;
- goto start_recv;
- case EOT:
- flushinput();
- _outbyte(ACK);
- return len; /* normal end */
- case CAN:
- if ((c = _inbyte(DLY_1S)) == CAN) {
- flushinput();
- _outbyte(ACK);
- return -1; /* canceled by remote */
- }
- break;
- default:
- break;
- }
- }
- }
- if (trychar == 'C') { trychar = NAK; continue; }
- flushinput();
- _outbyte(CAN);
- _outbyte(CAN);
- _outbyte(CAN);
- return -2; /* sync error */
- start_recv:
- if (trychar == 'C') crc = 1;
- trychar = 0;
- p = xbuff;
- *p++ = c;
- for (i = 0; i < (bufsz+(crc?1:0)+3); ++i) {
- if ((c = _inbyte(DLY_1S)) < 0) goto reject;
- *p++ = c;
- }
- if (xbuff[1] == (unsigned char)(~xbuff[2]) &&
- (xbuff[1] == packetno || xbuff[1] == (unsigned char)packetno-1) &&
- check(crc, &xbuff[3], bufsz)) {
- if (xbuff[1] == packetno) {
- // register int count = destsz - len;
- // if (count > bufsz) count = bufsz;
- if (bufsz > 0) {
- sys_memcpy (&dest[len], &xbuff[3], bufsz);
- len += bufsz;
- }
- ++packetno;
- retrans = MAXRETRANS+1;
- }
- if (--retrans <= 0) {
- flushinput();
- _outbyte(CAN);
- _outbyte(CAN);
- _outbyte(CAN);
- return -3; /* too many retry error */
- }
- _outbyte(ACK);
- continue;
- }
- reject:
- flushinput();
- _outbyte(NAK);
- }
- }
|