15b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 25b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * GRUB -- GRand Unified Bootloader 35b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Copyright (C) 1999,2005 Free Software Foundation, Inc. 45b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 55b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This program is free software; you can redistribute it and/or modify 65b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * it under the terms of the GNU General Public License as published by 75b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * the Free Software Foundation; either version 2 of the License, or 85b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (at your option) any later version. 95b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This program is distributed in the hope that it will be useful, 115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * but WITHOUT ANY WARRANTY; without even the implied warranty of 125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * GNU General Public License for more details. 145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * You should have received a copy of the GNU General Public License 165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * along with this program; if not, write to the Free Software 175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * <Insert copyright here : it must be BSD-like so anyone can use it> 225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Author: Erich Boleyn <erich@uruk.org> http://www.uruk.org/~erich/ 245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Source file implementing Intel MultiProcessor Specification (MPS) 265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * version 1.1 and 1.4 SMP hardware control for Intel Architecture CPUs, 275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * with hooks for running correctly on a standard PC without the hardware. 285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This file was created from information in the Intel MPS version 1.4 305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * document, order number 242016-004, which can be ordered from the 315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Intel literature center. 325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * General limitations of this code: 345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (1) : This code has never been tested on an MPS-compatible system with 365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 486 CPUs, but is expected to work. 375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (2) : Presumes "int", "long", and "unsigned" are 32 bits in size, and 385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * that 32-bit pointers and memory addressing is used uniformly. 395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define _SMP_IMPS_C 425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * XXXXX The following absolutely must be defined!!! 465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * The "KERNEL_PRINT" could be made a null macro with no danger, of 485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * course, but pretty much nothing would work without the other 495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * ones defined. 505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#if 0 535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define KERNEL_PRINT(x) /* some kind of print function */ 545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_WRITE_BYTE(x,y) /* write unsigned char "y" at CMOS loc "x" */ 555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_READ_BYTE(x) /* read unsigned char at CMOS loc "x" */ 565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define PHYS_TO_VIRTUAL(x) /* convert physical address "x" to virtual */ 575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define VIRTUAL_TO_PHYS(x) /* convert virtual address "x" to physical */ 585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This is the Intel MultiProcessor Spec debugging/display code. 635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define IMPS_DEBUG 665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define KERNEL_PRINT(x) printf x 675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_WRITE_BYTE(x, y) cmos_write_byte(x, y) 685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_READ_BYTE(x) cmos_read_byte(x) 695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define PHYS_TO_VIRTUAL(x) (x) 705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define VIRTUAL_TO_PHYS(x) (x) 715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic inline unsigned char 735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectinb (unsigned short port) 745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned char data; 765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project __asm __volatile ("inb %1,%0" :"=a" (data):"d" (port)); 785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return data; 795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic inline void 825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectoutb (unsigned short port, unsigned char val) 835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project __asm __volatile ("outb %0,%1"::"a" (val), "d" (port)); 855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic inline void 895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectcmos_write_byte (int loc, int val) 905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project outb (0x70, loc); 925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project outb (0x71, val); 935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic inline unsigned 965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectcmos_read_byte (int loc) 975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project outb (0x70, loc); 995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return inb (0x71); 1005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 1015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 1045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Includes here 1055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 1065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#include "shared.h" 1085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#include "apic.h" 1095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#include "smp-imps.h" 1105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 1135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Defines that are here so as not to be in the global header file. 1145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 1155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define EBDA_SEG_ADDR 0x40E 1165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define BIOS_RESET_VECTOR 0x467 1175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define LAPIC_ADDR_DEFAULT 0xFEE00000uL 1185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define IOAPIC_ADDR_DEFAULT 0xFEC00000uL 1195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_RESET_CODE 0xF 1205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_RESET_JUMP 0xa 1215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define CMOS_BASE_MEMORY 0x15 1225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 1255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Static defines here for SMP use. 1265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 1275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#define DEF_ENTRIES 23 1295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 1305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int lapic_dummy = 0; 1315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic struct 1325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_processor proc[2]; 1345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_bus bus[2]; 1355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_ioapic ioapic; 1365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_interrupt intin[16]; 1375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_interrupt lintin[2]; 1385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectdefconfig = 1405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 1415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_PROCESSOR, 0, 0, 0, 0, 0 1445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_PROCESSOR, 1, 0, 0, 0, 0 1485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_BUS, 0, 1545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 'E', 'I', 'S', 'A', ' ', ' ' 1565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 255, 1, 1615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 'P', 'C', 'I', ' ', ' ', ' ' 1635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IOAPIC, 0, 0, IMPS_FLAG_ENABLED, IOAPIC_ADDR_DEFAULT 1695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_EXTINT, 0, 0, 0, 0xFF, 0 1745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 1, 0xFF, 1 1785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 0, 0xFF, 2 1825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 3, 0xFF, 3 1865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 4, 0xFF, 4 1905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 5, 0xFF, 5 1945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 1965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 1975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 6, 0xFF, 6 1985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 1995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 7, 0xFF, 7 2025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 8, 0xFF, 8 2065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 9, 0xFF, 9 2105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 10, 0xFF, 10 2145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 11, 0xFF, 11 2185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 12, 0xFF, 12 2225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 13, 0xFF, 13 2265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 14, 0xFF, 14 2305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_IO_INTERRUPT, IMPS_INT_INT, 0, 0, 15, 0xFF, 15 2345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_LOCAL_INTERRUPT, IMPS_INT_EXTINT, 0, 0, 15, 0xFF, 0 2405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project , 2425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_BCT_LOCAL_INTERRUPT, IMPS_INT_NMI, 0, 0, 15, 0xFF, 1 2445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project}; 2475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Exported globals here. 2505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * "imps_any_new_apics" is non-zero if any of the APICS (local or I/O) 2545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * are *not* an 82489DX. This is useful to determine if more than 15 2555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * CPUs can be supported (true if zero). 2565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int imps_any_new_apics = 0; 2585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#if 0 2595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectvolatile int imps_release_cpus = 0; 2605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 2615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * "imps_enabled" is non-zero if the probe sequence found IMPS 2635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * information and was successful. 2645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int imps_enabled = 0; 2665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This represents the number of CPUs found. 2685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int imps_num_cpus = 1; 2705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This contains the local APIC hardware address. 2725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic unsigned imps_lapic_addr = ((unsigned) (&lapic_dummy)) - LAPIC_ID; 2745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * These map from virtual cpu numbers to APIC id's and back. 2765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic unsigned char imps_cpu_apic_map[IMPS_MAX_CPUS]; 2785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic unsigned char imps_apic_cpu_map[IMPS_MAX_CPUS]; 2795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 2825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * MPS checksum function 2835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 2845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Function finished. 2855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 2865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int 2885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectget_checksum (unsigned start, int length) 2895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 2905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned sum = 0; 2915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project while (length-- > 0) 2935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 2945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project sum += *((unsigned char *) (start++)); 2955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 2965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 2975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return (sum & 0xFF); 2985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 2995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 3025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Primary function for booting individual CPUs. 3035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 3045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This must be modified to perform whatever OS-specific initialization 3055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * that is required. 3065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 3075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int 3095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectboot_cpu (imps_processor * proc) 3105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 3115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned bootaddr, accept_status; 3125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned bios_reset_vector = PHYS_TO_VIRTUAL (BIOS_RESET_VECTOR); 3135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* %%%%% ESB */ 3155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project extern char patch_code[]; 3165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project bootaddr = 256 * 1024; 3175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memmove ((char *) bootaddr, patch_code, 32); 3185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 3205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Generic CPU startup sequence starts here. 3215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 3225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* set BIOS reset vector */ 3245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project CMOS_WRITE_BYTE (CMOS_RESET_CODE, CMOS_RESET_JUMP); 3255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project *((volatile unsigned *) bios_reset_vector) = bootaddr << 12; 3265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* clear the error register */ 3285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (proc->apic_ver & 0x10) 3295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 3305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_LAPIC_WRITE (LAPIC_ESR, 0); 3315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project accept_status = IMPS_LAPIC_READ (LAPIC_ESR); 3325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 3335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#if 0 3355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* assert INIT IPI */ 3365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cfg = IMPS_LAPIC_READ (LAPIC_ICR + 1); 3375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cfg &= LAPIC_DEST_MASK; 3385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_LAPIC_WRITE (LAPIC_ICR + 1, cfg); 3395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cfg = IMPS_LAPIC_READ (LAPIC_ACR); 3405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cfg &=; 3415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* %%%%% ESB finish adding startup sequence */ 3435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 3445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* clean up BIOS reset vector */ 3465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project CMOS_WRITE_BYTE (CMOS_RESET_CODE, 0); 3475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project *((volatile unsigned *) bios_reset_vector) = 0; 3485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 3505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Generic CPU startup sequence ends here. 3515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 3525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("\n")); 3545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 3565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* XXXXX add OS-specific initialization here! */ 3585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 3595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 3625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * read bios stuff and fill tables 3635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 3645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic void 3665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectadd_processor (imps_processor * proc) 3675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 3685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project int apicid = proc->apic_id; 3695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Processor [APIC id %d ver %d]: ", 3715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project apicid, proc->apic_ver)); 3725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (!(proc->flags & IMPS_FLAG_ENABLED)) 3735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 3745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("DISABLED\n")); 3755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return; 3765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 3775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (proc->apic_ver > 0xF) 3785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 3795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_any_new_apics = 1; 3805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 3815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (proc->flags & (IMPS_CPUFLAG_BOOT)) 3825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 3835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("#0 Bootstrap Processor (BSP)\n")); 3845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return; 3855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 3865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_cpu_apic_map[imps_num_cpus] = apicid; 3875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_apic_cpu_map[apicid] = imps_num_cpus; 3885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (boot_cpu (proc)) 3895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 3905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* XXXXX add OS-specific setup for secondary CPUs here */ 3925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_num_cpus++; 3945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 3955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 3965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 3985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic void 3995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectadd_bus (imps_bus * bus) 4005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 4015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project char str[8]; 4025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memmove (str, bus->bus_type, 6); 4045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str[6] = 0; 4055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Bus id %d is %s\n", bus->id, str)); 4065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* XXXXX add OS-specific code here */ 4085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 4095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic void 4125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectadd_ioapic (imps_ioapic * ioapic) 4135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 4145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" I/O APIC id %d ver %d, address: 0x%x ", 4155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project ioapic->id, ioapic->ver, ioapic->addr)); 4165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (!(ioapic->flags & IMPS_FLAG_ENABLED)) 4175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("DISABLED\n")); 4195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return; 4205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("\n")); 4225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* XXXXX add OS-specific code here */ 4245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 4255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic void 4285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectimps_read_config_table (unsigned start, int count) 4295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 4305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project while (count-- > 0) 4315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project switch (*((unsigned char *) start)) 4335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project case IMPS_BCT_PROCESSOR: 4355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project add_processor ((imps_processor *) start); 4365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project start += 12; /* 20 total */ 4375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project case IMPS_BCT_BUS: 4395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project add_bus ((imps_bus *) start); 4405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project case IMPS_BCT_IOAPIC: 4425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project add_ioapic ((imps_ioapic *) start); 4435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#if 0 /* XXXXX uncomment this if "add_io_interrupt" is implemented */ 4455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project case IMPS_BCT_IO_INTERRUPT: 4465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project add_io_interrupt ((imps_interrupt *) start); 4475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 4495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#if 0 /* XXXXX uncomment this if "add_local_interrupt" is implemented */ 4505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project case IMPS_BCT_LOCAL_INTERRUPT: 4515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project add_local_interupt ((imps_interrupt *) start); 4525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 4545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project default: 4555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project break; 4565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project start += 8; 4585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 4605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int 4635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectimps_bad_bios (imps_fps * fps_ptr) 4645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 4655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project int sum; 4665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_cth *local_cth_ptr 4675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project = (imps_cth *) PHYS_TO_VIRTUAL (fps_ptr->cth_ptr); 4685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] > IMPS_FPS_DEFAULT_MAX) 4705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Invalid MP System Configuration type %d\n", 4725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project fps_ptr->feature_info[0])); 4735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 4745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 4765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->cth_ptr) 4775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project sum = get_checksum ((unsigned) local_cth_ptr, 4795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project local_cth_ptr->base_length); 4805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (local_cth_ptr->sig != IMPS_CTH_SIGNATURE || sum) 4815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT 4835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project ((" Bad MP Config Table sig 0x%x and/or checksum 0x%x\n", 4845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project (unsigned) (fps_ptr->cth_ptr), sum)); 4855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 4865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (local_cth_ptr->spec_rev != fps_ptr->spec_rev) 4885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Bad MP Config Table sub-revision # %d\n", local_cth_ptr->spec_rev)); 4905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 4915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 4925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (local_cth_ptr->extended_length) 4935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 4945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project sum = (get_checksum (((unsigned) local_cth_ptr) 4955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project + local_cth_ptr->base_length, 4965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project local_cth_ptr->extended_length) 4975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project + local_cth_ptr->extended_checksum) & 0xFF; 4985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (sum) 4995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT 5015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project ((" Bad Extended MP Config Table checksum 0x%x\n", sum)); 5025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 5035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project else if (!fps_ptr->feature_info[0]) 5075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Missing configuration information\n")); 5095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 5105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 0; 5135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 5145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic void 5175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectimps_read_bios (imps_fps * fps_ptr) 5185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 5195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project int apicid; 5205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned cth_start, cth_count; 5215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_cth *local_cth_ptr 5225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project = (imps_cth *) PHYS_TO_VIRTUAL (fps_ptr->cth_ptr); 5235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project char *str_ptr; 5245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT (("Intel MultiProcessor Spec 1.%d BIOS support detected\n", 5265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project fps_ptr->spec_rev)); 5275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 5295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Do all checking of errors which would definitely 5305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * lead to failure of the SMP boot here. 5315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 5325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (imps_bad_bios (fps_ptr)) 5345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" Disabling MPS support\n")); 5365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return; 5375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[1] & IMPS_FPS_IMCRP_BIT) 5405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str_ptr = "IMCR and PIC"; 5425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project else 5445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str_ptr = "Virtual Wire"; 5465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->cth_ptr) 5485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_lapic_addr = local_cth_ptr->lapic_addr; 5505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project else 5525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_lapic_addr = LAPIC_ADDR_DEFAULT; 5545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT 5565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project ((" APIC config: \"%s mode\" Local APIC address: 0x%x\n", 5575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str_ptr, imps_lapic_addr)); 5585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_lapic_addr = PHYS_TO_VIRTUAL (imps_lapic_addr); 5595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 5615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Setup primary CPU. 5625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 5635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project apicid = IMPS_LAPIC_READ (LAPIC_SPIV); 5645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_LAPIC_WRITE (LAPIC_SPIV, apicid | LAPIC_SPIV_ENABLE_APIC); 5655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_any_new_apics = IMPS_LAPIC_READ (LAPIC_VER) & 0xF0; 5665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project apicid = IMPS_APIC_ID (IMPS_LAPIC_READ (LAPIC_ID)); 5675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_cpu_apic_map[0] = apicid; 5685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_apic_cpu_map[apicid] = 0; 5695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 5705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->cth_ptr) 5715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project char str1[16], str2[16]; 5735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memcpy (str1, local_cth_ptr->oem_id, 8); 5745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str1[8] = 0; 5755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memcpy (str2, local_cth_ptr->prod_id, 12); 5765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project str2[12] = 0; 5775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project KERNEL_PRINT ((" OEM id: %s Product id: %s\n", str1, str2)); 5785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cth_start = ((unsigned) local_cth_ptr) + sizeof (imps_cth); 5795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cth_count = local_cth_ptr->entry_count; 5805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 5815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project else 5825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project *((volatile unsigned *) IOAPIC_ADDR_DEFAULT) = IOAPIC_ID; 5845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.ioapic.id 5855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project = IMPS_APIC_ID (*((volatile unsigned *) 5865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project (IOAPIC_ADDR_DEFAULT + IOAPIC_RW))); 5875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project *((volatile unsigned *) IOAPIC_ADDR_DEFAULT) = IOAPIC_VER; 5885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.ioapic.ver 5895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project = APIC_VERSION (*((volatile unsigned *) 5905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project (IOAPIC_ADDR_DEFAULT + IOAPIC_RW))); 5915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.proc[apicid].flags 5925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project = IMPS_FLAG_ENABLED | IMPS_CPUFLAG_BOOT; 5935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.proc[!apicid].flags = IMPS_FLAG_ENABLED; 5945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_num_cpus = 2; 5955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] == 1 5965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project || fps_ptr->feature_info[0] == 5) 5975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 5985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memcpy (defconfig.bus[0].bus_type, "ISA ", 6); 5995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] == 4 6015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project || fps_ptr->feature_info[0] == 7) 6025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project memcpy (defconfig.bus[0].bus_type, "MCA ", 6); 6045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] > 4) 6065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.proc[0].apic_ver = 0x10; 6085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.proc[1].apic_ver = 0x10; 6095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.bus[1].type = IMPS_BCT_BUS; 6105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] == 2) 6125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.intin[2].type = 255; 6145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.intin[13].type = 255; 6155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->feature_info[0] == 7) 6175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project defconfig.intin[0].type = 255; 6195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cth_start = (unsigned) &defconfig; 6215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project cth_count = DEF_ENTRIES; 6225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_read_config_table (cth_start, cth_count); 6245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* %%%%% ESB read extended entries here */ 6265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_enabled = 1; 6285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 6295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 6325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Given a region to check, this actually looks for the "MP Floating 6335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Pointer Structure". The return value indicates if the correct 6345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * signature and checksum for a floating pointer structure of the 6355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * appropriate spec revision was found. If so, then do not search 6365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * further. 6375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * NOTE: The memory scan will always be in the bottom 1 MB. 6395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This function presumes that "start" will always be aligned to a 16-bit 6415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * boundary. 6425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Function finished. 6445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 6455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectstatic int 6475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectimps_scan (unsigned start, unsigned length) 6485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 6495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_DEBUG_PRINT (("Scanning from 0x%x for %d bytes\n", 6505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project start, length)); 6515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project while (length > 0) 6535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_fps *fps_ptr = (imps_fps *) PHYS_TO_VIRTUAL (start); 6555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (fps_ptr->sig == IMPS_FPS_SIGNATURE 6575b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project && fps_ptr->length == 1 6585b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project && (fps_ptr->spec_rev == 1 || fps_ptr->spec_rev == 4) 6595b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project && !get_checksum (start, 16)) 6605b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 6615b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project IMPS_DEBUG_PRINT (("Found MP Floating Structure Pointer at %x\n", start)); 6625b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_read_bios (fps_ptr); 6635b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 6645b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6655b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6665b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project length -= 16; 6675b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project start += 16; 6685b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 6695b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6705b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 0; 6715b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 6725b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6735b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 6745b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project/* 6755b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * This is the primary function for probing for MPS compatible hardware 6765b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * and BIOS information. Call this during the early stages of OS startup, 6775b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * before memory can be messed up. 6785b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6795b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * The probe looks for the "MP Floating Pointer Structure" at locations 6805b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * listed at the top of page 4-2 of the spec. 6815b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6825b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Environment requirements from the OS to run: 6835b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 6845b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (1) : A non-linear virtual to physical memory mapping is probably OK, 6855b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * as (I think) the structures all fall within page boundaries, 6865b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * but a linear mapping is recommended. Currently assumes that 6875b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * the mapping will remain identical over time (which should be 6885b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * OK since it only accesses memory which shouldn't be munged 6895b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * by the OS anyway). 6905b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (2) : The OS only consumes memory which the BIOS says is OK to use, 6915b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * and not any of the BIOS standard areas (the areas 0x400 to 6925b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 0x600, the EBDA, 0xE0000 to 0xFFFFF, and unreported physical 6935b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * RAM). Sometimes a small amount of physical RAM is not 6945b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * reported by the BIOS, to be used to store MPS and other 6955b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * information. 6965b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (3) : It must be possible to read the CMOS. 6975b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * (4) : There must be between 512K and 640K of lower memory (this is a 6985b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * sanity check). 6995b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 7005b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Function finished. 7015b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 7025b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7035b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectint 7045b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Projectimps_probe (void) 7055b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project{ 7065b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 7075b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Determine possible address of the EBDA 7085b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 7095b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned ebda_addr = *((unsigned short *) 7105b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project PHYS_TO_VIRTUAL (EBDA_SEG_ADDR)) << 4; 7115b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7125b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 7135b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Determine amount of installed lower memory (not *available* 7145b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * lower memory). 7155b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 7165b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * NOTE: This should work reliably as long as we verify the 7175b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * machine is at least a system that could possibly have 7185b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * MPS compatibility to begin with. 7195b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 7205b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project unsigned mem_lower = ((CMOS_READ_BYTE (CMOS_BASE_MEMORY + 1) << 8) 7215b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project | CMOS_READ_BYTE (CMOS_BASE_MEMORY)) << 10; 7225b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7235b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#ifdef IMPS_DEBUG 7245b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_enabled = 0; 7255b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project imps_num_cpus = 1; 7265b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project#endif 7275b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7285b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 7295b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * Sanity check : if this isn't reasonable, it is almost impossibly 7305b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * unlikely to be an MPS compatible machine, so return failure. 7315b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 7325b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (mem_lower < 512 * 1024 || mem_lower > 640 * 1024) 7335b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 7345b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 0; 7355b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 7365b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7375b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (ebda_addr > mem_lower - 1024 7385b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project || ebda_addr + *((unsigned char *) PHYS_TO_VIRTUAL (ebda_addr)) 7395b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * 1024 > mem_lower) 7405b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 7415b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project ebda_addr = 0; 7425b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 7435b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7445b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project if (((ebda_addr && imps_scan (ebda_addr, 1024)) 7455b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project || (!ebda_addr && imps_scan (mem_lower - 1024, 1024)) 7465b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project || imps_scan (0xF0000, 0x10000)) && imps_enabled) 7475b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project { 7485b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 1; 7495b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project } 7505b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7515b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project /* 7525b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project * If no BIOS info on MPS hardware is found, then return failure. 7535b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project */ 7545b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project 7555b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project return 0; 7565b1eb061628a97aae48a9c0bcaa96eb0bfa07aa4The Android Open Source Project} 757