Subject: Re: [PATCH] Fixup for Amigas with memory at 0x200000
To: None <port-amiga@netbsd.org>
From: Aymeric Vincent <Aymeric.Vincent@labri.fr>
List: port-amiga
Date: 01/08/2003 21:27:20
Hi!
is@netbsd.org (Ignatios Souvatzis) writes:
> This sounds good. The DraCo is guaranteed to have at least a 68040V CPU
> (thats a CMOS 68LC040), which uses the same ITTR + DTTR format and registers
> as the 68060. Actually, I'm using the same method to switch _off_
> the MMU at reboot time! Just use my code backwards ;-)
Great. Here is an updated patch which should handle the DraCo.
As far as the Draco and 68040 Amigas are concerned, I can just
guarantee that "it compiles".
[ the only change from the previous patch is the code in locore.s
which is #ifdef DRACO ]
> Make it so. I'll test on DraCo, and 68040 Amiga. (I don't really want to
> pull out the accellerator to test on 68030 Amiga, though).
I tested this patch with -current on my '030 A1200 with both a GENERIC
kernel and a stripped down kernel where M68040 and M68060 are
undefined.
Aymeric
Index: amiga/amiga_init.c
===================================================================
RCS file: /usr/local/cvsroot/src/sys/arch/amiga/amiga/amiga_init.c,v
retrieving revision 1.82
diff -u -r1.82 amiga_init.c
--- amiga/amiga_init.c 6 Jan 2003 13:04:56 -0000 1.82
+++ amiga/amiga_init.c 8 Jan 2003 18:01:19 -0000
@@ -117,6 +117,8 @@
int use_z2_mem = 1; /* XXX */
u_long boot_fphystart, boot_fphysize, boot_cphysize;
+static u_int start_c_fphystart;
+static u_int start_c_pstart;
static u_long boot_flags;
@@ -136,7 +138,7 @@
extern void kernel_reload(char *, u_long, u_long, u_long, u_long,
u_long, u_long, u_long, u_long, u_long, u_long);
extern void etext(void);
-void start_c_cleanup(void);
+void start_c_finish(void);
void *
chipmem_steal(long amount)
@@ -213,13 +215,9 @@
u_int Sysptmap_pa;
register st_entry_t sg_proto, *sg, *esg;
register pt_entry_t pg_proto, *pg;
- u_int tc, end_loaded, ncd, i;
+ u_int end_loaded, ncd, i;
struct boot_memlist *ml;
u_int loadbase = 0; /* XXXXXXXXXXXXXXXXXXXXXXXXXXXX */
- u_int *shadow_pt = 0; /* XXXXXXXXXXXXXXXXXXXXXXXXXXXX */
-#ifdef P5PPC68KBOARD
- struct cfdev *cdp, *ecdp;
-#endif
#ifdef DEBUG_KERNEL_START
/* XXX this only is valid if Altais is in slot 0 */
@@ -384,14 +382,6 @@
#endif
ptextra = NCHIPMEMPG + NCIAPG + NZTWOROMPG + RELOC(NZTWOMEMPG, u_int) +
btoc(RELOC(ZBUSAVAIL, u_int)) + NPCMCIAPG;
- /*
- * if kernel shadow mapping will overlap any initial mapping
- * of Zorro I/O space or the page table map, we need to
- * adjust things to remove the overlap.
- */
- if (loadbase != 0) {
- /* What to do, what to do? */
- }
ptsize = (RELOC(Sysptsize, u_int) +
howmany(ptextra, NPTEPG)) << PGSHIFT;
@@ -448,9 +438,6 @@
*/
i = ((ptsize >> PGSHIFT) + 1) * (NPTEPG / SG4_LEV3SIZE);
sg = &((u_int *)(RELOC(Sysseg_pa, u_int)))[SG4_LEV1SIZE];
- if (loadbase != 0)
- /* start of next L2 table */
- shadow_pt = &sg[roundup(i, SG4_LEV2SIZE)];
esg = &sg[i];
sg_proto = ptpa | SG_U | SG_RW | SG_V;
while (sg < esg) {
@@ -472,46 +459,6 @@
*sg++ = sg_proto;
sg_proto += (SG4_LEV2SIZE * sizeof(st_entry_t));
}
- if (loadbase != 0) {
- sg = (u_int *)RELOC(Sysseg_pa, u_int);
- if (sg[loadbase >> SG4_SHIFT1] == 0) {
- /* allocate another level 2 table */
- sg[loadbase >> SG4_SHIFT1] =
- (u_int)shadow_pt | SG_U | SG_RW | SG_V;
- shadow_pt = NULL;
- RELOC(protostfree, u_int) =
- RELOC(protostfree, u_int) << 1;
- }
- sg = (u_int *)(sg[loadbase >> SG4_SHIFT1] & SG4_ADDR1);
- if (sg[(loadbase & SG4_MASK2) >> SG4_SHIFT2] == 0) {
- /* no page table exists, need to allocate it */
- sg_proto = pstart | SG_U | SG_RW | SG_V;
- sg = &sg[(loadbase & SG4_MASK2) >> SG4_SHIFT2];
- sg = (u_int *)((int)sg &
- ~(NBPG / SG4_LEV3SIZE - 1));
- esg = &sg[NPTEPG / SG4_LEV3SIZE];
- while (sg < esg) {
- *sg++ = sg_proto;
- sg_proto += SG4_LEV3SIZE *
- sizeof (st_entry_t);
- }
- pg = (u_int *) pstart;
- esg = (u_int *)&pg[NPTEPG];
- while (pg < esg)
- *pg++ = PG_NV;
- pstart += NBPG;
- vstart += NBPG;
- avail -= NBPG;
- /* ptmap??? */
- }
- sg = (u_int *)RELOC(Sysseg_pa, u_int);
- sg = (u_int *)(sg[loadbase >> SG4_SHIFT1] & SG4_ADDR1);
- shadow_pt =
- ((u_int *)(sg[(loadbase & SG4_MASK2) >> SG4_SHIFT2]
- & SG4_ADDR1)) +
- ((loadbase & SG4_MASK3) >> SG4_SHIFT3); /* XXX is */
-
- }
/*
* Initialize Sysptmap
*/
@@ -555,28 +502,6 @@
*sg++ = SG_NV;
*pg++ = PG_NV;
}
-
- if (loadbase != 0) {
- sg = (u_int *)RELOC(Sysseg_pa, u_int);
- if (sg[loadbase >> SG_ISHIFT] == 0) {
- /* no page table exists, need to allocate it */
- sg[loadbase >> SG_ISHIFT] =
- pstart | SG_RW | SG_V;
- pg = (u_int *)Sysptmap_pa;
- pg[loadbase >> SG_ISHIFT] =
- pstart | PG_RW | PG_CI | PG_V;
- pg = (u_int *) pstart;
- esg = (u_int *)&pg[NPTEPG];
- while (pg < esg)
- *pg++ = PG_NV;
- pstart += NBPG;
- vstart += NBPG;
- avail -= NBPG;
- }
- shadow_pt =
- ((u_int *)(sg[loadbase >> SG_ISHIFT] & 0xffffff00))
- + ((loadbase & SG_PMASK) >> SG_PSHIFT);
- }
}
/*
@@ -692,23 +617,6 @@
}
/*
- * Initial any "shadow" mapping of the kernel
- */
- if (loadbase != 0 && shadow_pt != 0) {
- RELOC(amigashdwaddr, vaddr_t) = (u_int)shadow_pt - loadbase;
- RELOC(namigashdwpg, u_int) = (vstart + USPACE) >> PGSHIFT;
- pg_proto = fphystart | PG_RO | PG_V;
- pg = shadow_pt;
- *pg++ = PG_NV; /* Make page 0 invalid */
- pg_proto += NBPG;
- for (i = NBPG; i < (u_int)etext; i += NBPG, pg_proto += NBPG)
- *pg++ = pg_proto;
- pg_proto = (pg_proto & PG_FRAME) | PG_RW | PG_V;
- for (; i < vstart + USPACE; i += NBPG, pg_proto += NBPG)
- *pg++ = pg_proto;
- }
-
- /*
*[ following page tables MAY be allocated to ZORRO3 space,
* but they're then later mapped in autoconf.c ]
*/
@@ -843,9 +751,6 @@
/*
* movel Sysseg_pa,a0;
* movec a0,SRP;
- * pflusha;
- * movel #$0xc000,d0;
- * movec d0,TC
*/
if (id & AMIGA_68060) {
@@ -868,9 +773,6 @@
} else
((volatile struct Custom *)0xdff000)->color[0] = 0xA70; /* ORANGE */
#endif
-
- asm volatile ("movel #0xc000,%%d0; .word 0x4e7b,0x0003"
- : : :"d0" );
} else
#endif
{
@@ -881,14 +783,20 @@
*/
(RELOC(protorp[0], u_int)) = 0x80000202;
asm volatile ("pmove %0@,%%srp":: "a" (&RELOC(protorp, u_int)));
- /*
- * setup and load TC register.
- * enable_cpr, enable_srp, pagesize=8k,
- * A = 8 bits, B = 11 bits
- */
- tc = 0x82d08b00;
- asm volatile ("pmove %0@,%%tc" : : "a" (&tc));
}
+
+ RELOC(start_c_fphystart, u_int) = fphystart;
+ RELOC(start_c_pstart, u_int) = pstart;
+}
+
+void
+start_c_finish()
+{
+ extern u_int32_t delaydivisor;
+#ifdef P5PPC68KBOARD
+ struct cfdev *cdp, *ecdp;
+#endif
+
#ifdef DEBUG_KERNEL_START
#ifdef DRACO
if ((id >> 24) == 0x7D) { /* mapping on, is_draco() is valid */
@@ -907,8 +815,8 @@
((volatile struct Custom *)CUSTOMADDR)->color[0] = 0x0a0; /* GREEN */
#endif
- bzero ((u_char *)proc0paddr, USPACE); /* XXXXXXXXXXXXXXXXXXXXX */
- pmap_bootstrap(pstart, fphystart); /* XXXXXXXXXXXXXXXXXXXXXXx*/
+ bzero ((u_char *)proc0paddr, USPACE);
+ pmap_bootstrap(start_c_pstart, start_c_fphystart);
/*
* to make life easier in locore.s, set these addresses explicitly
@@ -941,8 +849,10 @@
z2mem_start = ZTWOMEMADDR;
}
+#if 0
i = *(int *)proc0paddr;
*(volatile int *)proc0paddr = i;
+#endif
/*
* disable all interrupts but enable allow them to be enabled
@@ -1018,24 +928,6 @@
}
}
#endif
-}
-
-void
-start_c_cleanup()
-{
- u_int *sg, *esg;
- extern u_int32_t delaydivisor;
-
- /*
- * remove shadow mapping of kernel?
- */
- if (amigashdwaddr == 0)
- return;
- sg = (u_int *) amigashdwaddr;
- esg = (u_int *)&sg[namigashdwpg];
- while (sg < esg)
- *sg++ = PG_NV;
-
/*
* preliminary delay divisor value
*/
Index: amiga/locore.s
===================================================================
RCS file: /usr/local/cvsroot/src/sys/arch/amiga/amiga/locore.s,v
retrieving revision 1.132
diff -u -r1.132 locore.s
--- amiga/locore.s 2 Nov 2002 20:03:04 -0000 1.132
+++ amiga/locore.s 8 Jan 2003 19:49:26 -0000
@@ -918,16 +918,71 @@
movc %d0,%sfc | as source
movc %d0,%dfc | and destination of transfers
-/* let the C function initialize everything and enable the MMU */
+/* let the C function initialize everything */
RELOC(start_c, %a0)
jbsr %a0@
addl #28,%sp
+
+#ifdef DRACO
+ RELOC(machineid,%a0)
+ cmpb #0x7d,%a0@
+ jne LAmiga_enable_MMU
+
+ lea %pc@(0),%a0
+ movl %a0,%d0
+ andl #0xff000000,%d0
+ orl #0x0000c044,%d0
+ .word 0x4e7b,0x0004 | movc %d0,%itt0
+
+ bra LMMUenable_start
+
+LAmiga_enable_MMU:
+#endif /* DRACO */
+
+/* Copy just the code to enable the MMU into chip memory */
+ lea LMMUenable_start,%a0
+ movl #LMMUenable_start:l,%a1
+ lea LMMUenable_end,%a2
+Lcopy_MMU_enabler:
+ movl %a0@+,%a1@+
+ cmpl %a0,%a2
+ jgt Lcopy_MMU_enabler
+
+ jmp LMMUenable_start:l
+
+LMMUenable_start:
+
+/* enable the MMU */
+#if defined(M68040) || defined(M68060)
+ RELOC(mmutype, %a0)
+ cmpl #MMU_68040,%a0@
+ jne Lenable030
+ pflusha
+ movl #0xc000,%d0
+ .word 0x4e7b, 0x0003 | movec %d0,%tc
+ jmp Lunshadow:l
+#endif /* M68040 || M68060 */
+/* ENABLE, SRP_ENABLE, 8K pages, 8bit A-level, 11bit B-level */
+Ltc: .long 0x82d08b00
+Lenable030:
+ lea Ltc,%a0
+ pmove %a0@,%tc
jmp Lunshadow:l
+LMMUenable_end:
+
Lunshadow:
+#ifdef DRACO
+ cmpb #0x7d,_C_LABEL(machineid)
+ bne Ldontcleanitt0
+ movq #0,%d0
+ .word 0x4e7b,0x0004 | movc %d0,%itt0
+Ldontcleanitt0:
+#endif /* DRACO */
+
lea _ASM_LABEL(tmpstk),%sp | give ourselves a temporary stack
- jbsr _C_LABEL(start_c_cleanup)
+ jbsr _C_LABEL(start_c_finish)
/* set kernel stack, user SP, and initial pcb */
movl _C_LABEL(proc0paddr),%a1 | proc0 kernel stack