blob: a209dfa4af73d134bcf647511ad6cd7fabe9406f [file] [log] [blame]
Wolfgang Denkebd3deb2006-04-16 10:51:58 +02001/*
2 *==========================================================================
3 *
4 * xyzModem.c
5 *
6 * RedBoot stream handler for xyzModem protocol
7 *
8 *==========================================================================
9 *####ECOSGPLCOPYRIGHTBEGIN####
10 * -------------------------------------------
11 * This file is part of eCos, the Embedded Configurable Operating System.
12 * Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
13 * Copyright (C) 2002 Gary Thomas
14 *
15 * eCos is free software; you can redistribute it and/or modify it under
16 * the terms of the GNU General Public License as published by the Free
17 * Software Foundation; either version 2 or (at your option) any later version.
18 *
19 * eCos is distributed in the hope that it will be useful, but WITHOUT ANY
20 * WARRANTY; without even the implied warranty of MERCHANTABILITY or
21 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
22 * for more details.
23 *
24 * You should have received a copy of the GNU General Public License along
25 * with eCos; if not, write to the Free Software Foundation, Inc.,
26 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
27 *
28 * As a special exception, if other files instantiate templates or use macros
29 * or inline functions from this file, or you compile this file and link it
30 * with other works to produce a work based on this file, this file does not
31 * by itself cause the resulting work to be covered by the GNU General Public
32 * License. However the source code for this file must still be made available
33 * in accordance with section (3) of the GNU General Public License.
34 *
35 * This exception does not invalidate any other reasons why a work based on
36 * this file might be covered by the GNU General Public License.
37 *
38 * Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
39 * at http: *sources.redhat.com/ecos/ecos-license/
40 * -------------------------------------------
41 *####ECOSGPLCOPYRIGHTEND####
42 *==========================================================================
43 *#####DESCRIPTIONBEGIN####
44 *
45 * Author(s): gthomas
46 * Contributors: gthomas, tsmith, Yoshinori Sato
47 * Date: 2000-07-14
48 * Purpose:
49 * Description:
50 *
51 * This code is part of RedBoot (tm).
52 *
53 *####DESCRIPTIONEND####
54 *
55 *==========================================================================
56 */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020057#include <common.h>
58#include <xyzModem.h>
59#include <stdarg.h>
60#include <crc.h>
61
Wolfgang Denkebd3deb2006-04-16 10:51:58 +020062/* Assumption - run xyzModem protocol over the console port */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020063
Wolfgang Denkebd3deb2006-04-16 10:51:58 +020064/* Values magic to the protocol */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020065#define SOH 0x01
66#define STX 0x02
67#define EOT 0x04
68#define ACK 0x06
69#define BSP 0x08
70#define NAK 0x15
71#define CAN 0x18
Wolfgang Denk95d11692006-08-31 16:46:53 +020072#define EOF 0x1A /* ^Z for DOS officionados */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020073
74#define USE_YMODEM_LENGTH
75
Wolfgang Denkebd3deb2006-04-16 10:51:58 +020076/* Data & state local to the protocol */
Wolfgang Denk95d11692006-08-31 16:46:53 +020077static struct
78{
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020079#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +020080 hal_virtual_comm_table_t *__chan;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020081#else
Wolfgang Denk95d11692006-08-31 16:46:53 +020082 int *__chan;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020083#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +020084 unsigned char pkt[1024], *bufp;
85 unsigned char blk, cblk, crc1, crc2;
86 unsigned char next_blk; /* Expected block */
87 int len, mode, total_retries;
88 int total_SOH, total_STX, total_CAN;
89 bool crc_mode, at_eof, tx_ack;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020090#ifdef USE_YMODEM_LENGTH
Wolfgang Denk95d11692006-08-31 16:46:53 +020091 unsigned long file_length, read_length;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020092#endif
93} xyz;
94
Wolfgang Denk95d11692006-08-31 16:46:53 +020095#define xyzModem_CHAR_TIMEOUT 2000 /* 2 seconds */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020096#define xyzModem_MAX_RETRIES 20
97#define xyzModem_MAX_RETRIES_WITH_CRC 10
Wolfgang Denk95d11692006-08-31 16:46:53 +020098#define xyzModem_CAN_COUNT 3 /* Wait for 3 CAN before quitting */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +020099
100
Wolfgang Denk95d11692006-08-31 16:46:53 +0200101#ifndef REDBOOT /*SB */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200102typedef int cyg_int32;
Wolfgang Denk95d11692006-08-31 16:46:53 +0200103int
104CYGACC_COMM_IF_GETC_TIMEOUT (char chan, char *c)
105{
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200106#define DELAY 20
Wolfgang Denk95d11692006-08-31 16:46:53 +0200107 unsigned long counter = 0;
108 while (!tstc () && (counter < xyzModem_CHAR_TIMEOUT * 1000 / DELAY))
109 {
110 udelay (DELAY);
111 counter++;
112 }
113 if (tstc ())
114 {
115 *c = getc ();
116 return 1;
117 }
118 return 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200119}
120
Wolfgang Denk95d11692006-08-31 16:46:53 +0200121void
122CYGACC_COMM_IF_PUTC (char x, char y)
123{
124 putc (y);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200125}
126
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200127/* Validate a hex character */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200128__inline__ static bool
Wolfgang Denk95d11692006-08-31 16:46:53 +0200129_is_hex (char c)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200130{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200131 return (((c >= '0') && (c <= '9')) ||
132 ((c >= 'A') && (c <= 'F')) || ((c >= 'a') && (c <= 'f')));
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200133}
134
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200135/* Convert a single hex nibble */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200136__inline__ static int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200137_from_hex (char c)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200138{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200139 int ret = 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200140
Wolfgang Denk95d11692006-08-31 16:46:53 +0200141 if ((c >= '0') && (c <= '9'))
142 {
143 ret = (c - '0');
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200144 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200145 else if ((c >= 'a') && (c <= 'f'))
146 {
147 ret = (c - 'a' + 0x0a);
148 }
149 else if ((c >= 'A') && (c <= 'F'))
150 {
151 ret = (c - 'A' + 0x0A);
152 }
153 return ret;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200154}
155
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200156/* Convert a character to lower case */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200157__inline__ static char
Wolfgang Denk95d11692006-08-31 16:46:53 +0200158_tolower (char c)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200159{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200160 if ((c >= 'A') && (c <= 'Z'))
161 {
162 c = (c - 'A') + 'a';
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200163 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200164 return c;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200165}
166
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200167/* Parse (scan) a number */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200168bool
Wolfgang Denk95d11692006-08-31 16:46:53 +0200169parse_num (char *s, unsigned long *val, char **es, char *delim)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200170{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200171 bool first = true;
172 int radix = 10;
173 char c;
174 unsigned long result = 0;
175 int digit;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200176
Wolfgang Denk95d11692006-08-31 16:46:53 +0200177 while (*s == ' ')
178 s++;
179 while (*s)
180 {
181 if (first && (s[0] == '0') && (_tolower (s[1]) == 'x'))
182 {
183 radix = 16;
184 s += 2;
185 }
186 first = false;
187 c = *s++;
188 if (_is_hex (c) && ((digit = _from_hex (c)) < radix))
189 {
190 /* Valid digit */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200191#ifdef CYGPKG_HAL_MIPS
Wolfgang Denk95d11692006-08-31 16:46:53 +0200192 /* FIXME: tx49 compiler generates 0x2539018 for MUL which */
193 /* isn't any good. */
194 if (16 == radix)
195 result = result << 4;
196 else
197 result = 10 * result;
198 result += digit;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200199#else
Wolfgang Denk95d11692006-08-31 16:46:53 +0200200 result = (result * radix) + digit;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200201#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200202 }
203 else
204 {
205 if (delim != (char *) 0)
206 {
207 /* See if this character is one of the delimiters */
208 char *dp = delim;
209 while (*dp && (c != *dp))
210 dp++;
211 if (*dp)
212 break; /* Found a good delimiter */
213 }
214 return false; /* Malformatted number */
215 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200216 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200217 *val = result;
218 if (es != (char **) 0)
219 {
220 *es = s;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200221 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200222 return true;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200223}
224
225#endif
226
227#define USE_SPRINTF
228#ifdef DEBUG
229#ifndef USE_SPRINTF
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200230/*
231 * Note: this debug setup only works if the target platform has two serial ports
232 * available so that the other one (currently only port 1) can be used for debug
233 * messages.
234 */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200235static int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200236zm_dprintf (char *fmt, ...)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200237{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200238 int cur_console;
239 va_list args;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200240
Wolfgang Denk95d11692006-08-31 16:46:53 +0200241 va_start (args, fmt);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200242#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200243 cur_console =
244 CYGACC_CALL_IF_SET_CONSOLE_COMM
245 (CYGNUM_CALL_IF_SET_COMM_ID_QUERY_CURRENT);
246 CYGACC_CALL_IF_SET_CONSOLE_COMM (1);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200247#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200248 diag_vprintf (fmt, args);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200249#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200250 CYGACC_CALL_IF_SET_CONSOLE_COMM (cur_console);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200251#endif
252}
253
254static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200255zm_flush (void)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200256{
257}
258
259#else
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200260/*
261 * Note: this debug setup works by storing the strings in a fixed buffer
262 */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200263#define FINAL
264#ifdef FINAL
Wolfgang Denk95d11692006-08-31 16:46:53 +0200265static char *zm_out = (char *) 0x00380000;
266static char *zm_out_start = (char *) 0x00380000;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200267#else
268static char zm_buf[8192];
Wolfgang Denk95d11692006-08-31 16:46:53 +0200269static char *zm_out = zm_buf;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200270static char *zm_out_start = zm_buf;
271
272#endif
273static int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200274zm_dprintf (char *fmt, ...)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200275{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200276 int len;
277 va_list args;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200278
Wolfgang Denk95d11692006-08-31 16:46:53 +0200279 va_start (args, fmt);
280 len = diag_vsprintf (zm_out, fmt, args);
281 zm_out += len;
282 return len;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200283}
284
285static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200286zm_flush (void)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200287{
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200288#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200289 char *p = zm_out_start;
290 while (*p)
291 mon_write_char (*p++);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200292#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200293 zm_out = zm_out_start;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200294}
295#endif
296
297static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200298zm_dump_buf (void *buf, int len)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200299{
300#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200301 diag_vdump_buf_with_offset (zm_dprintf, buf, len, 0);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200302#else
303
304#endif
305}
306
307static unsigned char zm_buf[2048];
308static unsigned char *zm_bp;
309
310static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200311zm_new (void)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200312{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200313 zm_bp = zm_buf;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200314}
315
316static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200317zm_save (unsigned char c)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200318{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200319 *zm_bp++ = c;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200320}
321
322static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200323zm_dump (int line)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200324{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200325 zm_dprintf ("Packet at line: %d\n", line);
326 zm_dump_buf (zm_buf, zm_bp - zm_buf);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200327}
328
329#define ZM_DEBUG(x) x
330#else
331#define ZM_DEBUG(x)
332#endif
333
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200334/* Wait for the line to go idle */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200335static void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200336xyzModem_flush (void)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200337{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200338 int res;
339 char c;
340 while (true)
341 {
342 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, &c);
343 if (!res)
344 return;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200345 }
346}
347
348static int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200349xyzModem_get_hdr (void)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200350{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200351 char c;
352 int res;
353 bool hdr_found = false;
354 int i, can_total, hdr_chars;
355 unsigned short cksum;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200356
Wolfgang Denk95d11692006-08-31 16:46:53 +0200357 ZM_DEBUG (zm_new ());
358 /* Find the start of a header */
359 can_total = 0;
360 hdr_chars = 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200361
Wolfgang Denk95d11692006-08-31 16:46:53 +0200362 if (xyz.tx_ack)
363 {
364 CYGACC_COMM_IF_PUTC (*xyz.__chan, ACK);
365 xyz.tx_ack = false;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200366 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200367 while (!hdr_found)
368 {
369 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, &c);
370 ZM_DEBUG (zm_save (c));
371 if (res)
372 {
373 hdr_chars++;
374 switch (c)
375 {
376 case SOH:
377 xyz.total_SOH++;
378 case STX:
379 if (c == STX)
380 xyz.total_STX++;
381 hdr_found = true;
382 break;
383 case CAN:
384 xyz.total_CAN++;
385 ZM_DEBUG (zm_dump (__LINE__));
386 if (++can_total == xyzModem_CAN_COUNT)
387 {
388 return xyzModem_cancel;
389 }
390 else
391 {
392 /* Wait for multiple CAN to avoid early quits */
393 break;
394 }
395 case EOT:
396 /* EOT only supported if no noise */
397 if (hdr_chars == 1)
398 {
399 CYGACC_COMM_IF_PUTC (*xyz.__chan, ACK);
400 ZM_DEBUG (zm_dprintf ("ACK on EOT #%d\n", __LINE__));
401 ZM_DEBUG (zm_dump (__LINE__));
402 return xyzModem_eof;
403 }
404 default:
405 /* Ignore, waiting for start of header */
406 ;
407 }
408 }
409 else
410 {
411 /* Data stream timed out */
412 xyzModem_flush (); /* Toss any current input */
413 ZM_DEBUG (zm_dump (__LINE__));
414 CYGACC_CALL_IF_DELAY_US ((cyg_int32) 250000);
415 return xyzModem_timeout;
416 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200417 }
418
Wolfgang Denk95d11692006-08-31 16:46:53 +0200419 /* Header found, now read the data */
420 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, (char *) &xyz.blk);
421 ZM_DEBUG (zm_save (xyz.blk));
422 if (!res)
423 {
424 ZM_DEBUG (zm_dump (__LINE__));
425 return xyzModem_timeout;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200426 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200427 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, (char *) &xyz.cblk);
428 ZM_DEBUG (zm_save (xyz.cblk));
429 if (!res)
430 {
431 ZM_DEBUG (zm_dump (__LINE__));
432 return xyzModem_timeout;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200433 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200434 xyz.len = (c == SOH) ? 128 : 1024;
435 xyz.bufp = xyz.pkt;
436 for (i = 0; i < xyz.len; i++)
437 {
438 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, &c);
439 ZM_DEBUG (zm_save (c));
440 if (res)
441 {
442 xyz.pkt[i] = c;
443 }
444 else
445 {
446 ZM_DEBUG (zm_dump (__LINE__));
447 return xyzModem_timeout;
448 }
449 }
450 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, (char *) &xyz.crc1);
451 ZM_DEBUG (zm_save (xyz.crc1));
452 if (!res)
453 {
454 ZM_DEBUG (zm_dump (__LINE__));
455 return xyzModem_timeout;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200456 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200457 if (xyz.crc_mode)
458 {
459 res = CYGACC_COMM_IF_GETC_TIMEOUT (*xyz.__chan, (char *) &xyz.crc2);
460 ZM_DEBUG (zm_save (xyz.crc2));
461 if (!res)
462 {
463 ZM_DEBUG (zm_dump (__LINE__));
464 return xyzModem_timeout;
465 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200466 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200467 ZM_DEBUG (zm_dump (__LINE__));
468 /* Validate the message */
469 if ((xyz.blk ^ xyz.cblk) != (unsigned char) 0xFF)
470 {
471 ZM_DEBUG (zm_dprintf
472 ("Framing error - blk: %x/%x/%x\n", xyz.blk, xyz.cblk,
473 (xyz.blk ^ xyz.cblk)));
474 ZM_DEBUG (zm_dump_buf (xyz.pkt, xyz.len));
475 xyzModem_flush ();
476 return xyzModem_frame;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200477 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200478 /* Verify checksum/CRC */
479 if (xyz.crc_mode)
480 {
481 cksum = cyg_crc16 (xyz.pkt, xyz.len);
482 if (cksum != ((xyz.crc1 << 8) | xyz.crc2))
483 {
484 ZM_DEBUG (zm_dprintf ("CRC error - recvd: %02x%02x, computed: %x\n",
485 xyz.crc1, xyz.crc2, cksum & 0xFFFF));
486 return xyzModem_cksum;
487 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200488 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200489 else
490 {
491 cksum = 0;
492 for (i = 0; i < xyz.len; i++)
493 {
494 cksum += xyz.pkt[i];
495 }
496 if (xyz.crc1 != (cksum & 0xFF))
497 {
498 ZM_DEBUG (zm_dprintf
499 ("Checksum error - recvd: %x, computed: %x\n", xyz.crc1,
500 cksum & 0xFF));
501 return xyzModem_cksum;
502 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200503 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200504 /* If we get here, the message passes [structural] muster */
505 return 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200506}
507
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200508int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200509xyzModem_stream_open (connection_info_t * info, int *err)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200510{
Stefan Roeseae884d72006-05-10 15:01:40 +0200511#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200512 int console_chan;
Stefan Roeseae884d72006-05-10 15:01:40 +0200513#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200514 int stat = 0;
515 int retries = xyzModem_MAX_RETRIES;
516 int crc_retries = xyzModem_MAX_RETRIES_WITH_CRC;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200517
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200518/* ZM_DEBUG(zm_out = zm_out_start); */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200519#ifdef xyzModem_zmodem
Wolfgang Denk95d11692006-08-31 16:46:53 +0200520 if (info->mode == xyzModem_zmodem)
521 {
522 *err = xyzModem_noZmodem;
523 return -1;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200524 }
525#endif
526
527#ifdef REDBOOT
Wolfgang Denk95d11692006-08-31 16:46:53 +0200528 /* Set up the I/O channel. Note: this allows for using a different port in the future */
529 console_chan =
530 CYGACC_CALL_IF_SET_CONSOLE_COMM
531 (CYGNUM_CALL_IF_SET_COMM_ID_QUERY_CURRENT);
532 if (info->chan >= 0)
533 {
534 CYGACC_CALL_IF_SET_CONSOLE_COMM (info->chan);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200535 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200536 else
537 {
538 CYGACC_CALL_IF_SET_CONSOLE_COMM (console_chan);
539 }
540 xyz.__chan = CYGACC_CALL_IF_CONSOLE_PROCS ();
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200541
Wolfgang Denk95d11692006-08-31 16:46:53 +0200542 CYGACC_CALL_IF_SET_CONSOLE_COMM (console_chan);
543 CYGACC_COMM_IF_CONTROL (*xyz.__chan, __COMMCTL_SET_TIMEOUT,
544 xyzModem_CHAR_TIMEOUT);
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200545#else
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200546/* TODO: CHECK ! */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200547 int dummy;
548 xyz.__chan = &dummy;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200549#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200550 xyz.len = 0;
551 xyz.crc_mode = true;
552 xyz.at_eof = false;
553 xyz.tx_ack = false;
554 xyz.mode = info->mode;
555 xyz.total_retries = 0;
556 xyz.total_SOH = 0;
557 xyz.total_STX = 0;
558 xyz.total_CAN = 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200559#ifdef USE_YMODEM_LENGTH
Wolfgang Denk95d11692006-08-31 16:46:53 +0200560 xyz.read_length = 0;
561 xyz.file_length = 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200562#endif
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200563
Wolfgang Denk95d11692006-08-31 16:46:53 +0200564 CYGACC_COMM_IF_PUTC (*xyz.__chan, (xyz.crc_mode ? 'C' : NAK));
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200565
Wolfgang Denk95d11692006-08-31 16:46:53 +0200566 if (xyz.mode == xyzModem_xmodem)
567 {
568 /* X-modem doesn't have an information header - exit here */
569 xyz.next_blk = 1;
570 return 0;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200571 }
572
Wolfgang Denk95d11692006-08-31 16:46:53 +0200573 while (retries-- > 0)
574 {
575 stat = xyzModem_get_hdr ();
576 if (stat == 0)
577 {
578 /* Y-modem file information header */
579 if (xyz.blk == 0)
580 {
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200581#ifdef USE_YMODEM_LENGTH
Wolfgang Denk95d11692006-08-31 16:46:53 +0200582 /* skip filename */
583 while (*xyz.bufp++);
584 /* get the length */
585 parse_num ((char *) xyz.bufp, &xyz.file_length, NULL, " ");
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200586#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200587 /* The rest of the file name data block quietly discarded */
588 xyz.tx_ack = true;
589 }
590 xyz.next_blk = 1;
591 xyz.len = 0;
592 return 0;
593 }
594 else if (stat == xyzModem_timeout)
595 {
596 if (--crc_retries <= 0)
597 xyz.crc_mode = false;
598 CYGACC_CALL_IF_DELAY_US (5 * 100000); /* Extra delay for startup */
599 CYGACC_COMM_IF_PUTC (*xyz.__chan, (xyz.crc_mode ? 'C' : NAK));
600 xyz.total_retries++;
601 ZM_DEBUG (zm_dprintf ("NAK (%d)\n", __LINE__));
602 }
603 if (stat == xyzModem_cancel)
604 {
605 break;
606 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200607 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200608 *err = stat;
609 ZM_DEBUG (zm_flush ());
610 return -1;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200611}
612
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200613int
Wolfgang Denk95d11692006-08-31 16:46:53 +0200614xyzModem_stream_read (char *buf, int size, int *err)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200615{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200616 int stat, total, len;
617 int retries;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200618
Wolfgang Denk95d11692006-08-31 16:46:53 +0200619 total = 0;
620 stat = xyzModem_cancel;
621 /* Try and get 'size' bytes into the buffer */
622 while (!xyz.at_eof && (size > 0))
623 {
624 if (xyz.len == 0)
625 {
626 retries = xyzModem_MAX_RETRIES;
627 while (retries-- > 0)
628 {
629 stat = xyzModem_get_hdr ();
630 if (stat == 0)
631 {
632 if (xyz.blk == xyz.next_blk)
633 {
634 xyz.tx_ack = true;
635 ZM_DEBUG (zm_dprintf
636 ("ACK block %d (%d)\n", xyz.blk, __LINE__));
637 xyz.next_blk = (xyz.next_blk + 1) & 0xFF;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200638
639#if defined(xyzModem_zmodem) || defined(USE_YMODEM_LENGTH)
Wolfgang Denk95d11692006-08-31 16:46:53 +0200640 if (xyz.mode == xyzModem_xmodem || xyz.file_length == 0)
641 {
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200642#else
Wolfgang Denk95d11692006-08-31 16:46:53 +0200643 if (1)
644 {
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200645#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200646 /* Data blocks can be padded with ^Z (EOF) characters */
647 /* This code tries to detect and remove them */
648 if ((xyz.bufp[xyz.len - 1] == EOF) &&
649 (xyz.bufp[xyz.len - 2] == EOF) &&
650 (xyz.bufp[xyz.len - 3] == EOF))
651 {
652 while (xyz.len
653 && (xyz.bufp[xyz.len - 1] == EOF))
654 {
655 xyz.len--;
656 }
657 }
658 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200659
660#ifdef USE_YMODEM_LENGTH
Wolfgang Denk95d11692006-08-31 16:46:53 +0200661 /*
662 * See if accumulated length exceeds that of the file.
663 * If so, reduce size (i.e., cut out pad bytes)
664 * Only do this for Y-modem (and Z-modem should it ever
665 * be supported since it can fall back to Y-modem mode).
666 */
667 if (xyz.mode != xyzModem_xmodem && 0 != xyz.file_length)
668 {
669 xyz.read_length += xyz.len;
670 if (xyz.read_length > xyz.file_length)
671 {
672 xyz.len -= (xyz.read_length - xyz.file_length);
673 }
674 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200675#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200676 break;
677 }
678 else if (xyz.blk == ((xyz.next_blk - 1) & 0xFF))
679 {
680 /* Just re-ACK this so sender will get on with it */
681 CYGACC_COMM_IF_PUTC (*xyz.__chan, ACK);
682 continue; /* Need new header */
683 }
684 else
685 {
686 stat = xyzModem_sequence;
687 }
688 }
689 if (stat == xyzModem_cancel)
690 {
691 break;
692 }
693 if (stat == xyzModem_eof)
694 {
695 CYGACC_COMM_IF_PUTC (*xyz.__chan, ACK);
696 ZM_DEBUG (zm_dprintf ("ACK (%d)\n", __LINE__));
697 if (xyz.mode == xyzModem_ymodem)
698 {
699 CYGACC_COMM_IF_PUTC (*xyz.__chan,
700 (xyz.crc_mode ? 'C' : NAK));
701 xyz.total_retries++;
702 ZM_DEBUG (zm_dprintf ("Reading Final Header\n"));
703 stat = xyzModem_get_hdr ();
704 CYGACC_COMM_IF_PUTC (*xyz.__chan, ACK);
705 ZM_DEBUG (zm_dprintf ("FINAL ACK (%d)\n", __LINE__));
706 }
707 xyz.at_eof = true;
708 break;
709 }
710 CYGACC_COMM_IF_PUTC (*xyz.__chan, (xyz.crc_mode ? 'C' : NAK));
711 xyz.total_retries++;
712 ZM_DEBUG (zm_dprintf ("NAK (%d)\n", __LINE__));
713 }
714 if (stat < 0)
715 {
716 *err = stat;
717 xyz.len = -1;
718 return total;
719 }
720 }
721 /* Don't "read" data from the EOF protocol package */
722 if (!xyz.at_eof)
723 {
724 len = xyz.len;
725 if (size < len)
726 len = size;
727 memcpy (buf, xyz.bufp, len);
728 size -= len;
729 buf += len;
730 total += len;
731 xyz.len -= len;
732 xyz.bufp += len;
733 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200734 }
Wolfgang Denk95d11692006-08-31 16:46:53 +0200735 return total;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200736}
737
738void
Wolfgang Denk95d11692006-08-31 16:46:53 +0200739xyzModem_stream_close (int *err)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200740{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200741 diag_printf
742 ("xyzModem - %s mode, %d(SOH)/%d(STX)/%d(CAN) packets, %d retries\n",
743 xyz.crc_mode ? "CRC" : "Cksum", xyz.total_SOH, xyz.total_STX,
744 xyz.total_CAN, xyz.total_retries);
745 ZM_DEBUG (zm_flush ());
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200746}
747
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200748/* Need to be able to clean out the input buffer, so have to take the */
749/* getc */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200750void
751xyzModem_stream_terminate (bool abort, int (*getc) (void))
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200752{
753 int c;
754
Wolfgang Denk95d11692006-08-31 16:46:53 +0200755 if (abort)
756 {
757 ZM_DEBUG (zm_dprintf ("!!!! TRANSFER ABORT !!!!\n"));
758 switch (xyz.mode)
759 {
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200760 case xyzModem_xmodem:
761 case xyzModem_ymodem:
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200762 /* The X/YMODEM Spec seems to suggest that multiple CAN followed by an equal */
763 /* number of Backspaces is a friendly way to get the other end to abort. */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200764 CYGACC_COMM_IF_PUTC (*xyz.__chan, CAN);
765 CYGACC_COMM_IF_PUTC (*xyz.__chan, CAN);
766 CYGACC_COMM_IF_PUTC (*xyz.__chan, CAN);
767 CYGACC_COMM_IF_PUTC (*xyz.__chan, CAN);
768 CYGACC_COMM_IF_PUTC (*xyz.__chan, BSP);
769 CYGACC_COMM_IF_PUTC (*xyz.__chan, BSP);
770 CYGACC_COMM_IF_PUTC (*xyz.__chan, BSP);
771 CYGACC_COMM_IF_PUTC (*xyz.__chan, BSP);
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200772 /* Now consume the rest of what's waiting on the line. */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200773 ZM_DEBUG (zm_dprintf ("Flushing serial line.\n"));
774 xyzModem_flush ();
775 xyz.at_eof = true;
776 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200777#ifdef xyzModem_zmodem
778 case xyzModem_zmodem:
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200779 /* Might support it some day I suppose. */
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200780#endif
Wolfgang Denk95d11692006-08-31 16:46:53 +0200781 break;
782 }
783 }
784 else
785 {
786 ZM_DEBUG (zm_dprintf ("Engaging cleanup mode...\n"));
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200787 /*
788 * Consume any trailing crap left in the inbuffer from
789 * previous recieved blocks. Since very few files are an exact multiple
790 * of the transfer block size, there will almost always be some gunk here.
791 * If we don't eat it now, RedBoot will think the user typed it.
792 */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200793 ZM_DEBUG (zm_dprintf ("Trailing gunk:\n"));
794 while ((c = (*getc) ()) > -1);
795 ZM_DEBUG (zm_dprintf ("\n"));
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200796 /*
797 * Make a small delay to give terminal programs like minicom
798 * time to get control again after their file transfer program
799 * exits.
800 */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200801 CYGACC_CALL_IF_DELAY_US ((cyg_int32) 250000);
802 }
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200803}
804
805char *
Wolfgang Denk95d11692006-08-31 16:46:53 +0200806xyzModem_error (int err)
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200807{
Wolfgang Denk95d11692006-08-31 16:46:53 +0200808 switch (err)
809 {
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200810 case xyzModem_access:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200811 return "Can't access file";
812 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200813 case xyzModem_noZmodem:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200814 return "Sorry, zModem not available yet";
815 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200816 case xyzModem_timeout:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200817 return "Timed out";
818 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200819 case xyzModem_eof:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200820 return "End of file";
821 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200822 case xyzModem_cancel:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200823 return "Cancelled";
824 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200825 case xyzModem_frame:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200826 return "Invalid framing";
827 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200828 case xyzModem_cksum:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200829 return "CRC/checksum error";
830 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200831 case xyzModem_sequence:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200832 return "Block sequence error";
833 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200834 default:
Wolfgang Denk95d11692006-08-31 16:46:53 +0200835 return "Unknown error";
836 break;
Markus Klotzbuecher387f5412006-03-30 13:40:55 +0200837 }
838}
839
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200840/*
841 * RedBoot interface
842 */
Wolfgang Denk95d11692006-08-31 16:46:53 +0200843#if 0 /* SB */
844GETC_IO_FUNCS (xyzModem_io, xyzModem_stream_open, xyzModem_stream_close,
845 xyzModem_stream_terminate, xyzModem_stream_read,
846 xyzModem_error);
847RedBoot_load (xmodem, xyzModem_io, false, false, xyzModem_xmodem);
848RedBoot_load (ymodem, xyzModem_io, false, false, xyzModem_ymodem);
Wolfgang Denkebd3deb2006-04-16 10:51:58 +0200849#endif