EMILE/second/main.c

228 lines
5.8 KiB
C

/*
*
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
*
*/
#include <stdio.h>
#include <malloc.h>
#include <string.h>
#include "lowmem.h"
#include "bank.h"
#include "memory.h"
#include "uncompress.h"
#include "bootinfo.h"
#include "console.h"
#include "arch.h"
#include "misc.h"
#include "glue.h"
#include "load.h"
typedef void (*entry_t) (unsigned long , unsigned long , unsigned long );
typedef void (*disable_cache_t) (void);
extern void enter_kernel030(unsigned long addr, unsigned long size, unsigned long dest);
extern char end_enter_kernel030;
extern void MMU030_disable_cache(void);
extern void enter_kernel040(unsigned long addr, unsigned long size, unsigned long dest);
extern char end_enter_kernel040;
extern void MMU040_disable_cache(void);
#define PAGE_SHIFT 12
#define PAGE_SIZE (1UL << PAGE_SHIFT)
#define PAGE_MASK (~(PAGE_SIZE-1))
#define BI_ALLOC_SIZE (4096L) // Allocate 4K for bootinfo
#define KERNEL_ALIGN (256L * 1024L) // Kernel alignment, on 256K boundary
struct first_level_info {
unsigned long kernel_image_offset;
unsigned long kernel_image_size;
unsigned long kernel_size;
unsigned long ramdisk_offset;
unsigned long ramdisk_size;
char command_line[CL_SIZE];
};
int start(struct first_level_info* info)
{
char * kernel;
unsigned long physImage;
entry_t entry;
disable_cache_t disable_cache;
int ret;
unsigned long start_mem;
unsigned long aligned_size;
unsigned long aligned_addr;
unsigned long enter_kernel;
unsigned long end_enter_kernel;
unsigned long kernel_image_start;
unsigned long ramdisk_start;
int uncompressed_size;
printf("Early Macintosh Image LoadEr\n");
printf("EMILE v"VERSION" (c) 2004 Laurent Vivier\n");
printf("This is free software, redistribute it under GPL\n");
arch_init();
init_memory_map();
#ifdef BANK_DUMP
bank_dump();
#endif
/* load kernel */
printf("vmlinux %s\n", info->command_line);
printf("Loading kernel...\n");
kernel_image_start = (unsigned long)load_image(
(unsigned long)info->kernel_image_offset,
info->kernel_image_size);
printf("Kernel image loaded at 0x%lx\n", kernel_image_start);
printf("Kernel image size is %ld Bytes\n", info->kernel_image_size);
/* where is mapped my boot function ? */
if (mmu_type == gestalt68040MMU)
{
enter_kernel = (unsigned long)enter_kernel040;
end_enter_kernel = (unsigned long)&end_enter_kernel040;
disable_cache = MMU040_disable_cache;
}
else
{
enter_kernel = (unsigned long)enter_kernel030;
end_enter_kernel = (unsigned long)&end_enter_kernel030;
disable_cache = MMU030_disable_cache;
}
printf("Available Memory: %ld kB\n", bank_mem_avail() / 1024);
if (info->kernel_image_size != 0)
{
if (info->kernel_size == 0)
info->kernel_size = info->kernel_image_size * 3;
/* add KERNEL_ALIGN if we have to align
* and BI_ALLOC_SIZE for bootinfo
*/
printf("Allocating %ld bytes for kernel\n", info->kernel_size);
kernel = (char*)malloc(info->kernel_size + 4 + BI_ALLOC_SIZE +
end_enter_kernel - enter_kernel);
if (kernel == 0)
{
printf("cannot allocate %ld bytes\n", info->kernel_size);
while(1);
}
/* align kernel address to a 4 byte word */
kernel = (unsigned char*)(((unsigned long)kernel + 3) & 0xFFFFFFFC);
uncompressed_size = uncompress(kernel, (char*)kernel_image_start);
printf("\n");
if (check_full_in_bank((unsigned long)kernel, uncompressed_size))
error("Kernel between two banks, send a mail to LaurentVivier@wanadoo.fr for support\n");
/* copy enter_kernel at end of kernel */
memcpy((char*)kernel_image_start + uncompressed_size
+ BI_ALLOC_SIZE,
(char*)enter_kernel, end_enter_kernel - enter_kernel);
end_enter_kernel = kernel_image_start + uncompressed_size
+ BI_ALLOC_SIZE +
(end_enter_kernel - enter_kernel);
enter_kernel = kernel_image_start + + BI_ALLOC_SIZE
+ uncompressed_size;
}
else
{
error("Kernel is missing !!!!\n");
}
/* free kernel image */
free((void*)kernel_image_start);
/* load ramdisk if needed */
if (info->ramdisk_size != 0)
{
printf("Loading RAMDISK...\n");
ramdisk_start = (unsigned long)load_image(
(unsigned long)info->ramdisk_offset,
info->ramdisk_size);
printf("RAMDISK loaded at 0x%lx\n", ramdisk_start);
printf("RAMDISK size is %ld Bytes\n", info->ramdisk_size);
if (check_full_in_bank(ramdisk_start, info->ramdisk_size))
error("ramdisk between two banks, send a mail to LaurentVivier@wanadoo.fr for support\n");
}
else
{
ramdisk_start = 0;
printf("no RAMDISK\n");
}
ret = logical2physical((unsigned long)kernel, &physImage);
/* disable and flush cache */
disable_cache();
/* initialize bootinfo structure */
bootinfo_init(info->command_line,
(char*)ramdisk_start, info->ramdisk_size);
/* compute final address of kernel */
aligned_size = boot_info.memory[0].addr & (KERNEL_ALIGN - 1);
if ( aligned_size > 0 )
{
aligned_size = KERNEL_ALIGN - aligned_size;
aligned_addr = boot_info.memory[0].addr + aligned_size;
aligned_size = boot_info.memory[0].size - aligned_size;
boot_info.memory[0].addr = aligned_addr;
boot_info.memory[0].size = aligned_size;
}
/* set bootinfo at end of kernel image */
set_kernel_bootinfo(kernel + uncompressed_size);
/* disable interrupt */
asm("ori.w #0x0700,%sr");
ret = logical2physical(enter_kernel, (unsigned long*)&entry);
if ( (ret == 0) && (enter_kernel != (unsigned long)entry) )
{
unsigned long logi;
unsigned long size = end_enter_kernel - enter_kernel;
logi = console_get_video();
ret = logical2physical(logi, (unsigned long*)&entry);
memcpy((char*)logi, (char*)enter_kernel, size);
memcpy((char*)entry, (char*)enter_kernel, size);
}
start_mem = boot_info.memory[0].addr + PAGE_SIZE;
printf("\n");
printf("Physical address of kernel will be 0x%08lx\n", start_mem);
printf("Ok, booting the kernel.\n");
/* kick off */
entry(physImage, uncompressed_size + BI_ALLOC_SIZE, start_mem);
return 0;
}