cmd/load.c

   1 /*
   2  * (C) Copyright 2000-2004
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 /*
   9  * Serial up- and download support
  10  */
  11 #include <common.h>
  12 #include <command.h>
  13 #include <console.h>
  14 #include <s_record.h>
  15 #include <net.h>
  16 #include <exports.h>
  17 #include <xyzModem.h>
  18
  19 DECLARE_GLOBAL_DATA_PTR;
  20
  21 #if defined(CONFIG_CMD_LOADB)
  22 static ulong load_serial_ymodem(ulong offset, int mode);
  23 #endif
  24
  25 #if defined(CONFIG_CMD_LOADS)
  26 static ulong load_serial(long offset);
  27 static int read_record(char *buf, ulong len);
  28 # if defined(CONFIG_CMD_SAVES)
  29 static int save_serial(ulong offset, ulong size);
  30 static int write_record(char *buf);
  31 #endif
  32
  33 static int do_echo = 1;
  34 #endif
  35
  36 /* -------------------------------------------------------------------- */
  37
  38 #if defined(CONFIG_CMD_LOADS)
  39 static int do_load_serial(cmd_tbl_t *cmdtp, int flag, int argc,
  40                           char * const argv[])
  41 {
  42         long offset = 0;
  43         ulong addr;
  44         int i;
  45         char *env_echo;
  46         int rcode = 0;
  47 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
  48         int load_baudrate, current_baudrate;
  49
  50         load_baudrate = current_baudrate = gd->baudrate;
  51 #endif
  52
  53         if (((env_echo = getenv("loads_echo")) != NULL) && (*env_echo == '1')) {
  54                 do_echo = 1;
  55         } else {
  56                 do_echo = 0;
  57         }
  58
  59 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
  60         if (argc >= 2) {
  61                 offset = simple_strtol(argv[1], NULL, 16);
  62         }
  63         if (argc == 3) {
  64                 load_baudrate = (int)simple_strtoul(argv[2], NULL, 10);
  65
  66                 /* default to current baudrate */
  67                 if (load_baudrate == 0)
  68                         load_baudrate = current_baudrate;
  69         }
  70         if (load_baudrate != current_baudrate) {
  71                 printf("## Switch baudrate to %d bps and press ENTER ...\n",
  72                         load_baudrate);
  73                 udelay(50000);
  74                 gd->baudrate = load_baudrate;
  75                 serial_setbrg();
  76                 udelay(50000);
  77                 for (;;) {
  78                         if (getc() == '\r')
  79                                 break;
  80                 }
  81         }
  82 #else   /* ! CONFIG_SYS_LOADS_BAUD_CHANGE */
  83         if (argc == 2) {
  84                 offset = simple_strtol(argv[1], NULL, 16);
  85         }
  86 #endif  /* CONFIG_SYS_LOADS_BAUD_CHANGE */
  87
  88         printf("## Ready for S-Record download ...\n");
  89
  90         addr = load_serial(offset);
  91
  92         /*
  93          * Gather any trailing characters (for instance, the ^D which
  94          * is sent by 'cu' after sending a file), and give the
  95          * box some time (100 * 1 ms)
  96          */
  97         for (i=0; i<100; ++i) {
  98                 if (tstc()) {
  99                         (void) getc();
 100                 }
 101                 udelay(1000);
 102         }
 103
 104         if (addr == ~0) {
 105                 printf("## S-Record download aborted\n");
 106                 rcode = 1;
 107         } else {
 108                 printf("## Start Addr      = 0x%08lX\n", addr);
 109                 load_addr = addr;
 110         }
 111
 112 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
 113         if (load_baudrate != current_baudrate) {
 114                 printf("## Switch baudrate to %d bps and press ESC ...\n",
 115                         current_baudrate);
 116                 udelay(50000);
 117                 gd->baudrate = current_baudrate;
 118                 serial_setbrg();
 119                 udelay(50000);
 120                 for (;;) {
 121                         if (getc() == 0x1B) /* ESC */
 122                                 break;
 123                 }
 124         }
 125 #endif
 126         return rcode;
 127 }
 128
 129 static ulong load_serial(long offset)
 130 {
 131         char    record[SREC_MAXRECLEN + 1];     /* buffer for one S-Record      */
 132         char    binbuf[SREC_MAXBINLEN];         /* buffer for binary data       */
 133         int     binlen;                         /* no. of data bytes in S-Rec.  */
 134         int     type;                           /* return code for record type  */
 135         ulong   addr;                           /* load address from S-Record   */
 136         ulong   size;                           /* number of bytes transferred  */
 137         ulong   store_addr;
 138         ulong   start_addr = ~0;
 139         ulong   end_addr   =  0;
 140         int     line_count =  0;
 141
 142         while (read_record(record, SREC_MAXRECLEN + 1) >= 0) {
 143                 type = srec_decode(record, &binlen, &addr, binbuf);
 144
 145                 if (type < 0) {
 146                         return (~0);            /* Invalid S-Record             */
 147                 }
 148
 149                 switch (type) {
 150                 case SREC_DATA2:
 151                 case SREC_DATA3:
 152                 case SREC_DATA4:
 153                     store_addr = addr + offset;
 154 #ifdef CONFIG_MTD_NOR_FLASH
 155                     if (addr2info(store_addr)) {
 156                         int rc;
 157
 158                         rc = flash_write((char *)binbuf,store_addr,binlen);
 159                         if (rc != 0) {
 160                                 flash_perror(rc);
 161                                 return (~0);
 162                         }
 163                     } else
 164 #endif
 165                     {
 166                         memcpy((char *)(store_addr), binbuf, binlen);
 167                     }
 168                     if ((store_addr) < start_addr)
 169                         start_addr = store_addr;
 170                     if ((store_addr + binlen - 1) > end_addr)
 171                         end_addr = store_addr + binlen - 1;
 172                     break;
 173                 case SREC_END2:
 174                 case SREC_END3:
 175                 case SREC_END4:
 176                     udelay(10000);
 177                     size = end_addr - start_addr + 1;
 178                     printf("\n"
 179                             "## First Load Addr = 0x%08lX\n"
 180                             "## Last  Load Addr = 0x%08lX\n"
 181                             "## Total Size      = 0x%08lX = %ld Bytes\n",
 182                             start_addr, end_addr, size, size
 183                     );
 184                     flush_cache(start_addr, size);
 185                     setenv_hex("filesize", size);
 186                     return (addr);
 187                 case SREC_START:
 188                     break;
 189                 default:
 190                     break;
 191                 }
 192                 if (!do_echo) { /* print a '.' every 100 lines */
 193                         if ((++line_count % 100) == 0)
 194                                 putc('.');
 195                 }
 196         }
 197
 198         return (~0);                    /* Download aborted             */
 199 }
 200
 201 static int read_record(char *buf, ulong len)
 202 {
 203         char *p;
 204         char c;
 205
 206         --len;  /* always leave room for terminating '\0' byte */
 207
 208         for (p=buf; p < buf+len; ++p) {
 209                 c = getc();             /* read character               */
 210                 if (do_echo)
 211                         putc(c);        /* ... and echo it              */
 212
 213                 switch (c) {
 214                 case '\r':
 215                 case '\n':
 216                         *p = '\0';
 217                         return (p - buf);
 218                 case '\0':
 219                 case 0x03:                      /* ^C - Control C               */
 220                         return (-1);
 221                 default:
 222                         *p = c;
 223                 }
 224
 225             /* Check for the console hangup (if any different from serial) */
 226             if (gd->jt->getc != getc) {
 227                 if (ctrlc()) {
 228                     return (-1);
 229                 }
 230             }
 231         }
 232
 233         /* line too long - truncate */
 234         *p = '\0';
 235         return (p - buf);
 236 }
 237
 238 #if defined(CONFIG_CMD_SAVES)
 239
 240 int do_save_serial (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 241 {
 242         ulong offset = 0;
 243         ulong size   = 0;
 244 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
 245         int save_baudrate, current_baudrate;
 246
 247         save_baudrate = current_baudrate = gd->baudrate;
 248 #endif
 249
 250         if (argc >= 2) {
 251                 offset = simple_strtoul(argv[1], NULL, 16);
 252         }
 253 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
 254         if (argc >= 3) {
 255                 size = simple_strtoul(argv[2], NULL, 16);
 256         }
 257         if (argc == 4) {
 258                 save_baudrate = (int)simple_strtoul(argv[3], NULL, 10);
 259
 260                 /* default to current baudrate */
 261                 if (save_baudrate == 0)
 262                         save_baudrate = current_baudrate;
 263         }
 264         if (save_baudrate != current_baudrate) {
 265                 printf("## Switch baudrate to %d bps and press ENTER ...\n",
 266                         save_baudrate);
 267                 udelay(50000);
 268                 gd->baudrate = save_baudrate;
 269                 serial_setbrg();
 270                 udelay(50000);
 271                 for (;;) {
 272                         if (getc() == '\r')
 273                                 break;
 274                 }
 275         }
 276 #else   /* ! CONFIG_SYS_LOADS_BAUD_CHANGE */
 277         if (argc == 3) {
 278                 size = simple_strtoul(argv[2], NULL, 16);
 279         }
 280 #endif  /* CONFIG_SYS_LOADS_BAUD_CHANGE */
 281
 282         printf("## Ready for S-Record upload, press ENTER to proceed ...\n");
 283         for (;;) {
 284                 if (getc() == '\r')
 285                         break;
 286         }
 287         if (save_serial(offset, size)) {
 288                 printf("## S-Record upload aborted\n");
 289         } else {
 290                 printf("## S-Record upload complete\n");
 291         }
 292 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
 293         if (save_baudrate != current_baudrate) {
 294                 printf("## Switch baudrate to %d bps and press ESC ...\n",
 295                         (int)current_baudrate);
 296                 udelay(50000);
 297                 gd->baudrate = current_baudrate;
 298                 serial_setbrg();
 299                 udelay(50000);
 300                 for (;;) {
 301                         if (getc() == 0x1B) /* ESC */
 302                                 break;
 303                 }
 304         }
 305 #endif
 306         return 0;
 307 }
 308
 309 #define SREC3_START                             "S0030000FC\n"
 310 #define SREC3_FORMAT                    "S3%02X%08lX%s%02X\n"
 311 #define SREC3_END                               "S70500000000FA\n"
 312 #define SREC_BYTES_PER_RECORD   16
 313
 314 static int save_serial(ulong address, ulong count)
 315 {
 316         int i, c, reclen, checksum, length;
 317         char *hex = "0123456789ABCDEF";
 318         char    record[2*SREC_BYTES_PER_RECORD+16];     /* buffer for one S-Record      */
 319         char    data[2*SREC_BYTES_PER_RECORD+1];        /* buffer for hex data  */
 320
 321         reclen = 0;
 322         checksum  = 0;
 323
 324         if(write_record(SREC3_START))                   /* write the header */
 325                 return (-1);
 326         do {
 327                 if(count) {                                             /* collect hex data in the buffer  */
 328                         c = *(volatile uchar*)(address + reclen);       /* get one byte    */
 329                         checksum += c;                                                  /* accumulate checksum */
 330                         data[2*reclen]   = hex[(c>>4)&0x0f];
 331                         data[2*reclen+1] = hex[c & 0x0f];
 332                         data[2*reclen+2] = '\0';
 333                         ++reclen;
 334                         --count;
 335                 }
 336                 if(reclen == SREC_BYTES_PER_RECORD || count == 0) {
 337                         /* enough data collected for one record: dump it */
 338                         if(reclen) {    /* build & write a data record: */
 339                                 /* address + data + checksum */
 340                                 length = 4 + reclen + 1;
 341
 342                                 /* accumulate length bytes into checksum */
 343                                 for(i = 0; i < 2; i++)
 344                                         checksum += (length >> (8*i)) & 0xff;
 345
 346                                 /* accumulate address bytes into checksum: */
 347                                 for(i = 0; i < 4; i++)
 348                                         checksum += (address >> (8*i)) & 0xff;
 349
 350                                 /* make proper checksum byte: */
 351                                 checksum = ~checksum & 0xff;
 352
 353                                 /* output one record: */
 354                                 sprintf(record, SREC3_FORMAT, length, address, data, checksum);
 355                                 if(write_record(record))
 356                                         return (-1);
 357                         }
 358                         address  += reclen;  /* increment address */
 359                         checksum  = 0;
 360                         reclen    = 0;
 361                 }
 362         }
 363         while(count);
 364         if(write_record(SREC3_END))     /* write the final record */
 365                 return (-1);
 366         return(0);
 367 }
 368
 369 static int write_record(char *buf)
 370 {
 371         char c;
 372
 373         while((c = *buf++))
 374                 putc(c);
 375
 376         /* Check for the console hangup (if any different from serial) */
 377
 378         if (ctrlc()) {
 379             return (-1);
 380         }
 381         return (0);
 382 }
 383 # endif
 384
 385 #endif
 386
 387
 388 #if defined(CONFIG_CMD_LOADB)
 389 /*
 390  * loadb command (load binary) included
 391  */
 392 #define XON_CHAR        17
 393 #define XOFF_CHAR       19
 394 #define START_CHAR      0x01
 395 #define ETX_CHAR        0x03
 396 #define END_CHAR        0x0D
 397 #define SPACE           0x20
 398 #define K_ESCAPE        0x23
 399 #define SEND_TYPE       'S'
 400 #define DATA_TYPE       'D'
 401 #define ACK_TYPE        'Y'
 402 #define NACK_TYPE       'N'
 403 #define BREAK_TYPE      'B'
 404 #define tochar(x) ((char) (((x) + SPACE) & 0xff))
 405 #define untochar(x) ((int) (((x) - SPACE) & 0xff))
 406
 407 static void set_kerm_bin_mode(unsigned long *);
 408 static int k_recv(void);
 409 static ulong load_serial_bin(ulong offset);
 410
 411
 412 static char his_eol;        /* character he needs at end of packet */
 413 static int  his_pad_count;  /* number of pad chars he needs */
 414 static char his_pad_char;   /* pad chars he needs */
 415 static char his_quote;      /* quote chars he'll use */
 416
 417 static int do_load_serial_bin(cmd_tbl_t *cmdtp, int flag, int argc,
 418                               char * const argv[])
 419 {
 420         ulong offset = 0;
 421         ulong addr;
 422         int load_baudrate, current_baudrate;
 423         int rcode = 0;
 424         char *s;
 425
 426         /* pre-set offset from CONFIG_SYS_LOAD_ADDR */
 427         offset = CONFIG_SYS_LOAD_ADDR;
 428
 429         /* pre-set offset from $loadaddr */
 430         if ((s = getenv("loadaddr")) != NULL) {
 431                 offset = simple_strtoul(s, NULL, 16);
 432         }
 433
 434         load_baudrate = current_baudrate = gd->baudrate;
 435
 436         if (argc >= 2) {
 437                 offset = simple_strtoul(argv[1], NULL, 16);
 438         }
 439         if (argc == 3) {
 440                 load_baudrate = (int)simple_strtoul(argv[2], NULL, 10);
 441
 442                 /* default to current baudrate */
 443                 if (load_baudrate == 0)
 444                         load_baudrate = current_baudrate;
 445         }
 446
 447         if (load_baudrate != current_baudrate) {
 448                 printf("## Switch baudrate to %d bps and press ENTER ...\n",
 449                         load_baudrate);
 450                 udelay(50000);
 451                 gd->baudrate = load_baudrate;
 452                 serial_setbrg();
 453                 udelay(50000);
 454                 for (;;) {
 455                         if (getc() == '\r')
 456                                 break;
 457                 }
 458         }
 459
 460         if (strcmp(argv[0],"loady")==0) {
 461                 printf("## Ready for binary (ymodem) download "
 462                         "to 0x%08lX at %d bps...\n",
 463                         offset,
 464                         load_baudrate);
 465
 466                 addr = load_serial_ymodem(offset, xyzModem_ymodem);
 467
 468         } else if (strcmp(argv[0],"loadx")==0) {
 469                 printf("## Ready for binary (xmodem) download "
 470                         "to 0x%08lX at %d bps...\n",
 471                         offset,
 472                         load_baudrate);
 473
 474                 addr = load_serial_ymodem(offset, xyzModem_xmodem);
 475
 476         } else {
 477
 478                 printf("## Ready for binary (kermit) download "
 479                         "to 0x%08lX at %d bps...\n",
 480                         offset,
 481                         load_baudrate);
 482                 addr = load_serial_bin(offset);
 483
 484                 if (addr == ~0) {
 485                         load_addr = 0;
 486                         printf("## Binary (kermit) download aborted\n");
 487                         rcode = 1;
 488                 } else {
 489                         printf("## Start Addr      = 0x%08lX\n", addr);
 490                         load_addr = addr;
 491                 }
 492         }
 493         if (load_baudrate != current_baudrate) {
 494                 printf("## Switch baudrate to %d bps and press ESC ...\n",
 495                         current_baudrate);
 496                 udelay(50000);
 497                 gd->baudrate = current_baudrate;
 498                 serial_setbrg();
 499                 udelay(50000);
 500                 for (;;) {
 501                         if (getc() == 0x1B) /* ESC */
 502                                 break;
 503                 }
 504         }
 505
 506         return rcode;
 507 }
 508
 509
 510 static ulong load_serial_bin(ulong offset)
 511 {
 512         int size, i;
 513
 514         set_kerm_bin_mode((ulong *) offset);
 515         size = k_recv();
 516
 517         /*
 518          * Gather any trailing characters (for instance, the ^D which
 519          * is sent by 'cu' after sending a file), and give the
 520          * box some time (100 * 1 ms)
 521          */
 522         for (i=0; i<100; ++i) {
 523                 if (tstc()) {
 524                         (void) getc();
 525                 }
 526                 udelay(1000);
 527         }
 528
 529         flush_cache(offset, size);
 530
 531         printf("## Total Size      = 0x%08x = %d Bytes\n", size, size);
 532         setenv_hex("filesize", size);
 533
 534         return offset;
 535 }
 536
 537 static void send_pad(void)
 538 {
 539         int count = his_pad_count;
 540
 541         while (count-- > 0)
 542                 putc(his_pad_char);
 543 }
 544
 545 /* converts escaped kermit char to binary char */
 546 static char ktrans(char in)
 547 {
 548         if ((in & 0x60) == 0x40) {
 549                 return (char) (in & ~0x40);
 550         } else if ((in & 0x7f) == 0x3f) {
 551                 return (char) (in | 0x40);
 552         } else
 553                 return in;
 554 }
 555
 556 static int chk1(char *buffer)
 557 {
 558         int total = 0;
 559
 560         while (*buffer) {
 561                 total += *buffer++;
 562         }
 563         return (int) ((total + ((total >> 6) & 0x03)) & 0x3f);
 564 }
 565
 566 static void s1_sendpacket(char *packet)
 567 {
 568         send_pad();
 569         while (*packet) {
 570                 putc(*packet++);
 571         }
 572 }
 573
 574 static char a_b[24];
 575 static void send_ack(int n)
 576 {
 577         a_b[0] = START_CHAR;
 578         a_b[1] = tochar(3);
 579         a_b[2] = tochar(n);
 580         a_b[3] = ACK_TYPE;
 581         a_b[4] = '\0';
 582         a_b[4] = tochar(chk1(&a_b[1]));
 583         a_b[5] = his_eol;
 584         a_b[6] = '\0';
 585         s1_sendpacket(a_b);
 586 }
 587
 588 static void send_nack(int n)
 589 {
 590         a_b[0] = START_CHAR;
 591         a_b[1] = tochar(3);
 592         a_b[2] = tochar(n);
 593         a_b[3] = NACK_TYPE;
 594         a_b[4] = '\0';
 595         a_b[4] = tochar(chk1(&a_b[1]));
 596         a_b[5] = his_eol;
 597         a_b[6] = '\0';
 598         s1_sendpacket(a_b);
 599 }
 600
 601
 602 static void (*os_data_init)(void);
 603 static void (*os_data_char)(char new_char);
 604 static int os_data_state, os_data_state_saved;
 605 static char *os_data_addr, *os_data_addr_saved;
 606 static char *bin_start_address;
 607
 608 static void bin_data_init(void)
 609 {
 610         os_data_state = 0;
 611         os_data_addr = bin_start_address;
 612 }
 613
 614 static void os_data_save(void)
 615 {
 616         os_data_state_saved = os_data_state;
 617         os_data_addr_saved = os_data_addr;
 618 }
 619
 620 static void os_data_restore(void)
 621 {
 622         os_data_state = os_data_state_saved;
 623         os_data_addr = os_data_addr_saved;
 624 }
 625
 626 static void bin_data_char(char new_char)
 627 {
 628         switch (os_data_state) {
 629         case 0:                                 /* data */
 630                 *os_data_addr++ = new_char;
 631                 break;
 632         }
 633 }
 634
 635 static void set_kerm_bin_mode(unsigned long *addr)
 636 {
 637         bin_start_address = (char *) addr;
 638         os_data_init = bin_data_init;
 639         os_data_char = bin_data_char;
 640 }
 641
 642
 643 /* k_data_* simply handles the kermit escape translations */
 644 static int k_data_escape, k_data_escape_saved;
 645 static void k_data_init(void)
 646 {
 647         k_data_escape = 0;
 648         os_data_init();
 649 }
 650
 651 static void k_data_save(void)
 652 {
 653         k_data_escape_saved = k_data_escape;
 654         os_data_save();
 655 }
 656
 657 static void k_data_restore(void)
 658 {
 659         k_data_escape = k_data_escape_saved;
 660         os_data_restore();
 661 }
 662
 663 static void k_data_char(char new_char)
 664 {
 665         if (k_data_escape) {
 666                 /* last char was escape - translate this character */
 667                 os_data_char(ktrans(new_char));
 668                 k_data_escape = 0;
 669         } else {
 670                 if (new_char == his_quote) {
 671                         /* this char is escape - remember */
 672                         k_data_escape = 1;
 673                 } else {
 674                         /* otherwise send this char as-is */
 675                         os_data_char(new_char);
 676                 }
 677         }
 678 }
 679
 680 #define SEND_DATA_SIZE  20
 681 static char send_parms[SEND_DATA_SIZE];
 682 static char *send_ptr;
 683
 684 /* handle_send_packet interprits the protocol info and builds and
 685    sends an appropriate ack for what we can do */
 686 static void handle_send_packet(int n)
 687 {
 688         int length = 3;
 689         int bytes;
 690
 691         /* initialize some protocol parameters */
 692         his_eol = END_CHAR;             /* default end of line character */
 693         his_pad_count = 0;
 694         his_pad_char = '\0';
 695         his_quote = K_ESCAPE;
 696
 697         /* ignore last character if it filled the buffer */
 698         if (send_ptr == &send_parms[SEND_DATA_SIZE - 1])
 699                 --send_ptr;
 700         bytes = send_ptr - send_parms;  /* how many bytes we'll process */
 701         do {
 702                 if (bytes-- <= 0)
 703                         break;
 704                 /* handle MAXL - max length */
 705                 /* ignore what he says - most I'll take (here) is 94 */
 706                 a_b[++length] = tochar(94);
 707                 if (bytes-- <= 0)
 708                         break;
 709                 /* handle TIME - time you should wait for my packets */
 710                 /* ignore what he says - don't wait for my ack longer than 1 second */
 711                 a_b[++length] = tochar(1);
 712                 if (bytes-- <= 0)
 713                         break;
 714                 /* handle NPAD - number of pad chars I need */
 715                 /* remember what he says - I need none */
 716                 his_pad_count = untochar(send_parms[2]);
 717                 a_b[++length] = tochar(0);
 718                 if (bytes-- <= 0)
 719                         break;
 720                 /* handle PADC - pad chars I need */
 721                 /* remember what he says - I need none */
 722                 his_pad_char = ktrans(send_parms[3]);
 723                 a_b[++length] = 0x40;   /* He should ignore this */
 724                 if (bytes-- <= 0)
 725                         break;
 726                 /* handle EOL - end of line he needs */
 727                 /* remember what he says - I need CR */
 728                 his_eol = untochar(send_parms[4]);
 729                 a_b[++length] = tochar(END_CHAR);
 730                 if (bytes-- <= 0)
 731                         break;
 732                 /* handle QCTL - quote control char he'll use */
 733                 /* remember what he says - I'll use '#' */
 734                 his_quote = send_parms[5];
 735                 a_b[++length] = '#';
 736                 if (bytes-- <= 0)
 737                         break;
 738                 /* handle QBIN - 8-th bit prefixing */
 739                 /* ignore what he says - I refuse */
 740                 a_b[++length] = 'N';
 741                 if (bytes-- <= 0)
 742                         break;
 743                 /* handle CHKT - the clock check type */
 744                 /* ignore what he says - I do type 1 (for now) */
 745                 a_b[++length] = '1';
 746                 if (bytes-- <= 0)
 747                         break;
 748                 /* handle REPT - the repeat prefix */
 749                 /* ignore what he says - I refuse (for now) */
 750                 a_b[++length] = 'N';
 751                 if (bytes-- <= 0)
 752                         break;
 753                 /* handle CAPAS - the capabilities mask */
 754                 /* ignore what he says - I only do long packets - I don't do windows */
 755                 a_b[++length] = tochar(2);      /* only long packets */
 756                 a_b[++length] = tochar(0);      /* no windows */
 757                 a_b[++length] = tochar(94);     /* large packet msb */
 758                 a_b[++length] = tochar(94);     /* large packet lsb */
 759         } while (0);
 760
 761         a_b[0] = START_CHAR;
 762         a_b[1] = tochar(length);
 763         a_b[2] = tochar(n);
 764         a_b[3] = ACK_TYPE;
 765         a_b[++length] = '\0';
 766         a_b[length] = tochar(chk1(&a_b[1]));
 767         a_b[++length] = his_eol;
 768         a_b[++length] = '\0';
 769         s1_sendpacket(a_b);
 770 }
 771
 772 /* k_recv receives a OS Open image file over kermit line */
 773 static int k_recv(void)
 774 {
 775         char new_char;
 776         char k_state, k_state_saved;
 777         int sum;
 778         int done;
 779         int length;
 780         int n, last_n;
 781         int len_lo, len_hi;
 782
 783         /* initialize some protocol parameters */
 784         his_eol = END_CHAR;             /* default end of line character */
 785         his_pad_count = 0;
 786         his_pad_char = '\0';
 787         his_quote = K_ESCAPE;
 788
 789         /* initialize the k_recv and k_data state machine */
 790         done = 0;
 791         k_state = 0;
 792         k_data_init();
 793         k_state_saved = k_state;
 794         k_data_save();
 795         n = 0;                          /* just to get rid of a warning */
 796         last_n = -1;
 797
 798         /* expect this "type" sequence (but don't check):
 799            S: send initiate
 800            F: file header
 801            D: data (multiple)
 802            Z: end of file
 803            B: break transmission
 804          */
 805
 806         /* enter main loop */
 807         while (!done) {
 808                 /* set the send packet pointer to begining of send packet parms */
 809                 send_ptr = send_parms;
 810
 811                 /* With each packet, start summing the bytes starting with the length.
 812                    Save the current sequence number.
 813                    Note the type of the packet.
 814                    If a character less than SPACE (0x20) is received - error.
 815                  */
 816
 817 #if 0
 818                 /* OLD CODE, Prior to checking sequence numbers */
 819                 /* first have all state machines save current states */
 820                 k_state_saved = k_state;
 821                 k_data_save ();
 822 #endif
 823
 824                 /* get a packet */
 825                 /* wait for the starting character or ^C */
 826                 for (;;) {
 827                         switch (getc ()) {
 828                         case START_CHAR:        /* start packet */
 829                                 goto START;
 830                         case ETX_CHAR:          /* ^C waiting for packet */
 831                                 return (0);
 832                         default:
 833                                 ;
 834                         }
 835                 }
 836 START:
 837                 /* get length of packet */
 838                 sum = 0;
 839                 new_char = getc();
 840                 if ((new_char & 0xE0) == 0)
 841                         goto packet_error;
 842                 sum += new_char & 0xff;
 843                 length = untochar(new_char);
 844                 /* get sequence number */
 845                 new_char = getc();
 846                 if ((new_char & 0xE0) == 0)
 847                         goto packet_error;
 848                 sum += new_char & 0xff;
 849                 n = untochar(new_char);
 850                 --length;
 851
 852                 /* NEW CODE - check sequence numbers for retried packets */
 853                 /* Note - this new code assumes that the sequence number is correctly
 854                  * received.  Handling an invalid sequence number adds another layer
 855                  * of complexity that may not be needed - yet!  At this time, I'm hoping
 856                  * that I don't need to buffer the incoming data packets and can write
 857                  * the data into memory in real time.
 858                  */
 859                 if (n == last_n) {
 860                         /* same sequence number, restore the previous state */
 861                         k_state = k_state_saved;
 862                         k_data_restore();
 863                 } else {
 864                         /* new sequence number, checkpoint the download */
 865                         last_n = n;
 866                         k_state_saved = k_state;
 867                         k_data_save();
 868                 }
 869                 /* END NEW CODE */
 870
 871                 /* get packet type */
 872                 new_char = getc();
 873                 if ((new_char & 0xE0) == 0)
 874                         goto packet_error;
 875                 sum += new_char & 0xff;
 876                 k_state = new_char;
 877                 --length;
 878                 /* check for extended length */
 879                 if (length == -2) {
 880                         /* (length byte was 0, decremented twice) */
 881                         /* get the two length bytes */
 882                         new_char = getc();
 883                         if ((new_char & 0xE0) == 0)
 884                                 goto packet_error;
 885                         sum += new_char & 0xff;
 886                         len_hi = untochar(new_char);
 887                         new_char = getc();
 888                         if ((new_char & 0xE0) == 0)
 889                                 goto packet_error;
 890                         sum += new_char & 0xff;
 891                         len_lo = untochar(new_char);
 892                         length = len_hi * 95 + len_lo;
 893                         /* check header checksum */
 894                         new_char = getc();
 895                         if ((new_char & 0xE0) == 0)
 896                                 goto packet_error;
 897                         if (new_char != tochar((sum + ((sum >> 6) & 0x03)) & 0x3f))
 898                                 goto packet_error;
 899                         sum += new_char & 0xff;
 900 /* --length; */ /* new length includes only data and block check to come */
 901                 }
 902                 /* bring in rest of packet */
 903                 while (length > 1) {
 904                         new_char = getc();
 905                         if ((new_char & 0xE0) == 0)
 906                                 goto packet_error;
 907                         sum += new_char & 0xff;
 908                         --length;
 909                         if (k_state == DATA_TYPE) {
 910                                 /* pass on the data if this is a data packet */
 911                                 k_data_char (new_char);
 912                         } else if (k_state == SEND_TYPE) {
 913                                 /* save send pack in buffer as is */
 914                                 *send_ptr++ = new_char;
 915                                 /* if too much data, back off the pointer */
 916                                 if (send_ptr >= &send_parms[SEND_DATA_SIZE])
 917                                         --send_ptr;
 918                         }
 919                 }
 920                 /* get and validate checksum character */
 921                 new_char = getc();
 922                 if ((new_char & 0xE0) == 0)
 923                         goto packet_error;
 924                 if (new_char != tochar((sum + ((sum >> 6) & 0x03)) & 0x3f))
 925                         goto packet_error;
 926                 /* get END_CHAR */
 927                 new_char = getc();
 928                 if (new_char != END_CHAR) {
 929                   packet_error:
 930                         /* restore state machines */
 931                         k_state = k_state_saved;
 932                         k_data_restore();
 933                         /* send a negative acknowledge packet in */
 934                         send_nack(n);
 935                 } else if (k_state == SEND_TYPE) {
 936                         /* crack the protocol parms, build an appropriate ack packet */
 937                         handle_send_packet(n);
 938                 } else {
 939                         /* send simple acknowledge packet in */
 940                         send_ack(n);
 941                         /* quit if end of transmission */
 942                         if (k_state == BREAK_TYPE)
 943                                 done = 1;
 944                 }
 945         }
 946         return ((ulong) os_data_addr - (ulong) bin_start_address);
 947 }
 948
 949 static int getcxmodem(void) {
 950         if (tstc())
 951                 return (getc());
 952         return -1;
 953 }
 954 static ulong load_serial_ymodem(ulong offset, int mode)
 955 {
 956         int size;
 957         int err;
 958         int res;
 959         connection_info_t info;
 960         char ymodemBuf[1024];
 961         ulong store_addr = ~0;
 962         ulong addr = 0;
 963
 964         size = 0;
 965         info.mode = mode;
 966         res = xyzModem_stream_open(&info, &err);
 967         if (!res) {
 968
 969                 while ((res =
 970                         xyzModem_stream_read(ymodemBuf, 1024, &err)) > 0) {
 971                         store_addr = addr + offset;
 972                         size += res;
 973                         addr += res;
 974 #ifdef CONFIG_MTD_NOR_FLASH
 975                         if (addr2info(store_addr)) {
 976                                 int rc;
 977
 978                                 rc = flash_write((char *) ymodemBuf,
 979                                                   store_addr, res);
 980                                 if (rc != 0) {
 981                                         flash_perror (rc);
 982                                         return (~0);
 983                                 }
 984                         } else
 985 #endif
 986                         {
 987                                 memcpy((char *)(store_addr), ymodemBuf,
 988                                         res);
 989                         }
 990
 991                 }
 992         } else {
 993                 printf("%s\n", xyzModem_error(err));
 994         }
 995
 996         xyzModem_stream_close(&err);
 997         xyzModem_stream_terminate(false, &getcxmodem);
 998
 999
1000         flush_cache(offset, ALIGN(size, ARCH_DMA_MINALIGN));
1001
1002         printf("## Total Size      = 0x%08x = %d Bytes\n", size, size);
1003         setenv_hex("filesize", size);
1004
1005         return offset;
1006 }
1007
1008 #endif
1009
1010 /* -------------------------------------------------------------------- */
1011
1012 #if defined(CONFIG_CMD_LOADS)
1013
1014 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
1015 U_BOOT_CMD(
1016         loads, 3, 0,    do_load_serial,
1017         "load S-Record file over serial line",
1018         "[ off ] [ baud ]\n"
1019         "    - load S-Record file over serial line"
1020         " with offset 'off' and baudrate 'baud'"
1021 );
1022
1023 #else   /* ! CONFIG_SYS_LOADS_BAUD_CHANGE */
1024 U_BOOT_CMD(
1025         loads, 2, 0,    do_load_serial,
1026         "load S-Record file over serial line",
1027         "[ off ]\n"
1028         "    - load S-Record file over serial line with offset 'off'"
1029 );
1030 #endif  /* CONFIG_SYS_LOADS_BAUD_CHANGE */
1031
1032 /*
1033  * SAVES always requires LOADS support, but not vice versa
1034  */
1035
1036
1037 #if defined(CONFIG_CMD_SAVES)
1038 #ifdef  CONFIG_SYS_LOADS_BAUD_CHANGE
1039 U_BOOT_CMD(
1040         saves, 4, 0,    do_save_serial,
1041         "save S-Record file over serial line",
1042         "[ off ] [size] [ baud ]\n"
1043         "    - save S-Record file over serial line"
1044         " with offset 'off', size 'size' and baudrate 'baud'"
1045 );
1046 #else   /* ! CONFIG_SYS_LOADS_BAUD_CHANGE */
1047 U_BOOT_CMD(
1048         saves, 3, 0,    do_save_serial,
1049         "save S-Record file over serial line",
1050         "[ off ] [size]\n"
1051         "    - save S-Record file over serial line with offset 'off' and size 'size'"
1052 );
1053 #endif  /* CONFIG_SYS_LOADS_BAUD_CHANGE */
1054 #endif  /* CONFIG_CMD_SAVES */
1055 #endif  /* CONFIG_CMD_LOADS */
1056
1057
1058 #if defined(CONFIG_CMD_LOADB)
1059 U_BOOT_CMD(
1060         loadb, 3, 0,    do_load_serial_bin,
1061         "load binary file over serial line (kermit mode)",
1062         "[ off ] [ baud ]\n"
1063         "    - load binary file over serial line"
1064         " with offset 'off' and baudrate 'baud'"
1065 );
1066
1067 U_BOOT_CMD(
1068         loadx, 3, 0,    do_load_serial_bin,
1069         "load binary file over serial line (xmodem mode)",
1070         "[ off ] [ baud ]\n"
1071         "    - load binary file over serial line"
1072         " with offset 'off' and baudrate 'baud'"
1073 );
1074
1075 U_BOOT_CMD(
1076         loady, 3, 0,    do_load_serial_bin,
1077         "load binary file over serial line (ymodem mode)",
1078         "[ off ] [ baud ]\n"
1079         "    - load binary file over serial line"
1080         " with offset 'off' and baudrate 'baud'"
1081 );
1082
1083 #endif  /* CONFIG_CMD_LOADB */