/*----------------------------------------------------------------
|
/*----------------------------------------------------------------
|
// //
|
// //
|
// boot-loader-ethmac.c //
|
// boot-loader-ethmac.c //
|
// //
|
// //
|
// This file is part of the Amber project //
|
// This file is part of the Amber project //
|
// http://www.opencores.org/project,amber //
|
// http://www.opencores.org/project,amber //
|
// //
|
// //
|
// Description //
|
// Description //
|
// The main functions for the boot loader application. This //
|
// The main functions for the boot loader application. This //
|
// application is embedded in the FPGA's SRAM and is used //
|
// application is embedded in the FPGA's SRAM and is used //
|
// to load larger applications into the DDR3 memory on //
|
// to load larger applications into the DDR3 memory on //
|
// the development board. //
|
// the development board. //
|
// //
|
// //
|
// Author(s): //
|
// Author(s): //
|
// - Conor Santifort, csantifort.amber@gmail.com //
|
// - Conor Santifort, csantifort.amber@gmail.com //
|
// //
|
// //
|
//////////////////////////////////////////////////////////////////
|
//////////////////////////////////////////////////////////////////
|
// //
|
// //
|
// Copyright (C) 2011 Authors and OPENCORES.ORG //
|
// Copyright (C) 2011 Authors and OPENCORES.ORG //
|
// //
|
// //
|
// This source file may be used and distributed without //
|
// This source file may be used and distributed without //
|
// restriction provided that this copyright statement is not //
|
// restriction provided that this copyright statement is not //
|
// removed from the file and that any derivative work contains //
|
// removed from the file and that any derivative work contains //
|
// the original copyright notice and the associated disclaimer. //
|
// the original copyright notice and the associated disclaimer. //
|
// //
|
// //
|
// This source file is free software; you can redistribute it //
|
// This source file is free software; you can redistribute it //
|
// and/or modify it under the terms of the GNU Lesser General //
|
// and/or modify it under the terms of the GNU Lesser General //
|
// Public License as published by the Free Software Foundation; //
|
// Public License as published by the Free Software Foundation; //
|
// either version 2.1 of the License, or (at your option) any //
|
// either version 2.1 of the License, or (at your option) any //
|
// later version. //
|
// later version. //
|
// //
|
// //
|
// This source is distributed in the hope that it will be //
|
// This source is distributed in the hope that it will be //
|
// useful, but WITHOUT ANY WARRANTY; without even the implied //
|
// useful, but WITHOUT ANY WARRANTY; without even the implied //
|
// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR //
|
// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR //
|
// PURPOSE. See the GNU Lesser General Public License for more //
|
// PURPOSE. See the GNU Lesser General Public License for more //
|
// details. //
|
// details. //
|
// //
|
// //
|
// You should have received a copy of the GNU Lesser General //
|
// You should have received a copy of the GNU Lesser General //
|
// Public License along with this source; if not, download it //
|
// Public License along with this source; if not, download it //
|
// from http://www.opencores.org/lgpl.shtml //
|
// from http://www.opencores.org/lgpl.shtml //
|
// //
|
// //
|
----------------------------------------------------------------*/
|
----------------------------------------------------------------*/
|
|
|
#include "amber_registers.h"
|
#include "amber_registers.h"
|
#include "address_map.h"
|
#include "address_map.h"
|
#include "line-buffer.h"
|
#include "line-buffer.h"
|
#include "timer.h"
|
#include "timer.h"
|
#include "utilities.h"
|
#include "utilities.h"
|
#include "packet.h"
|
#include "packet.h"
|
#include "udp.h"
|
#include "udp.h"
|
#include "tcp.h"
|
#include "tcp.h"
|
#include "tftp.h"
|
#include "tftp.h"
|
#include "elfsplitter.h"
|
#include "elfsplitter.h"
|
|
|
|
|
block_t* udp_file_g = NULL;
|
block_t* udp_file_g = NULL;
|
block_t* udp_current_block_g = NULL;
|
block_t* udp_current_block_g = NULL;
|
time_t* reboot_timer_g;
|
time_t* reboot_timer_g;
|
int reboot_stage_g;
|
int reboot_stage_g;
|
|
|
|
|
block_t* init_buffer_512()
|
block_t* init_buffer_512()
|
{
|
{
|
block_t* block = malloc(sizeof(block_t));
|
block_t* block = malloc(sizeof(block_t));
|
block->buf512 = malloc(512);
|
block->buf512 = malloc(512);
|
block->next = NULL;
|
block->next = NULL;
|
block->bytes = 0;
|
block->bytes = 0;
|
block->last_block = 0;
|
block->last_block = 0;
|
block->total_bytes = 0;
|
block->total_bytes = 0;
|
block->total_blocks = 0;
|
block->total_blocks = 0;
|
block->ready = 0;
|
block->ready = 0;
|
block->filename = NULL;
|
block->filename = NULL;
|
block->linux_boot = 0;
|
block->linux_boot = 0;
|
return block;
|
return block;
|
}
|
}
|
|
|
|
|
void parse_tftp_packet(char * buf, packet_t* rx_packet, int tftp_len, unsigned int udp_src_port, unsigned int udp_dst_port)
|
void parse_tftp_packet(char * buf, packet_t* rx_packet, int tftp_len, unsigned int udp_src_port, unsigned int udp_dst_port)
|
{
|
{
|
int mode_offset;
|
int mode_offset;
|
int binary_mode;
|
int binary_mode;
|
|
|
unsigned int opcode = buf[8]<<8|buf[9];
|
unsigned int opcode = buf[8]<<8|buf[9];
|
unsigned int block = buf[10]<<8|buf[11];
|
unsigned int block = buf[10]<<8|buf[11];
|
|
|
mode_offset = next_string(&buf[10]);
|
mode_offset = next_string(&buf[10]);
|
binary_mode = strcmp("octet", &buf[10+mode_offset]);
|
binary_mode = strcmp("octet", &buf[10+mode_offset]);
|
|
|
switch (opcode) {
|
switch (opcode) {
|
|
|
case UDP_READ:
|
case UDP_READ:
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ERROR);
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ERROR);
|
break;
|
break;
|
|
|
case UDP_WRITE:
|
case UDP_WRITE:
|
udp_file_g = init_buffer_512();
|
udp_file_g = init_buffer_512();
|
udp_file_g->filename = malloc(256);
|
udp_file_g->filename = malloc(256);
|
strcpy(udp_file_g->filename, &buf[10]);
|
strcpy(udp_file_g->filename, &buf[10]);
|
|
|
if (strncmp(&buf[10], "vmlinux", 7) == 0)
|
if (strncmp(&buf[10], "vmlinux", 7) == 0)
|
udp_file_g->linux_boot = 1;
|
udp_file_g->linux_boot = 1;
|
|
|
udp_current_block_g = udp_file_g;
|
udp_current_block_g = udp_file_g;
|
|
|
if (binary_mode)
|
if (binary_mode)
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ACK);
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ACK);
|
else
|
else
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ERROR);
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, 0, UDP_ERROR);
|
break;
|
break;
|
|
|
|
|
case UDP_DATA:
|
case UDP_DATA:
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, block, UDP_ACK);
|
udp_reply(rx_packet, udp_dst_port, udp_src_port, block, UDP_ACK);
|
|
|
if (block > udp_file_g->last_block) {
|
if (block > udp_file_g->last_block) {
|
// Have not already received this block
|
// Have not already received this block
|
udp_file_g->last_block = block;
|
udp_file_g->last_block = block;
|
|
|
/* receive and save a block */
|
/* receive and save a block */
|
udp_current_block_g->bytes = tftp_len;
|
udp_current_block_g->bytes = tftp_len;
|
udp_file_g->total_bytes += tftp_len;
|
udp_file_g->total_bytes += tftp_len;
|
udp_file_g->total_blocks++;
|
udp_file_g->total_blocks++;
|
|
|
memcpy(udp_current_block_g->buf512, &buf[12], tftp_len);
|
memcpy(udp_current_block_g->buf512, &buf[12], tftp_len);
|
|
|
/* Prepare the next block */
|
/* Prepare the next block */
|
if (tftp_len == 512) {
|
if (tftp_len == 512) {
|
udp_current_block_g->next = init_buffer_512();
|
udp_current_block_g->next = init_buffer_512();
|
udp_current_block_g = udp_current_block_g->next;
|
udp_current_block_g = udp_current_block_g->next;
|
}
|
}
|
else { /* Last block */
|
else { /* Last block */
|
udp_file_g->ready = 1;
|
udp_file_g->ready = 1;
|
}
|
}
|
}
|
}
|
break;
|
break;
|
|
|
|
|
default: break;
|
default: break;
|
}
|
}
|
}
|
}
|
|
|
|
|
|
|
void init_tftp()
|
void init_tftp()
|
{
|
{
|
reboot_timer_g = new_timer();
|
reboot_timer_g = new_timer();
|
reboot_stage_g = 0;
|
reboot_stage_g = 0;
|
}
|
}
|
|
|
|
|
void process_tftp ()
|
void process_tftp ()
|
{
|
{
|
socket_t* socket;
|
socket_t* socket;
|
|
|
/* Check for newly downloaded tftp file. Add to all tx buffers */
|
/* Check for newly downloaded tftp file. Add to all tx buffers */
|
/* Has a file been uploaded via tftp ? */
|
/* Has a file been uploaded via tftp ? */
|
if (udp_file_g != NULL) {
|
if (udp_file_g != NULL) {
|
/* Notify telnet clients that file has been received */
|
/* Notify telnet clients that file has been received */
|
if (udp_file_g->ready) {
|
if (udp_file_g->ready) {
|
udp_file_g->ready = 0;
|
udp_file_g->ready = 0;
|
|
|
print_serial("Received file %s, %d bytes",
|
print_serial("Received file %s, %d bytes",
|
udp_file_g->filename, udp_file_g->total_bytes);
|
udp_file_g->filename, udp_file_g->total_bytes);
|
if (udp_file_g->linux_boot)
|
if (udp_file_g->linux_boot)
|
print_serial(", linux image detected\r\n");
|
print_serial(", linux image detected\r\n");
|
else
|
else
|
print_serial("\r\n");
|
print_serial("\r\n");
|
|
|
if (process_file() == 0) {
|
if (process_file() == 0) {
|
/* Disconnect in 1 second */
|
/* Disconnect in 1 second */
|
set_timer(reboot_timer_g, 1000);
|
set_timer(reboot_timer_g, 1000);
|
}
|
}
|
else
|
else
|
print_serial("Not an elf file\r\n");
|
print_serial("Not an elf file\r\n");
|
}
|
}
|
}
|
}
|
|
|
/* reboot timer expired */
|
/* reboot timer expired */
|
if (timer_expired(reboot_timer_g)) {
|
if (timer_expired(reboot_timer_g)) {
|
/* First stage of reboot sequence is to nicely disconnect */
|
/* First stage of reboot sequence is to nicely disconnect */
|
if (reboot_stage_g == 0) {
|
if (reboot_stage_g == 0) {
|
set_timer(reboot_timer_g, 1000);
|
set_timer(reboot_timer_g, 1000);
|
reboot_stage_g = 1;
|
reboot_stage_g = 1;
|
socket = first_socket_g;
|
socket = first_socket_g;
|
|
if (socket != NULL){
|
for(;;){
|
for(;;){
|
socket->tcp_disconnect = 1;
|
socket->tcp_disconnect = 1;
|
if (socket->next!=NULL)
|
if (socket->next!=NULL)
|
socket=socket->next;
|
socket=socket->next;
|
else
|
else
|
break;
|
break;
|
}
|
}
|
|
}
|
}
|
}
|
else {
|
else {
|
/* Second stage of reboot sequence is to turn off ethmac and then jump to restart vector */
|
/* Second stage of reboot sequence is to turn off ethmac and then jump to restart vector */
|
close_link();
|
close_link();
|
reboot();
|
reboot();
|
}
|
}
|
}
|
}
|
}
|
}
|
|
|
|
|
|
|
/* copy tftp file into a single contiguous buffer so
|
/* copy tftp file into a single contiguous buffer so
|
if can be processed by elf splitter */
|
if can be processed by elf splitter */
|
int process_file()
|
int process_file()
|
{
|
{
|
block_t* block;
|
block_t* block;
|
char* buf512;
|
char* buf512;
|
char* tftp_file;
|
char* tftp_file;
|
char* line;
|
char* line;
|
int line_len;
|
int line_len;
|
int ret;
|
int ret;
|
|
|
tftp_file = malloc(udp_file_g->total_bytes);
|
tftp_file = malloc(udp_file_g->total_bytes);
|
|
|
block = udp_file_g;
|
block = udp_file_g;
|
buf512= tftp_file;
|
buf512= tftp_file;
|
|
|
while (block->next) {
|
while (block->next) {
|
memcpy(buf512, block->buf512, block->bytes);
|
memcpy(buf512, block->buf512, block->bytes);
|
buf512=&buf512[512];
|
buf512=&buf512[512];
|
block=block->next;
|
block=block->next;
|
}
|
}
|
memcpy(buf512, block->buf512, block->bytes);
|
memcpy(buf512, block->buf512, block->bytes);
|
buf512=&buf512[512];
|
buf512=&buf512[512];
|
|
|
return elfsplitter(tftp_file);
|
return elfsplitter(tftp_file);
|
}
|
}
|
|
|
|
|
/* Disable interrupts
|
/* Disable interrupts
|
Load new values into the interrupt vector memory space
|
Load new values into the interrupt vector memory space
|
Jump to address 0
|
Jump to address 0
|
*/
|
*/
|
void reboot()
|
void reboot()
|
{
|
{
|
int i;
|
int i;
|
|
|
/* Disable all interrupts */
|
/* Disable all interrupts */
|
/* Disable ethmac_int interrupt */
|
/* Disable ethmac_int interrupt */
|
/* Disable timer 0 interrupt in interrupt controller */
|
/* Disable timer 0 interrupt in interrupt controller */
|
*(unsigned int *) ( ADR_AMBER_IC_IRQ0_ENABLECLR ) = 0x120;
|
*(unsigned int *) ( ADR_AMBER_IC_IRQ0_ENABLECLR ) = 0x120;
|
|
|
for(i=0;i<MEM_BUF_ENTRIES;i++)
|
for(i=0;i<MEM_BUF_ENTRIES;i++)
|
if (elf_mem0_g->entry[i].valid)
|
if (elf_mem0_g->entry[i].valid)
|
*(char *)(i) = elf_mem0_g->entry[i].data;
|
*(char *)(i) = elf_mem0_g->entry[i].data;
|
|
|
if (udp_file_g->linux_boot) {
|
if (udp_file_g->linux_boot) {
|
print_serial("linux reboot\n\r");
|
print_serial("linux reboot\n\r");
|
_jump_to_program(LINUX_JUMP_ADR);
|
_jump_to_program(LINUX_JUMP_ADR);
|
}
|
}
|
else {
|
else {
|
print_serial("normal reboot\n\r");
|
print_serial("normal reboot\n\r");
|
_restart();
|
_restart();
|
}
|
}
|
}
|
}
|
|
|
