2005-07-06 19:00:18 +02:00
|
|
|
#define ASSEMBLY 1
|
|
|
|
#define ASM_CONSOLE_LOGLEVEL 8
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <device/pci_def.h>
|
|
|
|
#include <arch/io.h>
|
|
|
|
#include <device/pnp_def.h>
|
|
|
|
#include <arch/romcc_io.h>
|
|
|
|
#include <arch/hlt.h>
|
|
|
|
#include "pc80/mc146818rtc_early.c"
|
|
|
|
#include "pc80/serial.c"
|
|
|
|
#include "arch/i386/lib/console.c"
|
|
|
|
#include "ram/ramtest.c"
|
|
|
|
#include "cpu/x86/bist.h"
|
2005-07-06 19:16:11 +02:00
|
|
|
//#include "lib/delay.c"
|
2005-07-06 19:00:18 +02:00
|
|
|
#include "cpu/amd/sc520/raminit.c"
|
|
|
|
|
2005-07-06 19:17:41 +02:00
|
|
|
typedef void (*lj)(void);
|
|
|
|
|
|
|
|
|
|
|
|
|
2005-07-06 19:03:01 +02:00
|
|
|
struct mem_controller {
|
|
|
|
int i;
|
|
|
|
};
|
2005-07-06 19:00:18 +02:00
|
|
|
|
|
|
|
static void hard_reset(void)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
static void memreset_setup(void)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
static void memreset(int controllers, const struct mem_controller *ctrl)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static inline void activate_spd_rom(const struct mem_controller *ctrl)
|
|
|
|
{
|
|
|
|
/* nothing to do */
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int spd_read_byte(unsigned device, unsigned address)
|
|
|
|
{
|
2005-07-06 19:03:01 +02:00
|
|
|
// return smbus_read_byte(device, address);
|
2005-07-06 19:00:18 +02:00
|
|
|
}
|
|
|
|
|
2005-07-06 19:03:01 +02:00
|
|
|
//#include "sdram/generic_sdram.c"
|
2005-07-06 19:00:18 +02:00
|
|
|
|
2005-07-06 19:17:41 +02:00
|
|
|
static inline void dumpmem(void){
|
|
|
|
int i, j;
|
|
|
|
unsigned char *l;
|
|
|
|
unsigned char c;
|
|
|
|
|
|
|
|
for(i = 0x4000; i < 0x5000; i += 16) {
|
|
|
|
print_err_hex32(i); print_err(":");
|
|
|
|
for(j = 0; j < 16; j++) {
|
|
|
|
l = (unsigned char *)i + j;
|
|
|
|
c = *l;
|
|
|
|
print_err_hex8(c);
|
|
|
|
print_err(" ");
|
|
|
|
}
|
|
|
|
print_err("\r\n");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-09-12 15:40:10 +02:00
|
|
|
|
|
|
|
static inline void irqinit(void){
|
|
|
|
volatile unsigned char *cp;
|
|
|
|
#if 0
|
|
|
|
/* these values taken from the msm board itself.
|
|
|
|
* and they cause the board to not even come out of calibrating_delay_loop
|
|
|
|
* if you can believe it. Our problem right now is no IDE or serial interrupts
|
|
|
|
* So we'll try to put interrupts in, one at a time. IDE first.
|
|
|
|
*/
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd00;
|
|
|
|
*cp = 0x11;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd02;
|
|
|
|
*cp = 0x02;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd03;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd04;
|
|
|
|
*cp = 0xf7;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd08;
|
|
|
|
*cp = 0xf7;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd0a;
|
|
|
|
*cp = 0x8b;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd10;
|
|
|
|
*cp = 0x18;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd14;
|
|
|
|
*cp = 0x09;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd18;
|
|
|
|
*cp = 0x88;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd1a;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd1b;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd1c;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd20;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd21;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd22;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd28;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd29;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd30;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd31;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd32;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd33;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd40;
|
|
|
|
*cp = 0x10;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd41;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd42;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd43;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd44;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd45;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd46;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd50;
|
|
|
|
*cp = 0x37;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd51;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd52;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd53;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd54;
|
|
|
|
*cp = 0x37;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd55;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd56;
|
|
|
|
*cp = 0x37;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd57;
|
|
|
|
*cp = 0x00;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd58;
|
|
|
|
*cp = 0xff;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd59;
|
|
|
|
*cp = 0xff;
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd5a;
|
|
|
|
*cp = 0xff;
|
|
|
|
#endif
|
|
|
|
#if 0
|
|
|
|
/* this fails too */
|
|
|
|
/* IDE only ... */
|
|
|
|
cp = (volatile unsigned char *) 0xfffefd56;
|
|
|
|
*cp = 0xe;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2005-07-06 19:00:18 +02:00
|
|
|
static void main(unsigned long bist)
|
|
|
|
{
|
2005-07-06 19:16:23 +02:00
|
|
|
volatile int i;
|
|
|
|
for(i = 0; i < 100; i++)
|
|
|
|
;
|
|
|
|
|
2005-07-06 19:00:18 +02:00
|
|
|
|
2005-07-06 19:16:11 +02:00
|
|
|
setupsc520();
|
2005-09-12 15:40:10 +02:00
|
|
|
irqinit();
|
2005-07-06 19:00:18 +02:00
|
|
|
uart_init();
|
|
|
|
console_init();
|
2005-07-06 19:16:23 +02:00
|
|
|
for(i = 0; i < 100; i++)
|
|
|
|
print_err("fill usart\r\n");
|
|
|
|
// while(1)
|
2005-07-06 19:16:13 +02:00
|
|
|
print_err("HI THERE!\r\n");
|
2005-07-06 19:16:23 +02:00
|
|
|
// sizemem();
|
|
|
|
staticmem();
|
2005-07-06 19:17:41 +02:00
|
|
|
print_err("c60 is "); print_err_hex16(*(unsigned short *)0xfffefc60);
|
|
|
|
print_err("\n");
|
2005-07-06 19:16:21 +02:00
|
|
|
|
2005-07-06 19:16:23 +02:00
|
|
|
// while(1)
|
2005-07-06 19:16:15 +02:00
|
|
|
print_err("STATIC MEM DONE\r\n");
|
2005-07-06 19:16:23 +02:00
|
|
|
outb(0xee, 0x80);
|
|
|
|
print_err("loop forever ...\n");
|
|
|
|
|
2005-07-06 19:16:13 +02:00
|
|
|
|
2005-07-06 19:00:18 +02:00
|
|
|
#if 0
|
2005-07-06 19:17:41 +02:00
|
|
|
|
|
|
|
/* clear memory 1meg */
|
2005-07-06 19:00:18 +02:00
|
|
|
__asm__ volatile(
|
2005-07-06 19:17:41 +02:00
|
|
|
"1: \n\t"
|
|
|
|
"movl %0, %%fs:(%1)\n\t"
|
|
|
|
"addl $4,%1\n\t"
|
|
|
|
"subl $4,%2\n\t"
|
|
|
|
"jnz 1b\n\t"
|
|
|
|
:
|
|
|
|
: "a" (0), "D" (0), "c" (1024*1024)
|
|
|
|
);
|
|
|
|
|
2005-07-06 19:00:18 +02:00
|
|
|
|
|
|
|
#endif
|
2005-07-06 19:17:41 +02:00
|
|
|
|
2005-07-06 19:00:18 +02:00
|
|
|
#if 0
|
|
|
|
dump_pci_devices();
|
|
|
|
#endif
|
|
|
|
#if 0
|
|
|
|
dump_pci_device(PCI_DEV(0, 0, 0));
|
|
|
|
#endif
|
2005-07-06 19:17:41 +02:00
|
|
|
|
2005-07-06 19:16:23 +02:00
|
|
|
#if 0
|
2005-07-06 19:16:15 +02:00
|
|
|
print_err("RAM CHECK!\r\n");
|
2005-07-06 19:00:18 +02:00
|
|
|
// Check 16MB of memory @ 0
|
|
|
|
ram_check(0x00000000, 0x01000000);
|
|
|
|
#endif
|
2005-07-06 19:17:41 +02:00
|
|
|
#if 0
|
|
|
|
print_err("RAM CHECK for 32 MB!\r\n");
|
|
|
|
// Check 32MB of memory @ 0
|
|
|
|
ram_check(0x00000000, 0x02000000);
|
|
|
|
#endif
|
2005-09-12 15:40:10 +02:00
|
|
|
#if 1
|
2005-07-06 19:17:41 +02:00
|
|
|
{
|
2005-09-12 15:40:10 +02:00
|
|
|
volatile unsigned char *src = (unsigned char *) 0x2000000 + 0x60000;
|
2005-07-06 19:17:41 +02:00
|
|
|
volatile unsigned char *dst = (unsigned char *) 0x4000;
|
2005-09-12 15:40:10 +02:00
|
|
|
for(i = 0; i < 0x20000; i++) {
|
2005-07-06 19:17:41 +02:00
|
|
|
/*
|
|
|
|
print_err("Set dst "); print_err_hex32((unsigned long) dst);
|
|
|
|
print_err(" to "); print_err_hex32(*src); print_err("\r\n");
|
|
|
|
*/
|
|
|
|
*dst = *src;
|
|
|
|
//print_err(" dst is now "); print_err_hex32(*dst); print_err("\r\n");
|
|
|
|
dst++, src++;
|
|
|
|
outb((unsigned char)i, 0x80);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
dumpmem();
|
|
|
|
outb(0, 0x80);
|
|
|
|
print_err("loop forever\r\n");
|
|
|
|
outb(0xdd, 0x80);
|
|
|
|
__asm__ volatile(
|
|
|
|
"movl %0, %%edi\n\t"
|
|
|
|
"jmp *%%edi\n\t"
|
|
|
|
:
|
|
|
|
: "a" (0x4000)
|
|
|
|
);
|
|
|
|
|
|
|
|
print_err("FUCK\r\n");
|
|
|
|
|
|
|
|
while(1);
|
2005-07-06 19:16:23 +02:00
|
|
|
#endif
|
2005-07-06 19:00:18 +02:00
|
|
|
}
|
2005-07-06 19:17:41 +02:00
|
|
|
|