288 lines
6.3 KiB
C
288 lines
6.3 KiB
C
/*
|
||
* BaS
|
||
*
|
||
*/
|
||
|
||
|
||
#include "MCF5475.h"
|
||
#include "startcf.h"
|
||
|
||
extern unsigned long far __SP_AFTER_RESET[];
|
||
extern unsigned long far __Bas_base[];
|
||
|
||
/* imported routines */
|
||
extern int mmu_init();
|
||
extern int mmutr_miss();
|
||
extern int vec_init();
|
||
extern int illegal_table_make();
|
||
extern int cf68k_initialize();
|
||
|
||
/********************************************************************/
|
||
/* warte_routinen /*
|
||
********************************************************************/
|
||
|
||
void warte_10ms(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_10ms:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #1320000,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
|
||
void warte_1ms(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_1ms:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #132000,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
|
||
void warte_100us(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_100us:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #13200,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
|
||
void warte_50us(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_50us:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #6600,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
void warte_10us(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_10us:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #1320,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
|
||
void warte_1us(void)
|
||
{
|
||
asm
|
||
{
|
||
warte_1us:
|
||
move.l d0,-(sp)
|
||
move.l MCF_SLT0_SCNT,d0
|
||
sub.l #132,d0
|
||
warte_d6:
|
||
cmp.l MCF_SLT0_SCNT,d0
|
||
bcs warte_d6
|
||
move.l (sp)+,d0
|
||
}
|
||
}
|
||
|
||
/********************************************************************/
|
||
void BaS(void)
|
||
{
|
||
int az_sectors;
|
||
int sd_status,i;
|
||
|
||
az_sectors = sd_card_init();
|
||
|
||
if(az_sectors>0)
|
||
{
|
||
sd_card_idle();
|
||
}
|
||
|
||
asm
|
||
{
|
||
move.b DIP_SWITCH,d0 // dip schalter adresse
|
||
btst.b #6,d0
|
||
beq firetos_kopieren
|
||
lea MCF_PSC0_PSCTB_8BIT,a6
|
||
lea MCF_PSC3_PSCTB_8BIT,a3
|
||
lea MCF_PSC3_PSCRB_8BIT,a4
|
||
lea MCF_PSC3_PSCRFCNT,a5
|
||
move.l #'ACPF',(a3) // SEND SYNC MARKE, MCF BEREIT
|
||
bsr warte_10ms
|
||
move.l #'PIC ',(a6)
|
||
move.b (a4),d0
|
||
move.b d0,(a6)
|
||
move.b (a4),d1
|
||
move.b d1,(a6)
|
||
move.b (a4),d2
|
||
move.b d2,(a6)
|
||
move.l #0x0a0d,(a6)
|
||
move.b #0x01,(a3) // RTC DATEN ANFORDERN
|
||
// TOS kopieren
|
||
lea 0x00e00000,a0
|
||
lea 0xe0600000,a1 // default tos
|
||
lea 0xe0700000,a2 // 1MB
|
||
move.b DIP_SWITCH,d0 // dip schalter adresse
|
||
btst.b #6,d0
|
||
bne cptos_loop
|
||
firetos_kopieren:
|
||
lea 0x00e00000,a0
|
||
lea 0xe0400000,a1
|
||
lea 0xe0500000,a2 // 1MB
|
||
cptos_loop:
|
||
move.l (a1)+,(a0)+
|
||
cmp.l a2,a1
|
||
blt cptos_loop
|
||
/***************************************************************/
|
||
/* div inits
|
||
/***************************************************************/
|
||
div_inits:
|
||
move.b DIP_SWITCH,d0 // dip schalter adresse
|
||
btst.b #6,d0
|
||
beq video_setup
|
||
// rtc daten, mmu set, etc nur wenn switch 6 = off
|
||
lea 0xffff8961,a0
|
||
clr.l d1
|
||
moveq #64,d2
|
||
move.b (a4),d0
|
||
cmp.b #0x81,d0
|
||
bne not_rtc
|
||
loop_sr:
|
||
move.b (a4),d0
|
||
move.b d1,(a0)
|
||
move.b d0,2(a0)
|
||
addq.l #1,d1
|
||
cmp.b d1,d2
|
||
bne loop_sr
|
||
|
||
move.b #63,(a0)
|
||
move.b 2(a0),d0
|
||
add #1,d0
|
||
move.b d0,2(a0)
|
||
not_rtc:
|
||
bsr mmu_init
|
||
bsr vec_init
|
||
bsr illegal_table_make
|
||
|
||
// interrupts
|
||
clr.l 0xf0010004 // disable all interrupts
|
||
lea MCF_EPORT_EPPAR,a0
|
||
move.w #0xaaa8,(a0) // falling edge all,
|
||
|
||
// timer 0 on mit int -> video change -------------------------------------------
|
||
move.l #MCF_GPT_GMS_ICT(1)|MCF_GPT_GMS_IEN|MCF_GPT_GMS_TMS(1),d0 //caputre mit int on rising edge
|
||
move.l d0,MCF_GPT0_GMS
|
||
moveq.l #0x3f,d0 // max prority interrutp
|
||
move.b d0,MCF_INTC_ICR62 // setzen
|
||
// -------------------------------------------------
|
||
move.b #0xfe,d0
|
||
move.b d0,0xf0010004 // enable int 1-7
|
||
nop
|
||
lea MCF_EPORT_EPIER,a0
|
||
move.b #0xfe,(a0) // int 1-7 on
|
||
nop
|
||
lea MCF_EPORT_EPFR,a0
|
||
move.b #0xff,(a0) // alle pending interrupts l<>schen
|
||
nop
|
||
lea MCF_INTC_IMRL,a0
|
||
move.l #0xFFFFFF00,(a0) // int 1-7 on
|
||
lea MCF_INTC_IMRH,a0
|
||
move.l #0xBFFFFFFE,(a0) // psc3 and timer 0 int on
|
||
|
||
move.l #MCF_MMU_MMUCR_EN,d0
|
||
move.l d0,MCF_MMU_MMUCR // mmu on
|
||
nop
|
||
nop
|
||
/********************************************************************/
|
||
/* IDE reset
|
||
/********************************************************************/
|
||
lea 0xffff8802,a0
|
||
move.b #14,-2(a0)
|
||
move.b #0x80,(a0)
|
||
bsr warte_1ms
|
||
clr.b (a0)
|
||
/********************************************************************/
|
||
/* video setup
|
||
/********************************************************************/
|
||
video_setup:
|
||
lea 0xf0000410,a0
|
||
// 25MHz
|
||
move.l #0x032002ba,(a0)+ // horizontal 640x480
|
||
move.l #0x020c020a,(a0)+ // vertikal 640x480
|
||
move.l #0x0190015d,(a0)+ // horizontal 320x240
|
||
move.l #0x020C020A,(a0)+ // vertikal 320x240 */
|
||
/*
|
||
// 32MHz
|
||
move.l #0x037002ba,(a0)+ // horizontal 640x480
|
||
move.l #0x020d020a,(a0)+ // vertikal 640x480
|
||
move.l #0x02A001e0,(a0)+ // horizontal 320x240
|
||
move.l #0x05a00160,(a0)+ // vertikal 320x240
|
||
*/
|
||
lea -0x20(a0),a0
|
||
move.l #0x01070002,(a0) // fifo on, refresh on, ddrcs und cke on, video dac on,
|
||
/********************************************************************/
|
||
/* memory setup
|
||
/********************************************************************/
|
||
lea 0x400,a0
|
||
lea 0x800,a1
|
||
mem_clr_loop:
|
||
clr.l (a0)+
|
||
clr.l (a0)+
|
||
clr.l (a0)+
|
||
clr.l (a0)+
|
||
cmp.l a0,a1
|
||
bgt mem_clr_loop
|
||
|
||
moveq #0x48,d0
|
||
move.b d0,0xffff8007
|
||
// stram
|
||
move.l #0xe00000,d0 // ende stram
|
||
move.l d0,0x42e
|
||
move.l #0x752019f3,d0 // memvalid
|
||
move.l d0,0x420
|
||
move.l #0x237698aa,d0 // memval2
|
||
move.l d0,0x43a
|
||
move.l #0x5555aaaa,d0 // memval3
|
||
move.l d0,0x51a
|
||
// ttram
|
||
move.l #__Bas_base,d0 // ende ttram
|
||
move.l d0,0x5a4
|
||
move.l #0x1357bd13,d0 // ramvalid
|
||
move.l d0,0x5a8
|
||
|
||
// test auf protect mode ---------------------
|
||
move.b DIP_SWITCH,d0
|
||
btst #7,d0
|
||
beq no_protect // nein->
|
||
move.w #0x0700,sr
|
||
no_protect:
|
||
jmp 0xe00030
|
||
|
||
}
|
||
}
|