2008-06-05 17:45:20 +00:00
|
|
|
/**
|
|
|
|
* @file
|
|
|
|
* @brief LoadB and LoadY support.
|
|
|
|
*
|
|
|
|
* Provides loadb (over Kermit) and LoadY(over Y modem) support to download
|
|
|
|
* images.
|
|
|
|
*
|
|
|
|
* FileName: commands/loadb.c
|
|
|
|
*/
|
2003-06-27 21:31:46 +00:00
|
|
|
/*
|
2004-03-12 00:14:09 +00:00
|
|
|
* (C) Copyright 2000-2004
|
2003-06-27 21:31:46 +00:00
|
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
|
|
*
|
|
|
|
* See file CREDITS for list of people who contributed to this
|
|
|
|
* project.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License as
|
|
|
|
* published by the Free Software Foundation; either version 2 of
|
|
|
|
* the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
|
|
* MA 02111-1307 USA
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Serial up- and download support
|
|
|
|
*/
|
|
|
|
#include <common.h>
|
|
|
|
#include <command.h>
|
2006-03-30 11:40:55 +00:00
|
|
|
#include <xyzModem.h>
|
2008-06-05 17:45:20 +00:00
|
|
|
#include <console.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <environment.h>
|
|
|
|
#include <cache.h>
|
|
|
|
#include <getopt.h>
|
|
|
|
#include <fs.h>
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <malloc.h>
|
|
|
|
|
|
|
|
#define XON_CHAR 17
|
|
|
|
#define XOFF_CHAR 19
|
|
|
|
#define START_CHAR 0x01
|
2003-06-27 21:31:46 +00:00
|
|
|
#define ETX_CHAR 0x03
|
2008-06-05 17:45:20 +00:00
|
|
|
#define END_CHAR 0x0D
|
|
|
|
#define SPACE 0x20
|
|
|
|
#define K_ESCAPE 0x23
|
|
|
|
#define SEND_TYPE 'S'
|
|
|
|
#define DATA_TYPE 'D'
|
|
|
|
#define ACK_TYPE 'Y'
|
|
|
|
#define NACK_TYPE 'N'
|
|
|
|
#define BREAK_TYPE 'B'
|
|
|
|
#define tochar(x) ((char) (((x) + SPACE) & 0xff))
|
|
|
|
#define untochar(x) ((int) (((x) - SPACE) & 0xff))
|
|
|
|
#define DEF_FILE "/dev/mem"
|
|
|
|
|
|
|
|
static int ofd; /* output file descriptor */
|
|
|
|
|
|
|
|
#ifdef CONFIG_CMD_LOADB
|
|
|
|
static char his_eol; /* character he needs at end of packet */
|
|
|
|
static int his_pad_count; /* number of pad chars he needs */
|
|
|
|
static char his_pad_char; /* pad chars he needs */
|
|
|
|
static char his_quote; /* quote chars he'll use */
|
|
|
|
|
|
|
|
static void send_pad(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
int count = his_pad_count;
|
|
|
|
|
|
|
|
while (count-- > 0)
|
2008-06-05 17:45:20 +00:00
|
|
|
console_putc(CONSOLE_STDOUT, his_pad_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* converts escaped kermit char to binary char */
|
2008-06-05 17:45:20 +00:00
|
|
|
static char ktrans(char in)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
if ((in & 0x60) == 0x40) {
|
2008-06-05 17:45:20 +00:00
|
|
|
return (char)(in & ~0x40);
|
2003-06-27 21:31:46 +00:00
|
|
|
} else if ((in & 0x7f) == 0x3f) {
|
2008-06-05 17:45:20 +00:00
|
|
|
return (char)(in | 0x40);
|
2003-06-27 21:31:46 +00:00
|
|
|
} else
|
|
|
|
return in;
|
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
static int chk1(char *buffer)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
int total = 0;
|
|
|
|
|
|
|
|
while (*buffer) {
|
|
|
|
total += *buffer++;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
return (int)((total + ((total >> 6) & 0x03)) & 0x3f);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
static void s1_sendpacket(char *packet)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
2008-06-05 17:45:20 +00:00
|
|
|
send_pad();
|
2003-06-27 21:31:46 +00:00
|
|
|
while (*packet) {
|
2008-06-05 17:45:20 +00:00
|
|
|
console_putc(CONSOLE_STDOUT, *packet++);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static char a_b[24];
|
2008-06-05 17:45:20 +00:00
|
|
|
static void send_ack(int n)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
a_b[0] = START_CHAR;
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[1] = tochar(3);
|
|
|
|
a_b[2] = tochar(n);
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[3] = ACK_TYPE;
|
|
|
|
a_b[4] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[4] = tochar(chk1(&a_b[1]));
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[5] = his_eol;
|
|
|
|
a_b[6] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
s1_sendpacket(a_b);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
static void send_nack(int n)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
a_b[0] = START_CHAR;
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[1] = tochar(3);
|
|
|
|
a_b[2] = tochar(n);
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[3] = NACK_TYPE;
|
|
|
|
a_b[4] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[4] = tochar(chk1(&a_b[1]));
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[5] = his_eol;
|
|
|
|
a_b[6] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
s1_sendpacket(a_b);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
/* os_data_* data buffer handling before flushing the data to the o/p device
|
|
|
|
* we will only dump valid packets to the device.
|
|
|
|
*/
|
|
|
|
static int os_data_count, os_old_count, os_data_total;
|
|
|
|
static char *os_data_addr, *os_old_buffer;
|
2003-06-27 21:31:46 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
static void os_data_init(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
os_data_count = 0;
|
2008-06-05 17:45:20 +00:00
|
|
|
os_old_count = 0;
|
|
|
|
os_data_addr = NULL;
|
|
|
|
os_old_buffer = NULL;
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
|
|
|
|
static int os_data_alloc(int length)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
2008-06-05 17:45:20 +00:00
|
|
|
/* If already allocated, free the memory
|
|
|
|
*/
|
|
|
|
if (os_data_addr != NULL) {
|
|
|
|
os_data_addr -= os_data_count;
|
|
|
|
free(os_data_addr);
|
|
|
|
}
|
|
|
|
os_data_count = 0;
|
|
|
|
os_data_addr = (char *)malloc(length);
|
|
|
|
if (os_data_addr == NULL)
|
|
|
|
return -1;
|
|
|
|
return 0;
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
|
|
|
|
static int os_data_save(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
2008-06-05 17:45:20 +00:00
|
|
|
int ret = 0;
|
|
|
|
/* if there was an old data, flush it */
|
|
|
|
if (os_old_buffer) {
|
|
|
|
flush_cache((ulong) os_old_buffer, os_old_count);
|
|
|
|
ret = write(ofd, os_old_buffer, os_old_count);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
os_data_total += os_old_count;
|
|
|
|
free(os_old_buffer);
|
|
|
|
}
|
|
|
|
os_old_count = os_data_count;
|
|
|
|
os_old_buffer = os_data_addr - os_data_count;
|
|
|
|
os_data_count = 0;
|
|
|
|
os_data_addr = NULL;
|
|
|
|
return 0;
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
|
|
|
|
static void os_data_dump(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
2008-06-05 17:45:20 +00:00
|
|
|
if (os_old_buffer)
|
|
|
|
free(os_old_buffer);
|
|
|
|
if (os_data_addr) {
|
|
|
|
os_data_addr -= os_data_count;
|
|
|
|
free(os_data_addr);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
os_data_init();
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
static void os_data_char(char new_char)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
2008-06-05 17:45:20 +00:00
|
|
|
*os_data_addr++ = new_char;
|
|
|
|
os_data_count++;
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* k_data_* simply handles the kermit escape translations */
|
|
|
|
static int k_data_escape, k_data_escape_saved;
|
2008-06-05 17:45:20 +00:00
|
|
|
static void k_data_init(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
k_data_escape = 0;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
static void k_data_save(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
k_data_escape_saved = k_data_escape;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
static void k_data_restore(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
k_data_escape = k_data_escape_saved;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
static void k_data_char(char new_char)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
if (k_data_escape) {
|
|
|
|
/* last char was escape - translate this character */
|
2008-06-05 17:45:20 +00:00
|
|
|
os_data_char(ktrans(new_char));
|
2003-06-27 21:31:46 +00:00
|
|
|
k_data_escape = 0;
|
|
|
|
} else {
|
|
|
|
if (new_char == his_quote) {
|
|
|
|
/* this char is escape - remember */
|
|
|
|
k_data_escape = 1;
|
|
|
|
} else {
|
|
|
|
/* otherwise send this char as-is */
|
2008-06-05 17:45:20 +00:00
|
|
|
os_data_char(new_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#define SEND_DATA_SIZE 20
|
2008-06-05 17:45:20 +00:00
|
|
|
static char send_parms[SEND_DATA_SIZE];
|
|
|
|
static char *send_ptr;
|
2003-06-27 21:31:46 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
/**
|
|
|
|
* @brief interprets the protocol info and builds and
|
|
|
|
* sends an appropriate ack for what we can do
|
|
|
|
*
|
|
|
|
* @param n sequence
|
|
|
|
*
|
|
|
|
* @return void
|
|
|
|
*/
|
|
|
|
static void handle_send_packet(int n)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
int length = 3;
|
|
|
|
int bytes;
|
|
|
|
|
|
|
|
/* initialize some protocol parameters */
|
2008-06-05 17:45:20 +00:00
|
|
|
his_eol = END_CHAR; /* default end of line character */
|
2003-06-27 21:31:46 +00:00
|
|
|
his_pad_count = 0;
|
|
|
|
his_pad_char = '\0';
|
|
|
|
his_quote = K_ESCAPE;
|
|
|
|
|
|
|
|
/* ignore last character if it filled the buffer */
|
|
|
|
if (send_ptr == &send_parms[SEND_DATA_SIZE - 1])
|
|
|
|
--send_ptr;
|
|
|
|
bytes = send_ptr - send_parms; /* how many bytes we'll process */
|
|
|
|
do {
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle MAXL - max length */
|
|
|
|
/* ignore what he says - most I'll take (here) is 94 */
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[++length] = tochar(94);
|
2003-06-27 21:31:46 +00:00
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle TIME - time you should wait for my packets */
|
|
|
|
/* ignore what he says - don't wait for my ack longer than 1 second */
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[++length] = tochar(1);
|
2003-06-27 21:31:46 +00:00
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle NPAD - number of pad chars I need */
|
|
|
|
/* remember what he says - I need none */
|
2008-06-05 17:45:20 +00:00
|
|
|
his_pad_count = untochar(send_parms[2]);
|
|
|
|
a_b[++length] = tochar(0);
|
2003-06-27 21:31:46 +00:00
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle PADC - pad chars I need */
|
|
|
|
/* remember what he says - I need none */
|
2008-06-05 17:45:20 +00:00
|
|
|
his_pad_char = ktrans(send_parms[3]);
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[++length] = 0x40; /* He should ignore this */
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle EOL - end of line he needs */
|
|
|
|
/* remember what he says - I need CR */
|
2008-06-05 17:45:20 +00:00
|
|
|
his_eol = untochar(send_parms[4]);
|
|
|
|
a_b[++length] = tochar(END_CHAR);
|
2003-06-27 21:31:46 +00:00
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle QCTL - quote control char he'll use */
|
|
|
|
/* remember what he says - I'll use '#' */
|
|
|
|
his_quote = send_parms[5];
|
|
|
|
a_b[++length] = '#';
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle QBIN - 8-th bit prefixing */
|
|
|
|
/* ignore what he says - I refuse */
|
|
|
|
a_b[++length] = 'N';
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle CHKT - the clock check type */
|
|
|
|
/* ignore what he says - I do type 1 (for now) */
|
|
|
|
a_b[++length] = '1';
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle REPT - the repeat prefix */
|
|
|
|
/* ignore what he says - I refuse (for now) */
|
|
|
|
a_b[++length] = 'N';
|
|
|
|
if (bytes-- <= 0)
|
|
|
|
break;
|
|
|
|
/* handle CAPAS - the capabilities mask */
|
|
|
|
/* ignore what he says - I only do long packets - I don't do windows */
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[++length] = tochar(2); /* only long packets */
|
|
|
|
a_b[++length] = tochar(0); /* no windows */
|
|
|
|
a_b[++length] = tochar(94); /* large packet msb */
|
|
|
|
a_b[++length] = tochar(94); /* large packet lsb */
|
2003-06-27 21:31:46 +00:00
|
|
|
} while (0);
|
|
|
|
|
|
|
|
a_b[0] = START_CHAR;
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[1] = tochar(length);
|
|
|
|
a_b[2] = tochar(n);
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[3] = ACK_TYPE;
|
|
|
|
a_b[++length] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
a_b[length] = tochar(chk1(&a_b[1]));
|
2003-06-27 21:31:46 +00:00
|
|
|
a_b[++length] = his_eol;
|
|
|
|
a_b[++length] = '\0';
|
2008-06-05 17:45:20 +00:00
|
|
|
s1_sendpacket(a_b);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
/**
|
|
|
|
* @brief receives a OS Open image file over kermit line
|
|
|
|
*
|
|
|
|
* @return bytes read
|
|
|
|
*/
|
|
|
|
static int k_recv(void)
|
2003-06-27 21:31:46 +00:00
|
|
|
{
|
|
|
|
char new_char;
|
|
|
|
char k_state, k_state_saved;
|
|
|
|
int sum;
|
|
|
|
int done;
|
|
|
|
int length;
|
|
|
|
int n, last_n;
|
|
|
|
int z = 0;
|
|
|
|
int len_lo, len_hi;
|
|
|
|
|
|
|
|
/* initialize some protocol parameters */
|
2008-06-05 17:45:20 +00:00
|
|
|
his_eol = END_CHAR; /* default end of line character */
|
2003-06-27 21:31:46 +00:00
|
|
|
his_pad_count = 0;
|
|
|
|
his_pad_char = '\0';
|
|
|
|
his_quote = K_ESCAPE;
|
|
|
|
|
|
|
|
/* initialize the k_recv and k_data state machine */
|
|
|
|
done = 0;
|
|
|
|
k_state = 0;
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_init();
|
2003-06-27 21:31:46 +00:00
|
|
|
k_state_saved = k_state;
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_save();
|
|
|
|
os_data_init();
|
|
|
|
os_data_total = 0;
|
|
|
|
n = 0; /* just to get rid of a warning */
|
2003-06-27 21:31:46 +00:00
|
|
|
last_n = -1;
|
|
|
|
|
|
|
|
/* expect this "type" sequence (but don't check):
|
|
|
|
S: send initiate
|
|
|
|
F: file header
|
|
|
|
D: data (multiple)
|
|
|
|
Z: end of file
|
|
|
|
B: break transmission
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* enter main loop */
|
|
|
|
while (!done) {
|
|
|
|
/* set the send packet pointer to begining of send packet parms */
|
|
|
|
send_ptr = send_parms;
|
|
|
|
|
|
|
|
/* With each packet, start summing the bytes starting with the length.
|
|
|
|
Save the current sequence number.
|
|
|
|
Note the type of the packet.
|
|
|
|
If a character less than SPACE (0x20) is received - error.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* get a packet */
|
|
|
|
/* wait for the starting character or ^C */
|
|
|
|
for (;;) {
|
2008-06-05 17:45:20 +00:00
|
|
|
switch (getc()) {
|
2003-06-27 21:31:46 +00:00
|
|
|
case START_CHAR: /* start packet */
|
|
|
|
goto START;
|
2008-06-05 17:45:20 +00:00
|
|
|
case ETX_CHAR: /* ^C waiting for packet */
|
|
|
|
/* Save last success buffer and quit */
|
|
|
|
(void)os_data_save();
|
2003-06-27 21:31:46 +00:00
|
|
|
return (0);
|
|
|
|
default:
|
|
|
|
;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
START:
|
|
|
|
/* get length of packet */
|
|
|
|
sum = 0;
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
2008-06-05 17:45:20 +00:00
|
|
|
length = untochar(new_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
/* get sequence number */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
2008-06-05 17:45:20 +00:00
|
|
|
n = untochar(new_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
--length;
|
|
|
|
|
|
|
|
/* NEW CODE - check sequence numbers for retried packets */
|
|
|
|
/* Note - this new code assumes that the sequence number is correctly
|
|
|
|
* received. Handling an invalid sequence number adds another layer
|
|
|
|
* of complexity that may not be needed - yet! At this time, I'm hoping
|
|
|
|
* that I don't need to buffer the incoming data packets and can write
|
|
|
|
* the data into memory in real time.
|
|
|
|
*/
|
|
|
|
if (n == last_n) {
|
|
|
|
/* same sequence number, restore the previous state */
|
|
|
|
k_state = k_state_saved;
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_restore();
|
|
|
|
/* Dump any previously allocated data including previous
|
|
|
|
* buffer host wishes to retry.. */
|
|
|
|
os_data_dump();
|
2003-06-27 21:31:46 +00:00
|
|
|
} else {
|
|
|
|
/* new sequence number, checkpoint the download */
|
|
|
|
last_n = n;
|
|
|
|
k_state_saved = k_state;
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_save();
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
/* END NEW CODE */
|
|
|
|
|
|
|
|
/* get packet type */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
|
|
|
k_state = new_char;
|
|
|
|
--length;
|
|
|
|
/* check for extended length */
|
|
|
|
if (length == -2) {
|
|
|
|
/* (length byte was 0, decremented twice) */
|
|
|
|
/* get the two length bytes */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
2008-06-05 17:45:20 +00:00
|
|
|
len_hi = untochar(new_char);
|
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
2008-06-05 17:45:20 +00:00
|
|
|
len_lo = untochar(new_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
length = len_hi * 95 + len_lo;
|
|
|
|
/* check header checksum */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
2008-06-05 17:45:20 +00:00
|
|
|
if (new_char !=
|
|
|
|
tochar((sum + ((sum >> 6) & 0x03)) & 0x3f))
|
2003-06-27 21:31:46 +00:00
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
2008-06-05 17:45:20 +00:00
|
|
|
/* --length;
|
|
|
|
* new length includes only data and block check to come
|
|
|
|
*/
|
|
|
|
}
|
|
|
|
/* Try to allocate data chunk */
|
|
|
|
if (length > 1) {
|
|
|
|
if (os_data_alloc(length) < 0) {
|
|
|
|
/* too large.. NACK the data back */
|
|
|
|
goto packet_error;
|
|
|
|
}
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
while (length > 1) {
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
|
|
|
sum += new_char & 0xff;
|
|
|
|
--length;
|
|
|
|
if (k_state == DATA_TYPE) {
|
|
|
|
/* pass on the data if this is a data packet */
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_char(new_char);
|
2003-06-27 21:31:46 +00:00
|
|
|
} else if (k_state == SEND_TYPE) {
|
|
|
|
/* save send pack in buffer as is */
|
|
|
|
*send_ptr++ = new_char;
|
|
|
|
/* if too much data, back off the pointer */
|
|
|
|
if (send_ptr >= &send_parms[SEND_DATA_SIZE])
|
|
|
|
--send_ptr;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/* get and validate checksum character */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if ((new_char & 0xE0) == 0)
|
|
|
|
goto packet_error;
|
2008-06-05 17:45:20 +00:00
|
|
|
if (new_char != tochar((sum + ((sum >> 6) & 0x03)) & 0x3f))
|
2003-06-27 21:31:46 +00:00
|
|
|
goto packet_error;
|
|
|
|
/* get END_CHAR */
|
2008-06-05 17:45:20 +00:00
|
|
|
new_char = getc();
|
2003-06-27 21:31:46 +00:00
|
|
|
if (new_char != END_CHAR) {
|
2008-06-05 17:45:20 +00:00
|
|
|
packet_error:
|
2003-06-27 21:31:46 +00:00
|
|
|
/* restore state machines */
|
|
|
|
k_state = k_state_saved;
|
2008-06-05 17:45:20 +00:00
|
|
|
k_data_restore();
|
2003-06-27 21:31:46 +00:00
|
|
|
/* send a negative acknowledge packet in */
|
2008-06-05 17:45:20 +00:00
|
|
|
send_nack(n);
|
2003-06-27 21:31:46 +00:00
|
|
|
} else if (k_state == SEND_TYPE) {
|
|
|
|
/* crack the protocol parms, build an appropriate ack packet */
|
2008-06-05 17:45:20 +00:00
|
|
|
handle_send_packet(n);
|
2003-06-27 21:31:46 +00:00
|
|
|
} else {
|
|
|
|
/* send simple acknowledge packet in */
|
2008-06-05 17:45:20 +00:00
|
|
|
send_ack(n);
|
|
|
|
/* Flush old buffer,
|
|
|
|
* Store current buffer as old buffer */
|
|
|
|
os_data_save();
|
2003-06-27 21:31:46 +00:00
|
|
|
/* quit if end of transmission */
|
2008-06-05 17:45:20 +00:00
|
|
|
if (k_state == BREAK_TYPE) {
|
|
|
|
/* Flush remaining buffer */
|
|
|
|
os_data_save();
|
2003-06-27 21:31:46 +00:00
|
|
|
done = 1;
|
2008-06-05 17:45:20 +00:00
|
|
|
}
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
|
|
|
++z;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
return ((ulong) os_data_total);
|
2003-06-27 21:31:46 +00:00
|
|
|
}
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
/**
|
|
|
|
* @brief loadb Support over kermit protocol
|
|
|
|
*
|
|
|
|
* @return download size
|
|
|
|
*/
|
|
|
|
static ulong load_serial_bin(void)
|
|
|
|
{
|
|
|
|
int size, i;
|
|
|
|
char buf[32];
|
|
|
|
|
|
|
|
size = k_recv();
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Gather any trailing characters (for instance, the ^D which
|
|
|
|
* is sent by 'cu' after sending a file), and give the
|
|
|
|
* box some time (100 * 1 ms)
|
|
|
|
*/
|
|
|
|
for (i = 0; i < 100; ++i) {
|
|
|
|
if (tstc())
|
|
|
|
(void)getc();
|
|
|
|
udelay(1000);
|
|
|
|
}
|
|
|
|
printf("## Total Size = 0x%08x = %d Bytes\n", size, size);
|
|
|
|
sprintf(buf, "%X", size);
|
|
|
|
setenv("filesize", buf);
|
|
|
|
|
|
|
|
return size;
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif /* CONFIG_CMD_LOADB */
|
|
|
|
|
|
|
|
#ifdef CONFIG_CMD_LOADY
|
|
|
|
/**
|
|
|
|
* @brief getcxmodem
|
|
|
|
*
|
|
|
|
* @return if character avaiable, return the same, else return -1
|
|
|
|
*/
|
|
|
|
static int getcxmodem(void)
|
|
|
|
{
|
2006-04-16 08:51:58 +00:00
|
|
|
if (tstc())
|
2006-03-30 11:40:55 +00:00
|
|
|
return (getc());
|
|
|
|
return -1;
|
|
|
|
}
|
2008-06-05 17:45:20 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief LoadY over ymodem protocol
|
|
|
|
*
|
|
|
|
* @return download size
|
|
|
|
*/
|
|
|
|
static ulong load_serial_ymodem(void)
|
2006-03-30 11:40:55 +00:00
|
|
|
{
|
|
|
|
int size;
|
|
|
|
char buf[32];
|
|
|
|
int err;
|
2008-06-05 17:45:20 +00:00
|
|
|
int res, wr;
|
2006-03-30 11:40:55 +00:00
|
|
|
connection_info_t info;
|
2006-04-16 08:51:58 +00:00
|
|
|
char ymodemBuf[1024];
|
|
|
|
ulong store_addr = ~0;
|
|
|
|
ulong addr = 0;
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2006-04-16 08:51:58 +00:00
|
|
|
size = 0;
|
|
|
|
info.mode = xyzModem_ymodem;
|
2008-06-05 17:45:20 +00:00
|
|
|
res = xyzModem_stream_open(&info, &err);
|
2006-03-30 11:40:55 +00:00
|
|
|
if (!res) {
|
2008-06-05 17:45:20 +00:00
|
|
|
while ((res = xyzModem_stream_read(ymodemBuf, 1024, &err)) >
|
|
|
|
0) {
|
2006-04-16 08:51:58 +00:00
|
|
|
size += res;
|
|
|
|
addr += res;
|
2008-06-05 17:45:20 +00:00
|
|
|
flush_cache((ulong) yModemBuf, res);
|
|
|
|
wr = write(ofd, ymodemBuf, res);
|
|
|
|
if (res != wr) {
|
|
|
|
perror("ymodem");
|
|
|
|
break;
|
|
|
|
}
|
2006-04-16 08:51:58 +00:00
|
|
|
|
|
|
|
}
|
|
|
|
} else {
|
2008-06-05 17:45:20 +00:00
|
|
|
printf("%s\n", xyzModem_error(err));
|
2006-03-30 11:40:55 +00:00
|
|
|
}
|
2006-04-16 08:51:58 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
xyzModem_stream_close(&err);
|
|
|
|
xyzModem_stream_terminate(false, &getcxmodem);
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
printf("## Total Size = 0x%08x = %d Bytes\n", size, size);
|
|
|
|
sprintf(buf, "%X", size);
|
|
|
|
setenv("filesize", buf);
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
return res;
|
|
|
|
}
|
|
|
|
#endif
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
/**
|
|
|
|
* @brief returns current used console device
|
|
|
|
*
|
|
|
|
* @return console device which is registered with CONSOLE_STDIN and
|
|
|
|
* CONSOLE_STDOUT
|
|
|
|
*/
|
|
|
|
static struct console_device *get_current_console(void)
|
|
|
|
{
|
|
|
|
struct console_device *cdev;
|
|
|
|
/*
|
|
|
|
* Assumption to have BOTH CONSOLE_STDIN AND STDOUT in the
|
|
|
|
* same output console
|
|
|
|
*/
|
|
|
|
for_each_console(cdev) {
|
|
|
|
if ((cdev->f_active & (CONSOLE_STDIN | CONSOLE_STDOUT)))
|
|
|
|
return cdev;
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief provide the loadb(Kermit) or loadY mode support
|
|
|
|
*
|
|
|
|
* @param cmdtp
|
|
|
|
* @param argc
|
|
|
|
* @param argv
|
|
|
|
*
|
|
|
|
* @return success or failure
|
|
|
|
*/
|
|
|
|
static int do_load_serial_bin(cmd_tbl_t *cmdtp, int argc, char *argv[])
|
|
|
|
{
|
|
|
|
ulong offset = 0;
|
|
|
|
ulong addr;
|
|
|
|
int load_baudrate = 0, current_baudrate;
|
|
|
|
int rcode = 0;
|
|
|
|
int opt;
|
2008-08-16 00:31:56 +00:00
|
|
|
int open_mode = O_WRONLY;
|
2008-06-05 17:45:20 +00:00
|
|
|
char *output_file = NULL;
|
|
|
|
struct console_device *cdev = NULL;
|
|
|
|
|
|
|
|
getopt_reset();
|
|
|
|
|
2008-08-16 00:31:56 +00:00
|
|
|
while ((opt = getopt(argc, argv, "d:b:o:c")) > 0) {
|
2008-06-05 17:45:20 +00:00
|
|
|
switch (opt) {
|
|
|
|
case 'd':
|
|
|
|
output_file = optarg;
|
|
|
|
break;
|
|
|
|
case 'b':
|
|
|
|
load_baudrate = (int)simple_strtoul(optarg, NULL, 10);
|
|
|
|
break;
|
|
|
|
case 'o':
|
|
|
|
offset = (int)simple_strtoul(optarg, NULL, 10);
|
|
|
|
break;
|
2008-08-16 00:31:56 +00:00
|
|
|
case 'c':
|
|
|
|
open_mode |= O_CREAT;
|
|
|
|
break;
|
2008-06-05 17:45:20 +00:00
|
|
|
default:
|
|
|
|
perror(argv[0]);
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
cdev = get_current_console();
|
|
|
|
if (NULL == cdev) {
|
|
|
|
printf("%s:No console device with STDIN and STDOUT\n", argv[0]);
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
current_baudrate = simple_strtoul(cdev->baudrate_string, NULL, 10);
|
|
|
|
|
|
|
|
/* Load Defaults */
|
|
|
|
if (load_baudrate == 0)
|
|
|
|
load_baudrate = current_baudrate;
|
|
|
|
if (NULL == output_file)
|
|
|
|
output_file = DEF_FILE;
|
|
|
|
|
|
|
|
/* File should exist */
|
2008-08-16 00:31:56 +00:00
|
|
|
ofd = open(output_file, open_mode);
|
2008-06-05 17:45:20 +00:00
|
|
|
if (ofd < 0) {
|
|
|
|
perror(argv[0]);
|
|
|
|
return 3;
|
|
|
|
}
|
|
|
|
/* Seek to the right offset */
|
|
|
|
if (offset) {
|
|
|
|
int seek = lseek(ofd, offset, SEEK_SET);
|
|
|
|
if (seek != offset) {
|
|
|
|
close(ofd);
|
|
|
|
ofd = 0;
|
|
|
|
perror(argv[0]);
|
|
|
|
return 4;
|
|
|
|
}
|
|
|
|
}
|
2006-03-30 11:40:55 +00:00
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
if (load_baudrate != current_baudrate) {
|
|
|
|
printf("## Switch baudrate to %d bps and press ENTER ...\n",
|
|
|
|
load_baudrate);
|
|
|
|
udelay(50000);
|
|
|
|
cdev->setbrg(cdev, load_baudrate);
|
|
|
|
udelay(50000);
|
|
|
|
for (;;) {
|
|
|
|
if (getc() == '\r')
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#ifdef CONFIG_CMD_LOADY
|
|
|
|
if (strcmp(argv[0], "loady") == 0) {
|
|
|
|
printf("## Ready for binary (ymodem) download "
|
|
|
|
"to 0x%08lX offset on %s device at %d bps...\n", offset,
|
|
|
|
output_file, load_baudrate);
|
|
|
|
addr = load_serial_ymodem();
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_CMD_LOADB
|
|
|
|
if (strcmp(argv[0], "loadb") == 0) {
|
|
|
|
|
|
|
|
printf("## Ready for binary (kermit) download "
|
|
|
|
"to 0x%08lX offset on %s device at %d bps...\n", offset,
|
|
|
|
output_file, load_baudrate);
|
|
|
|
addr = load_serial_bin();
|
|
|
|
if (addr == 0) {
|
|
|
|
printf("## Binary (kermit) download aborted\n");
|
|
|
|
rcode = 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
if (load_baudrate != current_baudrate) {
|
|
|
|
printf("## Switch baudrate to %d bps and press ESC ...\n",
|
|
|
|
current_baudrate);
|
|
|
|
udelay(50000);
|
|
|
|
cdev->setbrg(cdev, current_baudrate);
|
|
|
|
udelay(50000);
|
|
|
|
for (;;) {
|
|
|
|
if (getc() == 0x1B) /* ESC */
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
close(ofd);
|
|
|
|
ofd = 0;
|
|
|
|
return rcode;
|
2006-03-30 11:40:55 +00:00
|
|
|
}
|
|
|
|
|
2008-06-05 17:45:20 +00:00
|
|
|
static const __maybe_unused char cmd_loadb_help[] =
|
|
|
|
"[OPTIONS]\n"
|
|
|
|
" -d device - which device to download - defaults to " DEF_FILE "\n"
|
|
|
|
" -o offset - what offset to download - defaults to 0\n"
|
|
|
|
" -b baud - baudrate at which to download - defaults to "
|
2008-08-16 00:31:56 +00:00
|
|
|
"console baudrate"
|
|
|
|
" -c - Create file if it is not present - default disabled";
|
2008-06-05 17:45:20 +00:00
|
|
|
#ifdef CONFIG_CMD_LOADB
|
|
|
|
U_BOOT_CMD_START(loadb)
|
2008-08-16 00:31:56 +00:00
|
|
|
.maxargs = 8,
|
2008-06-05 17:45:20 +00:00
|
|
|
.cmd = do_load_serial_bin,
|
|
|
|
.usage = "Load binary file over serial line (kermit mode)",
|
|
|
|
U_BOOT_CMD_HELP(cmd_loadb_help)
|
|
|
|
U_BOOT_CMD_END
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_CMD_LOADY
|
|
|
|
U_BOOT_CMD_START(loady)
|
2008-08-16 00:31:56 +00:00
|
|
|
.maxargs = 8,
|
2008-06-05 17:45:20 +00:00
|
|
|
.cmd = do_load_serial_bin,
|
|
|
|
.usage = "Load binary file over serial line (ymodem mode)",
|
|
|
|
U_BOOT_CMD_HELP(cmd_loadb_help)
|
|
|
|
U_BOOT_CMD_END
|
|
|
|
#endif
|