138 lines
3.9 KiB
C
138 lines
3.9 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2022 Aidan MacDonald
|
|
*
|
|
* 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include "boot-x1000.h"
|
|
#include "system.h"
|
|
#include <string.h>
|
|
|
|
#define HDR_BEGIN 128 /* header must begin within this many bytes */
|
|
#define HDR_LEN 256 /* header length cannot exceed this */
|
|
|
|
/* search for header value, label must be a 4-character string.
|
|
* Returns the found value or 0 if the label wasn't found. */
|
|
static uint32_t search_header(const unsigned char* source, size_t length,
|
|
const char* label)
|
|
{
|
|
size_t search_len = MIN(length, HDR_BEGIN);
|
|
if(search_len < 8)
|
|
return 0;
|
|
search_len -= 7;
|
|
|
|
/* find the beginning marker */
|
|
size_t i;
|
|
for(i = 8; i < search_len; i += 4)
|
|
if(!memcmp(&source[i], "BEGINHDR", 8))
|
|
break;
|
|
if(i >= search_len)
|
|
return 0;
|
|
i += 8;
|
|
|
|
/* search within the header */
|
|
search_len = MIN(length, i + HDR_LEN) - 7;
|
|
for(; i < search_len; i += 8) {
|
|
if(!memcmp(&source[i], "ENDH", 4)) {
|
|
break;
|
|
} else if(!memcmp(&source[i], label, 4)) {
|
|
i += 4;
|
|
/* read little-endian value */
|
|
uint32_t ret = source[i];
|
|
ret |= source[i+1] << 8;
|
|
ret |= source[i+2] << 16;
|
|
ret |= source[i+3] << 24;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void iram_memmove(void* dest, const void* source, size_t length)
|
|
__attribute__((section(".icode")));
|
|
|
|
static void iram_memmove(void* dest, const void* source, size_t length)
|
|
{
|
|
unsigned char* d = dest;
|
|
const unsigned char* s = source;
|
|
|
|
if(s < d && d < s + length) {
|
|
d += length;
|
|
s += length;
|
|
while(length--)
|
|
*--d = *--s;
|
|
} else {
|
|
while(length--)
|
|
*d++ = *s++;
|
|
}
|
|
}
|
|
|
|
void x1000_boot_rockbox(const void* source, size_t length)
|
|
{
|
|
uint32_t load_addr = search_header(source, length, "LOAD");
|
|
if(!load_addr)
|
|
load_addr = X1000_STANDARD_DRAM_BASE;
|
|
|
|
disable_irq();
|
|
|
|
/* --- Beyond this point, do not call into DRAM --- */
|
|
|
|
iram_memmove((void*)load_addr, source, length);
|
|
commit_discard_idcache();
|
|
|
|
typedef void(*entry_fn)(void);
|
|
entry_fn fn = (entry_fn)load_addr;
|
|
fn();
|
|
while(1);
|
|
}
|
|
|
|
void x1000_boot_linux(const void* source, size_t length,
|
|
void* load, void* entry, const char* args)
|
|
{
|
|
size_t args_len = strlen(args);
|
|
|
|
disable_irq();
|
|
|
|
/* --- Beyond this point, do not call into DRAM --- */
|
|
|
|
void* safe_mem = (void*)X1000_IRAM_END;
|
|
|
|
/* copy argument string to a safe location */
|
|
char* args_copy = safe_mem + 32;
|
|
iram_memmove(args_copy, args, args_len);
|
|
|
|
/* generate argv array */
|
|
char** argv = safe_mem;
|
|
argv[0] = NULL;
|
|
argv[1] = args_copy;
|
|
|
|
iram_memmove(load, source, length);
|
|
commit_discard_idcache();
|
|
|
|
typedef void(*entry_fn)(long, char**, long, long);
|
|
entry_fn fn = (entry_fn)entry;
|
|
fn(2, argv, 0, 0);
|
|
while(1);
|
|
}
|
|
|
|
void rolo_restart(const unsigned char* source, unsigned char* dest, int length)
|
|
{
|
|
(void)dest;
|
|
x1000_boot_rockbox(source, length);
|
|
}
|