nes-proj/platform/esb/loader/loader-arch.c

209 lines
5.8 KiB
C

/*
* Copyright (c) 2005, Swedish Institute of Computer Science
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of the Institute nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* This file is part of the Contiki operating system.
*
* @(#)$Id: loader-arch.c,v 1.1 2006/06/21 13:39:11 nifi Exp $
*/
#include "contiki-esb.h"
#include "loader-arch.h"
#include "dev/eeprom.h"
#include "dev/flash.h"
void *loader_arch_codeaddr, *loader_arch_dataaddr;
#define FLASHADDR ((char *)0x8000)
#define DATAADDR ((char *)0x900)
#define READSIZE 0x10
/*----------------------------------------------------------------------------------*/
void
loader_arch_load(unsigned short startaddr)
{
unsigned short tmp;
unsigned short codelen, datalen, sumlen;
int i, j;
unsigned short ptr;
unsigned short *flashptr;
void (* init)(void *);
unsigned char tmpdata[READSIZE];
unsigned char sum;
/* Read the magic word and version number from the first four bytes
in EEPROM. */
eeprom_read(startaddr, (char *)&tmp, 2);
if(tmp != HTONS(LOADER_ARCH_MAGIC)) {
beep_beep(60000);
return;
}
eeprom_read(startaddr + 2, (char *)&tmp, 2);
if(tmp != HTONS(LOADER_ARCH_VERSION)) {
return;
}
startaddr += 4;
/* Read the total lenghth that the checksum covers. */
eeprom_read(startaddr, (char *)&sumlen, 2);
sumlen = htons(sumlen);
sum = 0;
for(i = 0; sumlen - i > READSIZE; i += READSIZE) {
eeprom_read(startaddr + 2 + i, tmpdata, READSIZE);
for(j = 0; j < READSIZE; ++j) {
sum += tmpdata[j];
if(sum < tmpdata[j]) {
++sum;
}
}
}
if(sumlen - i > 0) {
eeprom_read(startaddr + 2 + i, tmpdata, READSIZE);
for(j = 0; j < sumlen - i; ++j) {
sum += tmpdata[j];
if(sum < tmpdata[j]) {
++sum;
}
}
}
/* If the checksum was wrong, we beep. The number of beeps indicate
the numerival value of the calculated checksum. */
if(sum != 0xff) {
leds_red(LEDS_ON);
for(i = 0; i < (sum >> 4); ++i) {
beep_beep(200);
for(j = 0; j < 2; ++j) {
clock_delay(60000);
}
}
for(j = 0; j < 8; ++j) {
clock_delay(60000);
}
for(i = 0; i < (sum & 0x0f); ++i) {
beep_beep(200);
for(j = 0; j < 2; ++j) {
clock_delay(60000);
}
}
leds_red(LEDS_OFF);
return;
} else {
leds_green(LEDS_ON);
for(i = 0; i < 4; ++i) {
beep_beep(200);
for(j = 0; j < 2; ++j) {
clock_delay(60000);
}
}
leds_green(LEDS_OFF);
}
leds_yellow(LEDS_ON);
startaddr += 2;
/* Read the size of the code segment from the next two bytes in EEPROM. */
eeprom_read(startaddr, (char *)&codelen, 2);
/* Convert from network byte order to host byte order. */
codelen = htons(codelen);
/* Flash program code into ROM. We use the available space in the
program's data memory to temporarily store the code before
flashing it into ROM. */
flash_setup();
flashptr = (unsigned short *)FLASHADDR;
for(ptr = startaddr + 2; ptr < startaddr + 2 + codelen; ptr += READSIZE) {
/* Read data from EEPROM into RAM. */
eeprom_read(ptr, DATAADDR, READSIZE);
/* Clear flash page on 512 byte boundary. */
if((((unsigned short)flashptr) & 0x01ff) == 0) {
flash_clear(flashptr);
}
/* Burn data from RAM into flash ROM. Flash is burned one 16-bit
word at a time, so we need to be careful when incrementing
pointers. The flashptr is already a short pointer, so
incrementing it by one will actually increment the address by
two. */
for(i = 0; i < READSIZE / 2; ++i) {
flash_write(flashptr, ((unsigned short *)DATAADDR)[i]);
++flashptr;
}
}
flash_done();
leds_yellow(LEDS_OFF);
leds_green(LEDS_ON);
/* Read the size of the code segment from the first two bytes in EEPROM. */
eeprom_read(startaddr + 2 + codelen, (char *)&datalen, 2);
/* Convert from network byte order to host byte order. */
datalen = htons(datalen);
if(datalen > 0) {
/* Read the contents of the data memory into RAM. */
eeprom_read(startaddr + 2 + codelen + 2, DATAADDR, datalen);
}
for(i = 0; i < 4; ++i) {
beep_beep(2000);
clock_delay(20000);
}
leds_green(LEDS_OFF);
/* Execute the loaded program. */
init = ((void (*)(void *))FLASHADDR);
init((void *)0);
}
/*----------------------------------------------------------------------------------*/
void
loader_arch_free(void *code, void *data)
{
}
/*----------------------------------------------------------------------------------*/