49 lines
1.1 KiB
C
49 lines
1.1 KiB
C
|
/*
|
||
|
|
* loader/loader.c
|
||
|
|
*
|
||
|
|
* Copyright (C) 2006 Erik Gilling, all rights reserved
|
||
|
|
*
|
||
|
|
* 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, version 2.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "at91.h"
|
||
|
|
|
||
|
|
// SAM-BA apears to write the following data to 0x201400
|
||
|
|
//
|
||
|
|
// 0x00: data0
|
||
|
|
// 0x01: data1
|
||
|
|
// ...
|
||
|
|
// PAGE_SIZE-1: last data byte
|
||
|
|
// PAGE_SIZE : page number to write
|
||
|
|
|
||
|
|
|
||
|
|
#define SAMBA_PAGE_BUFF ((uint32_t *) 0x201400)
|
||
|
|
|
||
|
|
int main( void )
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
uint32_t *page_buff = SAMBA_PAGE_BUFF;
|
||
|
|
// keep this in units of 32 bit words
|
||
|
|
int page_num = *(page_buff+PAGE_SIZE/4);
|
||
|
|
int page_offset = page_num * PAGE_SIZE/4;
|
||
|
|
|
||
|
|
// wait for mc to be ready
|
||
|
|
while( !(mc.fsr & AT91_MC_FMR_FRDY) ) { }
|
||
|
|
|
||
|
|
// write samba page buffer to flash buffer
|
||
|
|
for( i=0 ; i < (PAGE_SIZE/4) ; i++ ) {
|
||
|
|
AT91_FLASH_ADDR[ page_offset + i ] = page_buff[i];
|
||
|
|
}
|
||
|
|
|
||
|
|
// write page
|
||
|
|
mc.fcr = AT91_MC_FCR_FCMD_WP | AT91_MC_FCR_PAGEN(page_num) |
|
||
|
|
AT91_MC_FCR_KEY;
|
||
|
|
|
||
|
|
// dont wait for mc to be ready here so that flash ops can stack
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|