xv6-cs450/mp.c

157 lines
3.4 KiB
C
Raw Normal View History

2011-08-16 02:11:13 +02:00
// Multiprocessor support
2007-08-28 21:04:36 +02:00
// Search memory for MP description structures.
// http://developer.intel.com/design/pentium/datashts/24201606.pdf
2006-06-21 03:53:07 +02:00
#include "types.h"
#include "defs.h"
#include "param.h"
#include "memlayout.h"
2007-08-28 01:26:33 +02:00
#include "mp.h"
#include "x86.h"
#include "mmu.h"
#include "proc.h"
2006-06-21 03:53:07 +02:00
struct cpu cpus[NCPU];
static struct cpu *bcpu;
int ismp;
int ncpu;
uchar ioapicid;
int
mpbcpu(void)
{
return bcpu-cpus;
}
static uchar
sum(uchar *addr, int len)
{
int i, sum;
sum = 0;
for(i=0; i<len; i++)
sum += addr[i];
return sum;
}
// Look for an MP structure in the len bytes at addr.
static struct mp*
mpsearch1(uint a, int len)
2006-06-21 03:53:07 +02:00
{
uchar *e, *p, *addr;
2006-06-21 03:53:07 +02:00
addr = p2v(a);
2006-06-21 03:53:07 +02:00
e = addr+len;
for(p = addr; p < e; p += sizeof(struct mp))
if(memcmp(p, "_MP_", 4) == 0 && sum(p, sizeof(struct mp)) == 0)
2006-09-06 19:27:19 +02:00
return (struct mp*)p;
2006-06-21 03:53:07 +02:00
return 0;
}
2006-09-06 19:50:20 +02:00
// Search for the MP Floating Pointer Structure, which according to the
// spec is in one of the following three locations:
// 1) in the first KB of the EBDA;
// 2) in the last KB of system base memory;
// 3) in the BIOS ROM between 0xE0000 and 0xFFFFF.
static struct mp*
mpsearch(void)
2006-06-21 03:53:07 +02:00
{
2006-07-20 11:07:53 +02:00
uchar *bda;
uint p;
struct mp *mp;
2006-06-21 03:53:07 +02:00
bda = (uchar *) P2V(0x400);
if((p = ((bda[0x0F]<<8)| bda[0x0E]) << 4)){
if((mp = mpsearch1(p, 1024)))
2006-06-21 03:53:07 +02:00
return mp;
2007-08-28 20:37:41 +02:00
} else {
2006-06-21 03:53:07 +02:00
p = ((bda[0x14]<<8)|bda[0x13])*1024;
if((mp = mpsearch1(p-1024, 1024)))
2006-06-21 03:53:07 +02:00
return mp;
}
return mpsearch1(0xF0000, 0x10000);
2006-06-21 03:53:07 +02:00
}
// Search for an MP configuration table. For now,
2006-09-06 19:50:20 +02:00
// don't accept the default configurations (physaddr == 0).
// Check for correct signature, calculate the checksum and,
// if correct, check the version.
// To do: check extended table checksum.
static struct mpconf*
mpconfig(struct mp **pmp)
2006-06-21 03:53:07 +02:00
{
struct mpconf *conf;
struct mp *mp;
2006-06-21 03:53:07 +02:00
if((mp = mpsearch()) == 0 || mp->physaddr == 0)
return 0;
conf = (struct mpconf*) p2v((uint) mp->physaddr);
if(memcmp(conf, "PCMP", 4) != 0)
return 0;
if(conf->version != 1 && conf->version != 4)
return 0;
if(sum((uchar*)conf, conf->length) != 0)
return 0;
*pmp = mp;
return conf;
2006-06-21 03:53:07 +02:00
}
void
mpinit(void)
2006-09-06 19:27:19 +02:00
{
2006-07-20 11:07:53 +02:00
uchar *p, *e;
struct mp *mp;
struct mpconf *conf;
struct mpproc *proc;
struct mpioapic *ioapic;
2006-06-21 03:53:07 +02:00
bcpu = &cpus[0];
if((conf = mpconfig(&mp)) == 0)
2006-09-06 19:50:20 +02:00
return;
ismp = 1;
lapic = (uint*)conf->lapicaddr;
for(p=(uchar*)(conf+1), e=(uchar*)conf+conf->length; p<e; ){
2006-06-21 03:53:07 +02:00
switch(*p){
case MPPROC:
proc = (struct mpproc*)p;
if(ncpu != proc->apicid){
2011-01-11 19:16:28 +01:00
cprintf("mpinit: ncpu=%d apicid=%d\n", ncpu, proc->apicid);
ismp = 0;
}
if(proc->flags & MPBOOT)
bcpu = &cpus[ncpu];
cpus[ncpu].id = ncpu;
2006-06-21 03:53:07 +02:00
ncpu++;
p += sizeof(struct mpproc);
2006-06-21 03:53:07 +02:00
continue;
case MPIOAPIC:
ioapic = (struct mpioapic*)p;
ioapicid = ioapic->apicno;
p += sizeof(struct mpioapic);
2006-06-21 03:53:07 +02:00
continue;
case MPBUS:
case MPIOINTR:
case MPLINTR:
p += 8;
2006-06-21 03:53:07 +02:00
continue;
default:
cprintf("mpinit: unknown config type %x\n", *p);
2011-01-11 19:16:28 +01:00
ismp = 0;
2006-06-21 03:53:07 +02:00
}
}
2011-01-11 19:16:28 +01:00
if(!ismp){
// Didn't like what we found; fall back to no MP.
ncpu = 1;
lapic = 0;
ioapicid = 0;
return;
}
2007-08-28 20:32:08 +02:00
if(mp->imcrp){
2007-08-27 18:12:08 +02:00
// Bochs doesn't support IMCR, so this doesn't run on Bochs.
// But it would on real hardware.
2006-09-06 21:08:14 +02:00
outb(0x22, 0x70); // Select IMCR
2007-08-27 18:12:08 +02:00
outb(0x23, inb(0x23) | 1); // Mask external interrupts.
}
}