mtrr.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:70k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*  Generic MTRR (Memory Type Range Register) driver.
  2.     Copyright (C) 1997-2000  Richard Gooch
  3.     This library is free software; you can redistribute it and/or
  4.     modify it under the terms of the GNU Library General Public
  5.     License as published by the Free Software Foundation; either
  6.     version 2 of the License, or (at your option) any later version.
  7.     This library is distributed in the hope that it will be useful,
  8.     but WITHOUT ANY WARRANTY; without even the implied warranty of
  9.     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  10.     Library General Public License for more details.
  11.     You should have received a copy of the GNU Library General Public
  12.     License along with this library; if not, write to the Free
  13.     Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  14.     Richard Gooch may be reached by email at  rgooch@atnf.csiro.au
  15.     The postal address is:
  16.       Richard Gooch, c/o ATNF, P. O. Box 76, Epping, N.S.W., 2121, Australia.
  17.     Source: "Pentium Pro Family Developer's Manual, Volume 3:
  18.     Operating System Writer's Guide" (Intel document number 242692),
  19.     section 11.11.7
  20.     ChangeLog
  21.     Prehistory Martin Tischh鋟ser <martin@ikcbarka.fzk.de>
  22.        Initial register-setting code (from proform-1.0).
  23.     19971216   Richard Gooch <rgooch@atnf.csiro.au>
  24.                Original version for /proc/mtrr interface, SMP-safe.
  25.   v1.0
  26.     19971217   Richard Gooch <rgooch@atnf.csiro.au>
  27.                Bug fix for ioctls()'s.
  28.        Added sample code in Documentation/mtrr.txt
  29.   v1.1
  30.     19971218   Richard Gooch <rgooch@atnf.csiro.au>
  31.                Disallow overlapping regions.
  32.     19971219   Jens Maurer <jmaurer@menuett.rhein-main.de>
  33.                Register-setting fixups.
  34.   v1.2
  35.     19971222   Richard Gooch <rgooch@atnf.csiro.au>
  36.                Fixups for kernel 2.1.75.
  37.   v1.3
  38.     19971229   David Wragg <dpw@doc.ic.ac.uk>
  39.                Register-setting fixups and conformity with Intel conventions.
  40.     19971229   Richard Gooch <rgooch@atnf.csiro.au>
  41.                Cosmetic changes and wrote this ChangeLog ;-)
  42.     19980106   Richard Gooch <rgooch@atnf.csiro.au>
  43.                Fixups for kernel 2.1.78.
  44.   v1.4
  45.     19980119   David Wragg <dpw@doc.ic.ac.uk>
  46.                Included passive-release enable code (elsewhere in PCI setup).
  47.   v1.5
  48.     19980131   Richard Gooch <rgooch@atnf.csiro.au>
  49.                Replaced global kernel lock with private spinlock.
  50.   v1.6
  51.     19980201   Richard Gooch <rgooch@atnf.csiro.au>
  52.                Added wait for other CPUs to complete changes.
  53.   v1.7
  54.     19980202   Richard Gooch <rgooch@atnf.csiro.au>
  55.                Bug fix in definition of <set_mtrr> for UP.
  56.   v1.8
  57.     19980319   Richard Gooch <rgooch@atnf.csiro.au>
  58.                Fixups for kernel 2.1.90.
  59.     19980323   Richard Gooch <rgooch@atnf.csiro.au>
  60.                Move SMP BIOS fixup before secondary CPUs call <calibrate_delay>
  61.   v1.9
  62.     19980325   Richard Gooch <rgooch@atnf.csiro.au>
  63.                Fixed test for overlapping regions: confused by adjacent regions
  64.     19980326   Richard Gooch <rgooch@atnf.csiro.au>
  65.                Added wbinvd in <set_mtrr_prepare>.
  66.     19980401   Richard Gooch <rgooch@atnf.csiro.au>
  67.                Bug fix for non-SMP compilation.
  68.     19980418   David Wragg <dpw@doc.ic.ac.uk>
  69.                Fixed-MTRR synchronisation for SMP and use atomic operations
  70.        instead of spinlocks.
  71.     19980418   Richard Gooch <rgooch@atnf.csiro.au>
  72.        Differentiate different MTRR register classes for BIOS fixup.
  73.   v1.10
  74.     19980419   David Wragg <dpw@doc.ic.ac.uk>
  75.        Bug fix in variable MTRR synchronisation.
  76.   v1.11
  77.     19980419   Richard Gooch <rgooch@atnf.csiro.au>
  78.        Fixups for kernel 2.1.97.
  79.   v1.12
  80.     19980421   Richard Gooch <rgooch@atnf.csiro.au>
  81.        Safer synchronisation across CPUs when changing MTRRs.
  82.   v1.13
  83.     19980423   Richard Gooch <rgooch@atnf.csiro.au>
  84.        Bugfix for SMP systems without MTRR support.
  85.   v1.14
  86.     19980427   Richard Gooch <rgooch@atnf.csiro.au>
  87.        Trap calls to <mtrr_add> and <mtrr_del> on non-MTRR machines.
  88.   v1.15
  89.     19980427   Richard Gooch <rgooch@atnf.csiro.au>
  90.        Use atomic bitops for setting SMP change mask.
  91.   v1.16
  92.     19980428   Richard Gooch <rgooch@atnf.csiro.au>
  93.        Removed spurious diagnostic message.
  94.   v1.17
  95.     19980429   Richard Gooch <rgooch@atnf.csiro.au>
  96.        Moved register-setting macros into this file.
  97.        Moved setup code from init/main.c to i386-specific areas.
  98.   v1.18
  99.     19980502   Richard Gooch <rgooch@atnf.csiro.au>
  100.        Moved MTRR detection outside conditionals in <mtrr_init>.
  101.   v1.19
  102.     19980502   Richard Gooch <rgooch@atnf.csiro.au>
  103.        Documentation improvement: mention Pentium II and AGP.
  104.   v1.20
  105.     19980521   Richard Gooch <rgooch@atnf.csiro.au>
  106.        Only manipulate interrupt enable flag on local CPU.
  107.        Allow enclosed uncachable regions.
  108.   v1.21
  109.     19980611   Richard Gooch <rgooch@atnf.csiro.au>
  110.        Always define <main_lock>.
  111.   v1.22
  112.     19980901   Richard Gooch <rgooch@atnf.csiro.au>
  113.        Removed module support in order to tidy up code.
  114.        Added sanity check for <mtrr_add>/<mtrr_del> before <mtrr_init>.
  115.        Created addition queue for prior to SMP commence.
  116.   v1.23
  117.     19980902   Richard Gooch <rgooch@atnf.csiro.au>
  118.        Ported patch to kernel 2.1.120-pre3.
  119.   v1.24
  120.     19980910   Richard Gooch <rgooch@atnf.csiro.au>
  121.        Removed sanity checks and addition queue: Linus prefers an OOPS.
  122.   v1.25
  123.     19981001   Richard Gooch <rgooch@atnf.csiro.au>
  124.        Fixed harmless compiler warning in include/asm-i386/mtrr.h
  125.        Fixed version numbering and history for v1.23 -> v1.24.
  126.   v1.26
  127.     19990118   Richard Gooch <rgooch@atnf.csiro.au>
  128.        Added devfs support.
  129.   v1.27
  130.     19990123   Richard Gooch <rgooch@atnf.csiro.au>
  131.        Changed locking to spin with reschedule.
  132.        Made use of new <smp_call_function>.
  133.   v1.28
  134.     19990201   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  135.        Extended the driver to be able to use Cyrix style ARRs.
  136.     19990204   Richard Gooch <rgooch@atnf.csiro.au>
  137.        Restructured Cyrix support.
  138.   v1.29
  139.     19990204   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  140.        Refined ARR support: enable MAPEN in set_mtrr_prepare()
  141.        and disable MAPEN in set_mtrr_done().
  142.     19990205   Richard Gooch <rgooch@atnf.csiro.au>
  143.        Minor cleanups.
  144.   v1.30
  145.     19990208   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  146.                Protect plain 6x86s (and other processors without the
  147.                Page Global Enable feature) against accessing CR4 in
  148.                set_mtrr_prepare() and set_mtrr_done().
  149.     19990210   Richard Gooch <rgooch@atnf.csiro.au>
  150.        Turned <set_mtrr_up> and <get_mtrr> into function pointers.
  151.   v1.31
  152.     19990212   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  153.                Major rewrite of cyrix_arr_init(): do not touch ARRs,
  154.                leave them as the BIOS have set them up.
  155.                Enable usage of all 8 ARRs.
  156.                Avoid multiplications by 3 everywhere and other
  157.                code clean ups/speed ups.
  158.     19990213   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  159.                Set up other Cyrix processors identical to the boot cpu.
  160.                Since Cyrix don't support Intel APIC, this is l'art pour l'art.
  161.                Weigh ARRs by size:
  162.                If size <= 32M is given, set up ARR# we were given.
  163.                If size >  32M is given, set up ARR7 only if it is free,
  164.                fail otherwise.
  165.     19990214   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  166.                Also check for size >= 256K if we are to set up ARR7,
  167.                mtrr_add() returns the value it gets from set_mtrr()
  168.     19990218   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  169.                Remove Cyrix "coma bug" workaround from here.
  170.                Moved to linux/arch/i386/kernel/setup.c and
  171.                linux/include/asm-i386/bugs.h
  172.     19990228   Richard Gooch <rgooch@atnf.csiro.au>
  173.        Added MTRRIOC_KILL_ENTRY ioctl(2)
  174.        Trap for counter underflow in <mtrr_file_del>.
  175.        Trap for 4 MiB aligned regions for PPro, stepping <= 7.
  176.     19990301   Richard Gooch <rgooch@atnf.csiro.au>
  177.        Created <get_free_region> hook.
  178.     19990305   Richard Gooch <rgooch@atnf.csiro.au>
  179.        Temporarily disable AMD support now MTRR capability flag is set.
  180.   v1.32
  181.     19990308   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  182.        Adjust my changes (19990212-19990218) to Richard Gooch's
  183.        latest changes. (19990228-19990305)
  184.   v1.33
  185.     19990309   Richard Gooch <rgooch@atnf.csiro.au>
  186.        Fixed typo in <printk> message.
  187.     19990310   Richard Gooch <rgooch@atnf.csiro.au>
  188.        Support K6-II/III based on Alan Cox's <alan@redhat.com> patches.
  189.   v1.34
  190.     19990511   Bart Hartgers <bart@etpmod.phys.tue.nl>
  191.        Support Centaur C6 MCR's.
  192.     19990512   Richard Gooch <rgooch@atnf.csiro.au>
  193.        Minor cleanups.
  194.   v1.35
  195.     19990707   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  196.                Check whether ARR3 is protected in cyrix_get_free_region()
  197.                and mtrr_del(). The code won't attempt to delete or change it
  198.                from now on if the BIOS protected ARR3. It silently skips ARR3
  199.                in cyrix_get_free_region() or returns with an error code from
  200.                mtrr_del().
  201.     19990711   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  202.                Reset some bits in the CCRs in cyrix_arr_init() to disable SMM
  203.                if ARR3 isn't protected. This is needed because if SMM is active
  204.                and ARR3 isn't protected then deleting and setting ARR3 again
  205.                may lock up the processor. With SMM entirely disabled, it does
  206.                not happen.
  207.     19990812   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  208.                Rearrange switch() statements so the driver accomodates to
  209.                the fact that the AMD Athlon handles its MTRRs the same way
  210.                as Intel does.
  211.     19990814   Zolt醤 B鰏z鰎m閚yi <zboszor@mail.externet.hu>
  212.        Double check for Intel in mtrr_add()'s big switch() because
  213.        that revision check is only valid for Intel CPUs.
  214.     19990819   Alan Cox <alan@redhat.com>
  215.                Tested Zoltan's changes on a pre production Athlon - 100%
  216.                success.
  217.     19991008   Manfred Spraul <manfreds@colorfullife.com>
  218.             replaced spin_lock_reschedule() with a normal semaphore.
  219.   v1.36
  220.     20000221   Richard Gooch <rgooch@atnf.csiro.au>
  221.                Compile fix if procfs and devfs not enabled.
  222.        Formatting changes.
  223.   v1.37
  224.     20001109   H. Peter Anvin <hpa@zytor.com>
  225.        Use the new centralized CPU feature detects.
  226.   v1.38
  227.     20010309   Dave Jones <davej@suse.de>
  228.        Add support for Cyrix III.
  229.   v1.39
  230.     20010312   Dave Jones <davej@suse.de>
  231.                Ugh, I broke AMD support.
  232.        Reworked fix by Troels Walsted Hansen <troels@thule.no>
  233.   v1.40
  234.     20010327   Dave Jones <davej@suse.de>
  235.        Adapted Cyrix III support to include VIA C3.
  236. */
  237. #include <linux/types.h>
  238. #include <linux/errno.h>
  239. #include <linux/sched.h>
  240. #include <linux/tty.h>
  241. #include <linux/timer.h>
  242. #include <linux/config.h>
  243. #include <linux/kernel.h>
  244. #include <linux/wait.h>
  245. #include <linux/string.h>
  246. #include <linux/slab.h>
  247. #include <linux/ioport.h>
  248. #include <linux/delay.h>
  249. #include <linux/fs.h>
  250. #include <linux/ctype.h>
  251. #include <linux/proc_fs.h>
  252. #include <linux/devfs_fs_kernel.h>
  253. #include <linux/mm.h>
  254. #include <linux/module.h>
  255. #include <linux/pci.h>
  256. #define MTRR_NEED_STRINGS
  257. #include <asm/mtrr.h>
  258. #include <linux/init.h>
  259. #include <linux/smp.h>
  260. #include <linux/smp_lock.h>
  261. #include <asm/uaccess.h>
  262. #include <asm/io.h>
  263. #include <asm/processor.h>
  264. #include <asm/system.h>
  265. #include <asm/pgtable.h>
  266. #include <asm/segment.h>
  267. #include <asm/bitops.h>
  268. #include <asm/atomic.h>
  269. #include <asm/msr.h>
  270. #include <asm/hardirq.h>
  271. #include <linux/irq.h>
  272. #define MTRR_VERSION            "1.40 (20010327)"
  273. #define TRUE  1
  274. #define FALSE 0
  275. /*
  276.  * The code assumes all processors support the same MTRR
  277.  * interface.  This is generally a good assumption, but could
  278.  * potentially be a problem.
  279.  */
  280. enum mtrr_if_type {
  281.     MTRR_IF_NONE, /* No MTRRs supported */
  282.     MTRR_IF_INTEL, /* Intel (P6) standard MTRRs */
  283.     MTRR_IF_AMD_K6, /* AMD pre-Athlon MTRRs */
  284.     MTRR_IF_CYRIX_ARR, /* Cyrix ARRs */
  285.     MTRR_IF_CENTAUR_MCR, /* Centaur MCRs */
  286. } mtrr_if = MTRR_IF_NONE;
  287. static __initdata char *mtrr_if_name[] = {
  288.     "none", "Intel", "AMD K6", "Cyrix ARR", "Centaur MCR"
  289. };
  290. #define MTRRcap_MSR     0x0fe
  291. #define MTRRdefType_MSR 0x2ff
  292. #define MTRRphysBase_MSR(reg) (0x200 + 2 * (reg))
  293. #define MTRRphysMask_MSR(reg) (0x200 + 2 * (reg) + 1)
  294. #define NUM_FIXED_RANGES 88
  295. #define MTRRfix64K_00000_MSR 0x250
  296. #define MTRRfix16K_80000_MSR 0x258
  297. #define MTRRfix16K_A0000_MSR 0x259
  298. #define MTRRfix4K_C0000_MSR 0x268
  299. #define MTRRfix4K_C8000_MSR 0x269
  300. #define MTRRfix4K_D0000_MSR 0x26a
  301. #define MTRRfix4K_D8000_MSR 0x26b
  302. #define MTRRfix4K_E0000_MSR 0x26c
  303. #define MTRRfix4K_E8000_MSR 0x26d
  304. #define MTRRfix4K_F0000_MSR 0x26e
  305. #define MTRRfix4K_F8000_MSR 0x26f
  306. #ifdef CONFIG_SMP
  307. #  define MTRR_CHANGE_MASK_FIXED     0x01
  308. #  define MTRR_CHANGE_MASK_VARIABLE  0x02
  309. #  define MTRR_CHANGE_MASK_DEFTYPE   0x04
  310. #endif
  311. /* In the Intel processor's MTRR interface, the MTRR type is always held in
  312.    an 8 bit field: */
  313. typedef u8 mtrr_type;
  314. #define LINE_SIZE      80
  315. #define JIFFIE_TIMEOUT 100
  316. #ifdef CONFIG_SMP
  317. #  define set_mtrr(reg,base,size,type) set_mtrr_smp (reg, base, size, type)
  318. #else
  319. #  define set_mtrr(reg,base,size,type) (*set_mtrr_up) (reg, base, size, type, 
  320.        TRUE)
  321. #endif
  322. #if defined(CONFIG_PROC_FS) || defined(CONFIG_DEVFS_FS)
  323. # define USERSPACE_INTERFACE
  324. #endif
  325. #ifndef USERSPACE_INTERFACE
  326. #  define compute_ascii() while (0)
  327. #endif
  328. #ifdef USERSPACE_INTERFACE
  329. static char *ascii_buffer;
  330. static unsigned int ascii_buf_bytes;
  331. #endif
  332. static unsigned int *usage_table;
  333. static DECLARE_MUTEX(main_lock);
  334. /*  Private functions  */
  335. #ifdef USERSPACE_INTERFACE
  336. static void compute_ascii (void);
  337. #endif
  338. struct set_mtrr_context
  339. {
  340.     unsigned long flags;
  341.     unsigned long deftype_lo;
  342.     unsigned long deftype_hi;
  343.     unsigned long cr4val;
  344.     unsigned long ccr3;
  345. };
  346. static int arr3_protected;
  347. /*  Put the processor into a state where MTRRs can be safely set  */
  348. static void set_mtrr_prepare_save (struct set_mtrr_context *ctxt)
  349. {
  350.     /*  Disable interrupts locally  */
  351.     __save_flags (ctxt->flags); __cli ();
  352.     if ( mtrr_if != MTRR_IF_INTEL && mtrr_if != MTRR_IF_CYRIX_ARR )
  353.  return;
  354.     /*  Save value of CR4 and clear Page Global Enable (bit 7)  */
  355.     if ( test_bit(X86_FEATURE_PGE, &boot_cpu_data.x86_capability) ) {
  356. ctxt->cr4val = read_cr4();
  357. write_cr4(ctxt->cr4val & (unsigned char) ~(1<<7));
  358.     }
  359.     /*  Disable and flush caches. Note that wbinvd flushes the TLBs as
  360. a side-effect  */
  361.     {
  362. unsigned int cr0 = read_cr0() | 0x40000000;
  363. wbinvd();
  364. write_cr0( cr0 );
  365. wbinvd();
  366.     }
  367.     if ( mtrr_if == MTRR_IF_INTEL ) {
  368. /*  Save MTRR state */
  369. rdmsr (MTRRdefType_MSR, ctxt->deftype_lo, ctxt->deftype_hi);
  370.     } else {
  371. /* Cyrix ARRs - everything else were excluded at the top */
  372. ctxt->ccr3 = getCx86 (CX86_CCR3);
  373.     }
  374. }   /*  End Function set_mtrr_prepare_save  */
  375. static void set_mtrr_disable (struct set_mtrr_context *ctxt)
  376. {
  377.     if ( mtrr_if != MTRR_IF_INTEL && mtrr_if != MTRR_IF_CYRIX_ARR )
  378.  return;
  379.     if ( mtrr_if == MTRR_IF_INTEL ) {
  380. /*  Disable MTRRs, and set the default type to uncached  */
  381. wrmsr (MTRRdefType_MSR, ctxt->deftype_lo & 0xf300UL, ctxt->deftype_hi);
  382.     } else {
  383. /* Cyrix ARRs - everything else were excluded at the top */
  384. setCx86 (CX86_CCR3, (ctxt->ccr3 & 0x0f) | 0x10);
  385.     }
  386. }   /*  End Function set_mtrr_disable  */
  387. /*  Restore the processor after a set_mtrr_prepare  */
  388. static void set_mtrr_done (struct set_mtrr_context *ctxt)
  389. {
  390.     if ( mtrr_if != MTRR_IF_INTEL && mtrr_if != MTRR_IF_CYRIX_ARR ) {
  391.  __restore_flags (ctxt->flags);
  392.  return;
  393.     }
  394.     /*  Flush caches and TLBs  */
  395.     wbinvd();
  396.     /*  Restore MTRRdefType  */
  397.     if ( mtrr_if == MTRR_IF_INTEL ) {
  398. /* Intel (P6) standard MTRRs */
  399. wrmsr (MTRRdefType_MSR, ctxt->deftype_lo, ctxt->deftype_hi);
  400.     } else {
  401. /* Cyrix ARRs - everything else was excluded at the top */
  402. setCx86 (CX86_CCR3, ctxt->ccr3);
  403.     }
  404.     /*  Enable caches  */
  405.     write_cr0( read_cr0() & 0xbfffffff );
  406.     /*  Restore value of CR4  */
  407.     if ( test_bit(X86_FEATURE_PGE, &boot_cpu_data.x86_capability) )
  408. write_cr4(ctxt->cr4val);
  409.     /*  Re-enable interrupts locally (if enabled previously)  */
  410.     __restore_flags (ctxt->flags);
  411. }   /*  End Function set_mtrr_done  */
  412. /*  This function returns the number of variable MTRRs  */
  413. static unsigned int get_num_var_ranges (void)
  414. {
  415.     unsigned long config, dummy;
  416.     switch ( mtrr_if )
  417.     {
  418.     case MTRR_IF_INTEL:
  419. rdmsr (MTRRcap_MSR, config, dummy);
  420. return (config & 0xff);
  421.     case MTRR_IF_AMD_K6:
  422. return 2;
  423.     case MTRR_IF_CYRIX_ARR:
  424. return 8;
  425.     case MTRR_IF_CENTAUR_MCR:
  426. return 8;
  427.     default:
  428. return 0;
  429.     }
  430. }   /*  End Function get_num_var_ranges  */
  431. /*  Returns non-zero if we have the write-combining memory type  */
  432. static int have_wrcomb (void)
  433. {
  434.     unsigned long config, dummy;
  435.     struct pci_dev *dev = NULL;
  436.     
  437.    /* ServerWorks LE chipsets have problems with write-combining 
  438.       Don't allow it and leave room for other chipsets to be tagged */
  439. if ((dev = pci_find_class(PCI_CLASS_BRIDGE_HOST << 8, NULL)) != NULL) {
  440. if ((dev->vendor == PCI_VENDOR_ID_SERVERWORKS) &&
  441. (dev->device == PCI_DEVICE_ID_SERVERWORKS_LE)) {
  442. printk (KERN_INFO "mtrr: Serverworks LE detected. Write-combining disabled.n");
  443. return 0;
  444. }
  445. }
  446.     switch ( mtrr_if )
  447.     {
  448.     case MTRR_IF_INTEL:
  449. rdmsr (MTRRcap_MSR, config, dummy);
  450. return (config & (1<<10));
  451. return 1;
  452.     case MTRR_IF_AMD_K6:
  453.     case MTRR_IF_CENTAUR_MCR:
  454.     case MTRR_IF_CYRIX_ARR:
  455. return 1;
  456.     default:
  457. return 0;
  458.     }
  459. }   /*  End Function have_wrcomb  */
  460. static u32 size_or_mask, size_and_mask;
  461. static void intel_get_mtrr (unsigned int reg, unsigned long *base,
  462.     unsigned long *size, mtrr_type *type)
  463. {
  464.     unsigned long mask_lo, mask_hi, base_lo, base_hi;
  465.     rdmsr (MTRRphysMask_MSR(reg), mask_lo, mask_hi);
  466.     if ( (mask_lo & 0x800) == 0 )
  467.     {
  468. /*  Invalid (i.e. free) range  */
  469. *base = 0;
  470. *size = 0;
  471. *type = 0;
  472. return;
  473.     }
  474.     rdmsr(MTRRphysBase_MSR(reg), base_lo, base_hi);
  475.     /* Work out the shifted address mask. */
  476.     mask_lo = size_or_mask | mask_hi << (32 - PAGE_SHIFT)
  477. | mask_lo >> PAGE_SHIFT;
  478.     /* This works correctly if size is a power of two, i.e. a
  479.        contiguous range. */
  480.      *size = -mask_lo;
  481.      *base = base_hi << (32 - PAGE_SHIFT) | base_lo >> PAGE_SHIFT;
  482.      *type = base_lo & 0xff;
  483. }   /*  End Function intel_get_mtrr  */
  484. static void cyrix_get_arr (unsigned int reg, unsigned long *base,
  485.    unsigned long *size, mtrr_type *type)
  486. {
  487.     unsigned long flags;
  488.     unsigned char arr, ccr3, rcr, shift;
  489.     arr = CX86_ARR_BASE + (reg << 1) + reg; /* avoid multiplication by 3 */
  490.     /* Save flags and disable interrupts */
  491.     __save_flags (flags); __cli ();
  492.     ccr3 = getCx86 (CX86_CCR3);
  493.     setCx86 (CX86_CCR3, (ccr3 & 0x0f) | 0x10); /* enable MAPEN */
  494.     ((unsigned char *) base)[3]  = getCx86 (arr);
  495.     ((unsigned char *) base)[2]  = getCx86 (arr+1);
  496.     ((unsigned char *) base)[1]  = getCx86 (arr+2);
  497.     rcr = getCx86(CX86_RCR_BASE + reg);
  498.     setCx86 (CX86_CCR3, ccr3); /* disable MAPEN */
  499.     /* Enable interrupts if it was enabled previously */
  500.     __restore_flags (flags);
  501.     shift = ((unsigned char *) base)[1] & 0x0f;
  502.     *base >>= PAGE_SHIFT;
  503.     /* Power of two, at least 4K on ARR0-ARR6, 256K on ARR7
  504.      * Note: shift==0xf means 4G, this is unsupported.
  505.      */
  506.     if (shift)
  507.       *size = (reg < 7 ? 0x1UL : 0x40UL) << (shift - 1);
  508.     else
  509.       *size = 0;
  510.     /* Bit 0 is Cache Enable on ARR7, Cache Disable on ARR0-ARR6 */
  511.     if (reg < 7)
  512.     {
  513. switch (rcr)
  514. {
  515.   case  1: *type = MTRR_TYPE_UNCACHABLE; break;
  516.   case  8: *type = MTRR_TYPE_WRBACK;     break;
  517.   case  9: *type = MTRR_TYPE_WRCOMB;     break;
  518.   case 24:
  519.   default: *type = MTRR_TYPE_WRTHROUGH;  break;
  520. }
  521.     } else
  522.     {
  523. switch (rcr)
  524. {
  525.   case  0: *type = MTRR_TYPE_UNCACHABLE; break;
  526.   case  8: *type = MTRR_TYPE_WRCOMB;     break;
  527.   case  9: *type = MTRR_TYPE_WRBACK;     break;
  528.   case 25:
  529.   default: *type = MTRR_TYPE_WRTHROUGH;  break;
  530. }
  531.     }
  532. }   /*  End Function cyrix_get_arr  */
  533. static void amd_get_mtrr (unsigned int reg, unsigned long *base,
  534.   unsigned long *size, mtrr_type *type)
  535. {
  536.     unsigned long low, high;
  537.     rdmsr (MSR_K6_UWCCR, low, high);
  538.     /*  Upper dword is region 1, lower is region 0  */
  539.     if (reg == 1) low = high;
  540.     /*  The base masks off on the right alignment  */
  541.     *base = (low & 0xFFFE0000) >> PAGE_SHIFT;
  542.     *type = 0;
  543.     if (low & 1) *type = MTRR_TYPE_UNCACHABLE;
  544.     if (low & 2) *type = MTRR_TYPE_WRCOMB;
  545.     if ( !(low & 3) )
  546.     {
  547. *size = 0;
  548. return;
  549.     }
  550.     /*
  551.      * This needs a little explaining. The size is stored as an
  552.      * inverted mask of bits of 128K granularity 15 bits long offset
  553.      * 2 bits
  554.      *
  555.      * So to get a size we do invert the mask and add 1 to the lowest
  556.      * mask bit (4 as its 2 bits in). This gives us a size we then shift
  557.      * to turn into 128K blocks
  558.      *
  559.      * eg 111 1111 1111 1100      is 512K
  560.      *
  561.      * invert 000 0000 0000 0011
  562.      * +1 000 0000 0000 0100
  563.      * *128K ...
  564.      */
  565.     low = (~low) & 0x1FFFC;
  566.     *size = (low + 4) << (15 - PAGE_SHIFT);
  567.     return;
  568. }   /*  End Function amd_get_mtrr  */
  569. static struct
  570. {
  571.     unsigned long high;
  572.     unsigned long low;
  573. } centaur_mcr[8];
  574. static u8 centaur_mcr_reserved;
  575. static u8 centaur_mcr_type; /* 0 for winchip, 1 for winchip2 */
  576. /*
  577.  * Report boot time MCR setups 
  578.  */
  579.  
  580. void mtrr_centaur_report_mcr(int mcr, u32 lo, u32 hi)
  581. {
  582. centaur_mcr[mcr].low = lo;
  583. centaur_mcr[mcr].high = hi;
  584. }
  585. static void centaur_get_mcr (unsigned int reg, unsigned long *base,
  586.      unsigned long *size, mtrr_type *type)
  587. {
  588.     *base = centaur_mcr[reg].high >> PAGE_SHIFT;
  589.     *size = -(centaur_mcr[reg].low & 0xfffff000) >> PAGE_SHIFT;
  590.     *type = MTRR_TYPE_WRCOMB; /*  If it is there, it is write-combining  */
  591.     if(centaur_mcr_type==1 && ((centaur_mcr[reg].low&31)&2))
  592.      *type = MTRR_TYPE_UNCACHABLE;
  593.     if(centaur_mcr_type==1 && (centaur_mcr[reg].low&31)==25)
  594.      *type = MTRR_TYPE_WRBACK;
  595.     if(centaur_mcr_type==0 && (centaur_mcr[reg].low&31)==31)
  596.      *type = MTRR_TYPE_WRBACK;
  597.     
  598. }   /*  End Function centaur_get_mcr  */
  599. static void (*get_mtrr) (unsigned int reg, unsigned long *base,
  600.  unsigned long *size, mtrr_type *type);
  601. static void intel_set_mtrr_up (unsigned int reg, unsigned long base,
  602.        unsigned long size, mtrr_type type, int do_safe)
  603. /*  [SUMMARY] Set variable MTRR register on the local CPU.
  604.     <reg> The register to set.
  605.     <base> The base address of the region.
  606.     <size> The size of the region. If this is 0 the region is disabled.
  607.     <type> The type of the region.
  608.     <do_safe> If TRUE, do the change safely. If FALSE, safety measures should
  609.     be done externally.
  610.     [RETURNS] Nothing.
  611. */
  612. {
  613.     struct set_mtrr_context ctxt;
  614.     if (do_safe) {
  615. set_mtrr_prepare_save (&ctxt);
  616. set_mtrr_disable (&ctxt);
  617. }
  618.     if (size == 0)
  619.     {
  620. /* The invalid bit is kept in the mask, so we simply clear the
  621.    relevant mask register to disable a range. */
  622. wrmsr (MTRRphysMask_MSR (reg), 0, 0);
  623.     }
  624.     else
  625.     {
  626. wrmsr (MTRRphysBase_MSR (reg), base << PAGE_SHIFT | type,
  627. (base & size_and_mask) >> (32 - PAGE_SHIFT));
  628. wrmsr (MTRRphysMask_MSR (reg), -size << PAGE_SHIFT | 0x800,
  629. (-size & size_and_mask) >> (32 - PAGE_SHIFT));
  630.     }
  631.     if (do_safe) set_mtrr_done (&ctxt);
  632. }   /*  End Function intel_set_mtrr_up  */
  633. static void cyrix_set_arr_up (unsigned int reg, unsigned long base,
  634.       unsigned long size, mtrr_type type, int do_safe)
  635. {
  636.     struct set_mtrr_context ctxt;
  637.     unsigned char arr, arr_type, arr_size;
  638.     arr = CX86_ARR_BASE + (reg << 1) + reg; /* avoid multiplication by 3 */
  639.     /* count down from 32M (ARR0-ARR6) or from 2G (ARR7) */
  640.     if (reg >= 7)
  641. size >>= 6;
  642.     size &= 0x7fff; /* make sure arr_size <= 14 */
  643.     for(arr_size = 0; size; arr_size++, size >>= 1);
  644.     if (reg<7)
  645.     {
  646. switch (type) {
  647.   case MTRR_TYPE_UNCACHABLE: arr_type =  1; break;
  648.   case MTRR_TYPE_WRCOMB: arr_type =  9; break;
  649.   case MTRR_TYPE_WRTHROUGH: arr_type = 24; break;
  650.   default: arr_type =  8; break;
  651. }
  652.     }
  653.     else
  654.     {
  655. switch (type)
  656. {
  657.   case MTRR_TYPE_UNCACHABLE: arr_type =  0; break;
  658.   case MTRR_TYPE_WRCOMB: arr_type =  8; break;
  659.   case MTRR_TYPE_WRTHROUGH: arr_type = 25; break;
  660.   default: arr_type =  9; break;
  661. }
  662.     }
  663.     if (do_safe) {
  664. set_mtrr_prepare_save (&ctxt);
  665. set_mtrr_disable (&ctxt);
  666.     }
  667.     base <<= PAGE_SHIFT;
  668.     setCx86(arr,    ((unsigned char *) &base)[3]);
  669.     setCx86(arr+1,  ((unsigned char *) &base)[2]);
  670.     setCx86(arr+2, (((unsigned char *) &base)[1]) | arr_size);
  671.     setCx86(CX86_RCR_BASE + reg, arr_type);
  672.     if (do_safe) set_mtrr_done (&ctxt);
  673. }   /*  End Function cyrix_set_arr_up  */
  674. static void amd_set_mtrr_up (unsigned int reg, unsigned long base,
  675.      unsigned long size, mtrr_type type, int do_safe)
  676. /*  [SUMMARY] Set variable MTRR register on the local CPU.
  677.     <reg> The register to set.
  678.     <base> The base address of the region.
  679.     <size> The size of the region. If this is 0 the region is disabled.
  680.     <type> The type of the region.
  681.     <do_safe> If TRUE, do the change safely. If FALSE, safety measures should
  682.     be done externally.
  683.     [RETURNS] Nothing.
  684. */
  685. {
  686.     u32 regs[2];
  687.     struct set_mtrr_context ctxt;
  688.     if (do_safe) {
  689. set_mtrr_prepare_save (&ctxt);
  690. set_mtrr_disable (&ctxt);
  691.     }
  692.     /*
  693.      * Low is MTRR0 , High MTRR 1
  694.      */
  695.     rdmsr (MSR_K6_UWCCR, regs[0], regs[1]);
  696.     /*
  697.      * Blank to disable
  698.      */
  699.     if (size == 0)
  700. regs[reg] = 0;
  701.     else
  702. /* Set the register to the base, the type (off by one) and an
  703.    inverted bitmask of the size The size is the only odd
  704.    bit. We are fed say 512K We invert this and we get 111 1111
  705.    1111 1011 but if you subtract one and invert you get the   
  706.    desired 111 1111 1111 1100 mask
  707.    But ~(x - 1) == ~x + 1 == -x. Two's complement rocks!  */
  708. regs[reg] = (-size>>(15-PAGE_SHIFT) & 0x0001FFFC)
  709. | (base<<PAGE_SHIFT) | (type+1);
  710.     /*
  711.      * The writeback rule is quite specific. See the manual. Its
  712.      * disable local interrupts, write back the cache, set the mtrr
  713.      */
  714. wbinvd();
  715. wrmsr (MSR_K6_UWCCR, regs[0], regs[1]);
  716.     if (do_safe) set_mtrr_done (&ctxt);
  717. }   /*  End Function amd_set_mtrr_up  */
  718. static void centaur_set_mcr_up (unsigned int reg, unsigned long base,
  719. unsigned long size, mtrr_type type,
  720. int do_safe)
  721. {
  722.     struct set_mtrr_context ctxt;
  723.     unsigned long low, high;
  724.     if (do_safe) {
  725. set_mtrr_prepare_save (&ctxt);
  726. set_mtrr_disable (&ctxt);
  727.     }
  728.     if (size == 0)
  729.     {
  730.         /*  Disable  */
  731.         high = low = 0;
  732.     }
  733.     else
  734.     {
  735. high = base << PAGE_SHIFT;
  736. if(centaur_mcr_type == 0)
  737. low = -size << PAGE_SHIFT | 0x1f; /* only support write-combining... */
  738. else
  739. {
  740. if(type == MTRR_TYPE_UNCACHABLE)
  741. low = -size << PAGE_SHIFT | 0x02; /* NC */
  742. else
  743. low = -size << PAGE_SHIFT | 0x09; /* WWO,WC */
  744. }
  745.     }
  746.     centaur_mcr[reg].high = high;
  747.     centaur_mcr[reg].low = low;
  748.     wrmsr (MSR_IDT_MCR0 + reg, low, high);
  749.     if (do_safe) set_mtrr_done( &ctxt );
  750. }   /*  End Function centaur_set_mtrr_up  */
  751. static void (*set_mtrr_up) (unsigned int reg, unsigned long base,
  752.     unsigned long size, mtrr_type type,
  753.     int do_safe);
  754. #ifdef CONFIG_SMP
  755. struct mtrr_var_range
  756. {
  757.     unsigned long base_lo;
  758.     unsigned long base_hi;
  759.     unsigned long mask_lo;
  760.     unsigned long mask_hi;
  761. };
  762. /*  Get the MSR pair relating to a var range  */
  763. static void __init get_mtrr_var_range (unsigned int index,
  764.    struct mtrr_var_range *vr)
  765. {
  766.     rdmsr (MTRRphysBase_MSR (index), vr->base_lo, vr->base_hi);
  767.     rdmsr (MTRRphysMask_MSR (index), vr->mask_lo, vr->mask_hi);
  768. }   /*  End Function get_mtrr_var_range  */
  769. /*  Set the MSR pair relating to a var range. Returns TRUE if
  770.     changes are made  */
  771. static int __init set_mtrr_var_range_testing (unsigned int index,
  772.   struct mtrr_var_range *vr)
  773. {
  774.     unsigned int lo, hi;
  775.     int changed = FALSE;
  776.     rdmsr(MTRRphysBase_MSR(index), lo, hi);
  777.     if ( (vr->base_lo & 0xfffff0ffUL) != (lo & 0xfffff0ffUL)
  778.  || (vr->base_hi & 0xfUL) != (hi & 0xfUL) )
  779.     {
  780. wrmsr (MTRRphysBase_MSR(index), vr->base_lo, vr->base_hi);
  781. changed = TRUE;
  782.     }
  783.     rdmsr (MTRRphysMask_MSR(index), lo, hi);
  784.     if ( (vr->mask_lo & 0xfffff800UL) != (lo & 0xfffff800UL)
  785.  || (vr->mask_hi & 0xfUL) != (hi & 0xfUL) )
  786.     {
  787. wrmsr(MTRRphysMask_MSR(index), vr->mask_lo, vr->mask_hi);
  788. changed = TRUE;
  789.     }
  790.     return changed;
  791. }   /*  End Function set_mtrr_var_range_testing  */
  792. static void __init get_fixed_ranges(mtrr_type *frs)
  793. {
  794.     unsigned long *p = (unsigned long *)frs;
  795.     int i;
  796.     rdmsr(MTRRfix64K_00000_MSR, p[0], p[1]);
  797.     for (i = 0; i < 2; i++)
  798. rdmsr(MTRRfix16K_80000_MSR + i, p[2 + i*2], p[3 + i*2]);
  799.     for (i = 0; i < 8; i++)
  800. rdmsr(MTRRfix4K_C0000_MSR + i, p[6 + i*2], p[7 + i*2]);
  801. }   /*  End Function get_fixed_ranges  */
  802. static int __init set_fixed_ranges_testing(mtrr_type *frs)
  803. {
  804.     unsigned long *p = (unsigned long *)frs;
  805.     int changed = FALSE;
  806.     int i;
  807.     unsigned long lo, hi;
  808.     rdmsr(MTRRfix64K_00000_MSR, lo, hi);
  809.     if (p[0] != lo || p[1] != hi)
  810.     {
  811. wrmsr (MTRRfix64K_00000_MSR, p[0], p[1]);
  812. changed = TRUE;
  813.     }
  814.     for (i = 0; i < 2; i++)
  815.     {
  816. rdmsr (MTRRfix16K_80000_MSR + i, lo, hi);
  817. if (p[2 + i*2] != lo || p[3 + i*2] != hi)
  818. {
  819.     wrmsr (MTRRfix16K_80000_MSR + i, p[2 + i*2], p[3 + i*2]);
  820.     changed = TRUE;
  821. }
  822.     }
  823.     for (i = 0; i < 8; i++)
  824.     {
  825. rdmsr (MTRRfix4K_C0000_MSR + i, lo, hi);
  826. if (p[6 + i*2] != lo || p[7 + i*2] != hi)
  827. {
  828.     wrmsr(MTRRfix4K_C0000_MSR + i, p[6 + i*2], p[7 + i*2]);
  829.     changed = TRUE;
  830. }
  831.     }
  832.     return changed;
  833. }   /*  End Function set_fixed_ranges_testing  */
  834. struct mtrr_state
  835. {
  836.     unsigned int num_var_ranges;
  837.     struct mtrr_var_range *var_ranges;
  838.     mtrr_type fixed_ranges[NUM_FIXED_RANGES];
  839.     unsigned char enabled;
  840.     mtrr_type def_type;
  841. };
  842. /*  Grab all of the MTRR state for this CPU into *state  */
  843. static void __init get_mtrr_state(struct mtrr_state *state)
  844. {
  845.     unsigned int nvrs, i;
  846.     struct mtrr_var_range *vrs;
  847.     unsigned long lo, dummy;
  848.     nvrs = state->num_var_ranges = get_num_var_ranges();
  849.     vrs = state->var_ranges
  850.               = kmalloc (nvrs * sizeof (struct mtrr_var_range), GFP_KERNEL);
  851.     if (vrs == NULL)
  852. nvrs = state->num_var_ranges = 0;
  853.     for (i = 0; i < nvrs; i++)
  854. get_mtrr_var_range (i, &vrs[i]);
  855.     get_fixed_ranges (state->fixed_ranges);
  856.     rdmsr (MTRRdefType_MSR, lo, dummy);
  857.     state->def_type = (lo & 0xff);
  858.     state->enabled = (lo & 0xc00) >> 10;
  859. }   /*  End Function get_mtrr_state  */
  860. /*  Free resources associated with a struct mtrr_state  */
  861. static void __init finalize_mtrr_state(struct mtrr_state *state)
  862. {
  863.     if (state->var_ranges) kfree (state->var_ranges);
  864. }   /*  End Function finalize_mtrr_state  */
  865. static unsigned long __init set_mtrr_state (struct mtrr_state *state,
  866. struct set_mtrr_context *ctxt)
  867. /*  [SUMMARY] Set the MTRR state for this CPU.
  868.     <state> The MTRR state information to read.
  869.     <ctxt> Some relevant CPU context.
  870.     [NOTE] The CPU must already be in a safe state for MTRR changes.
  871.     [RETURNS] 0 if no changes made, else a mask indication what was changed.
  872. */
  873. {
  874.     unsigned int i;
  875.     unsigned long change_mask = 0;
  876.     for (i = 0; i < state->num_var_ranges; i++)
  877. if ( set_mtrr_var_range_testing (i, &state->var_ranges[i]) )
  878.     change_mask |= MTRR_CHANGE_MASK_VARIABLE;
  879.     if ( set_fixed_ranges_testing(state->fixed_ranges) )
  880. change_mask |= MTRR_CHANGE_MASK_FIXED;
  881.     /*  Set_mtrr_restore restores the old value of MTRRdefType,
  882. so to set it we fiddle with the saved value  */
  883.     if ( (ctxt->deftype_lo & 0xff) != state->def_type
  884.  || ( (ctxt->deftype_lo & 0xc00) >> 10 ) != state->enabled)
  885.     {
  886. ctxt->deftype_lo |= (state->def_type | state->enabled << 10);
  887. change_mask |= MTRR_CHANGE_MASK_DEFTYPE;
  888.     }
  889.     return change_mask;
  890. }   /*  End Function set_mtrr_state  */
  891. static atomic_t undone_count;
  892. static volatile int wait_barrier_mtrr_disable = FALSE;
  893. static volatile int wait_barrier_execute = FALSE;
  894. static volatile int wait_barrier_cache_enable = FALSE;
  895. struct set_mtrr_data
  896. {
  897.     unsigned long smp_base;
  898.     unsigned long smp_size;
  899.     unsigned int smp_reg;
  900.     mtrr_type smp_type;
  901. };
  902. static void ipi_handler (void *info)
  903. /*  [SUMMARY] Synchronisation handler. Executed by "other" CPUs.
  904.     [RETURNS] Nothing.
  905. */
  906. {
  907.     struct set_mtrr_data *data = info;
  908.     struct set_mtrr_context ctxt;
  909.     set_mtrr_prepare_save (&ctxt);
  910.     /*  Notify master that I've flushed and disabled my cache  */
  911.     atomic_dec (&undone_count);
  912.     while (wait_barrier_mtrr_disable) { rep_nop(); barrier(); }
  913.     set_mtrr_disable (&ctxt);
  914.     /*  Notify master that I've flushed and disabled my cache  */
  915.     atomic_dec (&undone_count);
  916.     while (wait_barrier_execute) { rep_nop(); barrier(); }
  917.     /*  The master has cleared me to execute  */
  918.     (*set_mtrr_up) (data->smp_reg, data->smp_base, data->smp_size,
  919.     data->smp_type, FALSE);
  920.     /*  Notify master CPU that I've executed the function  */
  921.     atomic_dec (&undone_count);
  922.     /*  Wait for master to clear me to enable cache and return  */
  923.     while (wait_barrier_cache_enable) { rep_nop(); barrier(); }
  924.     set_mtrr_done (&ctxt);
  925. }   /*  End Function ipi_handler  */
  926. static void set_mtrr_smp (unsigned int reg, unsigned long base,
  927.   unsigned long size, mtrr_type type)
  928. {
  929.     struct set_mtrr_data data;
  930.     struct set_mtrr_context ctxt;
  931.     data.smp_reg = reg;
  932.     data.smp_base = base;
  933.     data.smp_size = size;
  934.     data.smp_type = type;
  935.     wait_barrier_mtrr_disable = TRUE;
  936.     wait_barrier_execute = TRUE;
  937.     wait_barrier_cache_enable = TRUE;
  938.     atomic_set (&undone_count, smp_num_cpus - 1);
  939.     /*  Start the ball rolling on other CPUs  */
  940.     if (smp_call_function (ipi_handler, &data, 1, 0) != 0)
  941. panic ("mtrr: timed out waiting for other CPUsn");
  942.     /* Flush and disable the local CPU's cache */
  943.     set_mtrr_prepare_save (&ctxt);
  944.     /*  Wait for all other CPUs to flush and disable their caches  */
  945.     while (atomic_read (&undone_count) > 0) { rep_nop(); barrier(); }
  946.     /* Set up for completion wait and then release other CPUs to change MTRRs*/
  947.     atomic_set (&undone_count, smp_num_cpus - 1);
  948.     wait_barrier_mtrr_disable = FALSE;
  949.     set_mtrr_disable (&ctxt);
  950.     /*  Wait for all other CPUs to flush and disable their caches  */
  951.     while (atomic_read (&undone_count) > 0) { rep_nop(); barrier(); }
  952.     /* Set up for completion wait and then release other CPUs to change MTRRs*/
  953.     atomic_set (&undone_count, smp_num_cpus - 1);
  954.     wait_barrier_execute = FALSE;
  955.     (*set_mtrr_up) (reg, base, size, type, FALSE);
  956.     /*  Now wait for other CPUs to complete the function  */
  957.     while (atomic_read (&undone_count) > 0) { rep_nop(); barrier(); }
  958.     /*  Now all CPUs should have finished the function. Release the barrier to
  959. allow them to re-enable their caches and return from their interrupt,
  960. then enable the local cache and return  */
  961.     wait_barrier_cache_enable = FALSE;
  962.     set_mtrr_done (&ctxt);
  963. }   /*  End Function set_mtrr_smp  */
  964. /*  Some BIOS's are fucked and don't set all MTRRs the same!  */
  965. static void __init mtrr_state_warn(unsigned long mask)
  966. {
  967.     if (!mask) return;
  968.     if (mask & MTRR_CHANGE_MASK_FIXED)
  969. printk ("mtrr: your CPUs had inconsistent fixed MTRR settingsn");
  970.     if (mask & MTRR_CHANGE_MASK_VARIABLE)
  971. printk ("mtrr: your CPUs had inconsistent variable MTRR settingsn");
  972.     if (mask & MTRR_CHANGE_MASK_DEFTYPE)
  973. printk ("mtrr: your CPUs had inconsistent MTRRdefType settingsn");
  974.     printk ("mtrr: probably your BIOS does not setup all CPUsn");
  975. }   /*  End Function mtrr_state_warn  */
  976. #endif  /*  CONFIG_SMP  */
  977. static char *attrib_to_str (int x)
  978. {
  979.     return (x <= 6) ? mtrr_strings[x] : "?";
  980. }   /*  End Function attrib_to_str  */
  981. static void init_table (void)
  982. {
  983.     int i, max;
  984.     max = get_num_var_ranges ();
  985.     if ( ( usage_table = kmalloc (max * sizeof *usage_table, GFP_KERNEL) )
  986.  == NULL )
  987.     {
  988. printk ("mtrr: could not allocaten");
  989. return;
  990.     }
  991.     for (i = 0; i < max; i++) usage_table[i] = 1;
  992. #ifdef USERSPACE_INTERFACE
  993.     if ( ( ascii_buffer = kmalloc (max * LINE_SIZE, GFP_KERNEL) ) == NULL )
  994.     {
  995. printk ("mtrr: could not allocaten");
  996. return;
  997.     }
  998.     ascii_buf_bytes = 0;
  999.     compute_ascii ();
  1000. #endif
  1001. }   /*  End Function init_table  */
  1002. static int generic_get_free_region (unsigned long base, unsigned long size)
  1003. /*  [SUMMARY] Get a free MTRR.
  1004.     <base> The starting (base) address of the region.
  1005.     <size> The size (in bytes) of the region.
  1006.     [RETURNS] The index of the region on success, else -1 on error.
  1007. */
  1008. {
  1009.     int i, max;
  1010.     mtrr_type ltype;
  1011.     unsigned long lbase, lsize;
  1012.     max = get_num_var_ranges ();
  1013.     for (i = 0; i < max; ++i)
  1014.     {
  1015. (*get_mtrr) (i, &lbase, &lsize, &ltype);
  1016. if (lsize == 0) return i;
  1017.     }
  1018.     return -ENOSPC;
  1019. }   /*  End Function generic_get_free_region  */
  1020. static int centaur_get_free_region (unsigned long base, unsigned long size)
  1021. /*  [SUMMARY] Get a free MTRR.
  1022.     <base> The starting (base) address of the region.
  1023.     <size> The size (in bytes) of the region.
  1024.     [RETURNS] The index of the region on success, else -1 on error.
  1025. */
  1026. {
  1027.     int i, max;
  1028.     mtrr_type ltype;
  1029.     unsigned long lbase, lsize;
  1030.     max = get_num_var_ranges ();
  1031.     for (i = 0; i < max; ++i)
  1032.     {
  1033.      if(centaur_mcr_reserved & (1<<i))
  1034.      continue;
  1035. (*get_mtrr) (i, &lbase, &lsize, &ltype);
  1036. if (lsize == 0) return i;
  1037.     }
  1038.     return -ENOSPC;
  1039. }   /*  End Function generic_get_free_region  */
  1040. static int cyrix_get_free_region (unsigned long base, unsigned long size)
  1041. /*  [SUMMARY] Get a free ARR.
  1042.     <base> The starting (base) address of the region.
  1043.     <size> The size (in bytes) of the region.
  1044.     [RETURNS] The index of the region on success, else -1 on error.
  1045. */
  1046. {
  1047.     int i;
  1048.     mtrr_type ltype;
  1049.     unsigned long lbase, lsize;
  1050.     /* If we are to set up a region >32M then look at ARR7 immediately */
  1051.     if (size > 0x2000)
  1052.     {
  1053. cyrix_get_arr (7, &lbase, &lsize, &ltype);
  1054. if (lsize == 0) return 7;
  1055. /*  Else try ARR0-ARR6 first  */
  1056.     }
  1057.     else
  1058.     {
  1059. for (i = 0; i < 7; i++)
  1060. {
  1061.     cyrix_get_arr (i, &lbase, &lsize, &ltype);
  1062.     if ((i == 3) && arr3_protected) continue;
  1063.     if (lsize == 0) return i;
  1064. }
  1065. /* ARR0-ARR6 isn't free, try ARR7 but its size must be at least 256K */
  1066. cyrix_get_arr (i, &lbase, &lsize, &ltype);
  1067. if ((lsize == 0) && (size >= 0x40)) return i;
  1068.     }
  1069.     return -ENOSPC;
  1070. }   /*  End Function cyrix_get_free_region  */
  1071. static int (*get_free_region) (unsigned long base,
  1072.        unsigned long size) = generic_get_free_region;
  1073. /**
  1074.  * mtrr_add_page - Add a memory type region
  1075.  * @base: Physical base address of region in pages (4 KB)
  1076.  * @size: Physical size of region in pages (4 KB)
  1077.  * @type: Type of MTRR desired
  1078.  * @increment: If this is true do usage counting on the region
  1079.  *
  1080.  * Memory type region registers control the caching on newer Intel and
  1081.  * non Intel processors. This function allows drivers to request an
  1082.  * MTRR is added. The details and hardware specifics of each processor's
  1083.  * implementation are hidden from the caller, but nevertheless the 
  1084.  * caller should expect to need to provide a power of two size on an
  1085.  * equivalent power of two boundary.
  1086.  *
  1087.  * If the region cannot be added either because all regions are in use
  1088.  * or the CPU cannot support it a negative value is returned. On success
  1089.  * the register number for this entry is returned, but should be treated
  1090.  * as a cookie only.
  1091.  *
  1092.  * On a multiprocessor machine the changes are made to all processors.
  1093.  * This is required on x86 by the Intel processors.
  1094.  *
  1095.  * The available types are
  1096.  *
  1097.  * %MTRR_TYPE_UNCACHABLE - No caching
  1098.  *
  1099.  * %MTRR_TYPE_WRBACK - Write data back in bursts whenever
  1100.  *
  1101.  * %MTRR_TYPE_WRCOMB - Write data back soon but allow bursts
  1102.  *
  1103.  * %MTRR_TYPE_WRTHROUGH - Cache reads but not writes
  1104.  *
  1105.  * BUGS: Needs a quiet flag for the cases where drivers do not mind
  1106.  * failures and do not wish system log messages to be sent.
  1107.  */
  1108. int mtrr_add_page(unsigned long base, unsigned long size, unsigned int type, char increment)
  1109. {
  1110. /*  [SUMMARY] Add an MTRR entry.
  1111.     <base> The starting (base, in pages) address of the region.
  1112.     <size> The size of the region. (in pages)
  1113.     <type> The type of the new region.
  1114.     <increment> If true and the region already exists, the usage count will be
  1115.     incremented.
  1116.     [RETURNS] The MTRR register on success, else a negative number indicating
  1117.     the error code.
  1118.     [NOTE] This routine uses a spinlock.
  1119. */
  1120.     int i, max;
  1121.     mtrr_type ltype;
  1122.     unsigned long lbase, lsize, last;
  1123.     switch ( mtrr_if )
  1124.     {
  1125.     case MTRR_IF_NONE:
  1126. return -ENXIO; /* No MTRRs whatsoever */
  1127.     case MTRR_IF_AMD_K6:
  1128. /* Apply the K6 block alignment and size rules
  1129.    In order
  1130.    o Uncached or gathering only
  1131.    o 128K or bigger block
  1132.    o Power of 2 block
  1133.    o base suitably aligned to the power
  1134. */
  1135. if ( type > MTRR_TYPE_WRCOMB || size < (1 << (17-PAGE_SHIFT)) ||
  1136.      (size & ~(size-1))-size || ( base & (size-1) ) )
  1137.     return -EINVAL;
  1138. break;
  1139.     case MTRR_IF_INTEL:
  1140. /*  For Intel PPro stepping <= 7, must be 4 MiB aligned 
  1141.     and not touch 0x70000000->0x7003FFFF */
  1142. if ( boot_cpu_data.x86_vendor == X86_VENDOR_INTEL &&
  1143.      boot_cpu_data.x86 == 6 &&
  1144.      boot_cpu_data.x86_model == 1 &&
  1145.      boot_cpu_data.x86_mask <= 7 )
  1146. {
  1147.     if ( base & ((1 << (22-PAGE_SHIFT))-1) )
  1148.     {
  1149. printk (KERN_WARNING "mtrr: base(0x%lx000) is not 4 MiB alignedn", base);
  1150. return -EINVAL;
  1151.     }
  1152.     if (!(base + size < 0x70000000 || base > 0x7003FFFF) &&
  1153.  (type == MTRR_TYPE_WRCOMB || type == MTRR_TYPE_WRBACK))
  1154.     {
  1155. printk (KERN_WARNING "mtrr: writable mtrr between 0x70000000 and 0x7003FFFF may hang the CPU.n");
  1156.         return -EINVAL;
  1157.     }
  1158. }
  1159. /* Fall through */
  1160.     case MTRR_IF_CYRIX_ARR:
  1161.     case MTRR_IF_CENTAUR_MCR:
  1162.         if ( mtrr_if == MTRR_IF_CENTAUR_MCR )
  1163. {
  1164.     /*
  1165.      * FIXME: Winchip2 supports uncached
  1166.      */
  1167.     if (type != MTRR_TYPE_WRCOMB && (centaur_mcr_type == 0 || type != MTRR_TYPE_UNCACHABLE))
  1168.     {
  1169. printk (KERN_WARNING "mtrr: only write-combining%s supportedn",
  1170. centaur_mcr_type?" and uncacheable are":" is");
  1171. return -EINVAL;
  1172.     }
  1173. }
  1174. else if (base + size < 0x100)
  1175. {
  1176.     printk (KERN_WARNING "mtrr: cannot set region below 1 MiB (0x%lx000,0x%lx000)n",
  1177.     base, size);
  1178.     return -EINVAL;
  1179. }
  1180. /*  Check upper bits of base and last are equal and lower bits are 0
  1181.     for base and 1 for last  */
  1182. last = base + size - 1;
  1183. for (lbase = base; !(lbase & 1) && (last & 1);
  1184.      lbase = lbase >> 1, last = last >> 1);
  1185. if (lbase != last)
  1186. {
  1187.     printk (KERN_WARNING "mtrr: base(0x%lx000) is not aligned on a size(0x%lx000) boundaryn",
  1188.     base, size);
  1189.     return -EINVAL;
  1190. }
  1191. break;
  1192.     default:
  1193. return -EINVAL;
  1194.     }
  1195.     if (type >= MTRR_NUM_TYPES)
  1196.     {
  1197. printk ("mtrr: type: %u illegaln", type);
  1198. return -EINVAL;
  1199.     }
  1200.     /*  If the type is WC, check that this processor supports it  */
  1201.     if ( (type == MTRR_TYPE_WRCOMB) && !have_wrcomb () )
  1202.     {
  1203.         printk (KERN_WARNING "mtrr: your processor doesn't support write-combiningn");
  1204.         return -ENOSYS;
  1205.     }
  1206.     if ( base & size_or_mask || size  & size_or_mask )
  1207.     {
  1208. printk ("mtrr: base or size exceeds the MTRR widthn");
  1209. return -EINVAL;
  1210.     }
  1211.     increment = increment ? 1 : 0;
  1212.     max = get_num_var_ranges ();
  1213.     /*  Search for existing MTRR  */
  1214.     down(&main_lock);
  1215.     for (i = 0; i < max; ++i)
  1216.     {
  1217. (*get_mtrr) (i, &lbase, &lsize, &ltype);
  1218. if (base >= lbase + lsize) continue;
  1219. if ( (base < lbase) && (base + size <= lbase) ) continue;
  1220. /*  At this point we know there is some kind of overlap/enclosure  */
  1221. if ( (base < lbase) || (base + size > lbase + lsize) )
  1222. {
  1223.     up(&main_lock);
  1224.     printk (KERN_WARNING "mtrr: 0x%lx000,0x%lx000 overlaps existing"
  1225.     " 0x%lx000,0x%lx000n",
  1226.     base, size, lbase, lsize);
  1227.     return -EINVAL;
  1228. }
  1229. /*  New region is enclosed by an existing region  */
  1230. if (ltype != type)
  1231. {
  1232.     if (type == MTRR_TYPE_UNCACHABLE) continue;
  1233.     up(&main_lock);
  1234.     printk ( "mtrr: type mismatch for %lx000,%lx000 old: %s new: %sn",
  1235.      base, size, attrib_to_str (ltype), attrib_to_str (type) );
  1236.     return -EINVAL;
  1237. }
  1238. if (increment) ++usage_table[i];
  1239. compute_ascii ();
  1240. up(&main_lock);
  1241. return i;
  1242.     }
  1243.     /*  Search for an empty MTRR  */
  1244.     i = (*get_free_region) (base, size);
  1245.     if (i < 0)
  1246.     {
  1247. up(&main_lock);
  1248. printk ("mtrr: no more MTRRs availablen");
  1249. return i;
  1250.     }
  1251.     set_mtrr (i, base, size, type);
  1252.     usage_table[i] = 1;
  1253.     compute_ascii ();
  1254.     up(&main_lock);
  1255.     return i;
  1256. }   /*  End Function mtrr_add_page  */
  1257. /**
  1258.  * mtrr_add - Add a memory type region
  1259.  * @base: Physical base address of region
  1260.  * @size: Physical size of region
  1261.  * @type: Type of MTRR desired
  1262.  * @increment: If this is true do usage counting on the region
  1263.  *
  1264.  * Memory type region registers control the caching on newer Intel and
  1265.  * non Intel processors. This function allows drivers to request an
  1266.  * MTRR is added. The details and hardware specifics of each processor's
  1267.  * implementation are hidden from the caller, but nevertheless the 
  1268.  * caller should expect to need to provide a power of two size on an
  1269.  * equivalent power of two boundary.
  1270.  *
  1271.  * If the region cannot be added either because all regions are in use
  1272.  * or the CPU cannot support it a negative value is returned. On success
  1273.  * the register number for this entry is returned, but should be treated
  1274.  * as a cookie only.
  1275.  *
  1276.  * On a multiprocessor machine the changes are made to all processors.
  1277.  * This is required on x86 by the Intel processors.
  1278.  *
  1279.  * The available types are
  1280.  *
  1281.  * %MTRR_TYPE_UNCACHABLE - No caching
  1282.  *
  1283.  * %MTRR_TYPE_WRBACK - Write data back in bursts whenever
  1284.  *
  1285.  * %MTRR_TYPE_WRCOMB - Write data back soon but allow bursts
  1286.  *
  1287.  * %MTRR_TYPE_WRTHROUGH - Cache reads but not writes
  1288.  *
  1289.  * BUGS: Needs a quiet flag for the cases where drivers do not mind
  1290.  * failures and do not wish system log messages to be sent.
  1291.  */
  1292. int mtrr_add(unsigned long base, unsigned long size, unsigned int type, char increment)
  1293. {
  1294. /*  [SUMMARY] Add an MTRR entry.
  1295.     <base> The starting (base) address of the region.
  1296.     <size> The size (in bytes) of the region.
  1297.     <type> The type of the new region.
  1298.     <increment> If true and the region already exists, the usage count will be
  1299.     incremented.
  1300.     [RETURNS] The MTRR register on success, else a negative number indicating
  1301.     the error code.
  1302. */
  1303.     if ( (base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)) )
  1304.     {
  1305. printk ("mtrr: size and base must be multiples of 4 kiBn");
  1306. printk ("mtrr: size: 0x%lx  base: 0x%lxn", size, base);
  1307. return -EINVAL;
  1308.     }
  1309.     return mtrr_add_page(base >> PAGE_SHIFT, size >> PAGE_SHIFT, type, increment);
  1310. }   /*  End Function mtrr_add  */
  1311. /**
  1312.  * mtrr_del_page - delete a memory type region
  1313.  * @reg: Register returned by mtrr_add
  1314.  * @base: Physical base address
  1315.  * @size: Size of region
  1316.  *
  1317.  * If register is supplied then base and size are ignored. This is
  1318.  * how drivers should call it.
  1319.  *
  1320.  * Releases an MTRR region. If the usage count drops to zero the 
  1321.  * register is freed and the region returns to default state.
  1322.  * On success the register is returned, on failure a negative error
  1323.  * code.
  1324.  */
  1325.  
  1326. int mtrr_del_page (int reg, unsigned long base, unsigned long size)
  1327. /*  [SUMMARY] Delete MTRR/decrement usage count.
  1328.     <reg> The register. If this is less than 0 then <<base>> and <<size>> must
  1329.     be supplied.
  1330.     <base> The base address of the region. This is ignored if <<reg>> is >= 0.
  1331.     <size> The size of the region. This is ignored if <<reg>> is >= 0.
  1332.     [RETURNS] The register on success, else a negative number indicating
  1333.     the error code.
  1334.     [NOTE] This routine uses a spinlock.
  1335. */
  1336. {
  1337.     int i, max;
  1338.     mtrr_type ltype;
  1339.     unsigned long lbase, lsize;
  1340.     if ( mtrr_if == MTRR_IF_NONE ) return -ENXIO;
  1341.     max = get_num_var_ranges ();
  1342.     down (&main_lock);
  1343.     if (reg < 0)
  1344.     {
  1345. /*  Search for existing MTRR  */
  1346. for (i = 0; i < max; ++i)
  1347. {
  1348.     (*get_mtrr) (i, &lbase, &lsize, &ltype);
  1349.     if (lbase == base && lsize == size)
  1350.     {
  1351. reg = i;
  1352. break;
  1353.     }
  1354. }
  1355. if (reg < 0)
  1356. {
  1357.     up(&main_lock);
  1358.     printk ("mtrr: no MTRR for %lx000,%lx000 foundn", base, size);
  1359.     return -EINVAL;
  1360. }
  1361.     }
  1362.     if (reg >= max)
  1363.     {
  1364. up (&main_lock);
  1365. printk ("mtrr: register: %d too bign", reg);
  1366. return -EINVAL;
  1367.     }
  1368.     if ( mtrr_if == MTRR_IF_CYRIX_ARR )
  1369.     {
  1370. if ( (reg == 3) && arr3_protected )
  1371. {
  1372.     up (&main_lock);
  1373.     printk ("mtrr: ARR3 cannot be changedn");
  1374.     return -EINVAL;
  1375. }
  1376.     }
  1377.     (*get_mtrr) (reg, &lbase, &lsize, &ltype);
  1378.     if (lsize < 1)
  1379.     {
  1380. up (&main_lock);
  1381. printk ("mtrr: MTRR %d not usedn", reg);
  1382. return -EINVAL;
  1383.     }
  1384.     if (usage_table[reg] < 1)
  1385.     {
  1386. up (&main_lock);
  1387. printk ("mtrr: reg: %d has count=0n", reg);
  1388. return -EINVAL;
  1389.     }
  1390.     if (--usage_table[reg] < 1) set_mtrr (reg, 0, 0, 0);
  1391.     compute_ascii ();
  1392.     up (&main_lock);
  1393.     return reg;
  1394. }   /*  End Function mtrr_del_page  */
  1395. /**
  1396.  * mtrr_del - delete a memory type region
  1397.  * @reg: Register returned by mtrr_add
  1398.  * @base: Physical base address
  1399.  * @size: Size of region
  1400.  *
  1401.  * If register is supplied then base and size are ignored. This is
  1402.  * how drivers should call it.
  1403.  *
  1404.  * Releases an MTRR region. If the usage count drops to zero the 
  1405.  * register is freed and the region returns to default state.
  1406.  * On success the register is returned, on failure a negative error
  1407.  * code.
  1408.  */
  1409.  
  1410. int mtrr_del (int reg, unsigned long base, unsigned long size)
  1411. /*  [SUMMARY] Delete MTRR/decrement usage count.
  1412.     <reg> The register. If this is less than 0 then <<base>> and <<size>> must
  1413.     be supplied.
  1414.     <base> The base address of the region. This is ignored if <<reg>> is >= 0.
  1415.     <size> The size of the region. This is ignored if <<reg>> is >= 0.
  1416.     [RETURNS] The register on success, else a negative number indicating
  1417.     the error code.
  1418. */
  1419. {
  1420.     if ( (base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)) )
  1421.     {
  1422. printk ("mtrr: size and base must be multiples of 4 kiBn");
  1423. printk ("mtrr: size: 0x%lx  base: 0x%lxn", size, base);
  1424. return -EINVAL;
  1425.     }
  1426.     return mtrr_del_page(reg, base >> PAGE_SHIFT, size >> PAGE_SHIFT);
  1427. }
  1428. #ifdef USERSPACE_INTERFACE
  1429. static int mtrr_file_add (unsigned long base, unsigned long size,
  1430.   unsigned int type, char increment, struct file *file, int page)
  1431. {
  1432.     int reg, max;
  1433.     unsigned int *fcount = file->private_data;
  1434.     max = get_num_var_ranges ();
  1435.     if (fcount == NULL)
  1436.     {
  1437. if ( ( fcount = kmalloc (max * sizeof *fcount, GFP_KERNEL) ) == NULL )
  1438. {
  1439.     printk ("mtrr: could not allocaten");
  1440.     return -ENOMEM;
  1441. }
  1442. memset (fcount, 0, max * sizeof *fcount);
  1443. file->private_data = fcount;
  1444.     }
  1445.     if (!page) {
  1446. if ( (base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)) )
  1447. {
  1448.     printk ("mtrr: size and base must be multiples of 4 kiBn");
  1449.     printk ("mtrr: size: 0x%lx  base: 0x%lxn", size, base);
  1450.     return -EINVAL;
  1451. }
  1452. base >>= PAGE_SHIFT;
  1453. size >>= PAGE_SHIFT;
  1454.     }
  1455.     reg = mtrr_add_page (base, size, type, 1);
  1456.     if (reg >= 0) ++fcount[reg];
  1457.     return reg;
  1458. }   /*  End Function mtrr_file_add  */
  1459. static int mtrr_file_del (unsigned long base, unsigned long size,
  1460.   struct file *file, int page)
  1461. {
  1462.     int reg;
  1463.     unsigned int *fcount = file->private_data;
  1464.     if (!page) {
  1465. if ( (base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)) )
  1466. {
  1467.     printk ("mtrr: size and base must be multiples of 4 kiBn");
  1468.     printk ("mtrr: size: 0x%lx  base: 0x%lxn", size, base);
  1469.     return -EINVAL;
  1470. }
  1471. base >>= PAGE_SHIFT;
  1472. size >>= PAGE_SHIFT;
  1473.     }
  1474.     reg = mtrr_del_page (-1, base, size);
  1475.     if (reg < 0) return reg;
  1476.     if (fcount == NULL) return reg;
  1477.     if (fcount[reg] < 1) return -EINVAL;
  1478.     --fcount[reg];
  1479.     return reg;
  1480. }   /*  End Function mtrr_file_del  */
  1481. static ssize_t mtrr_read (struct file *file, char *buf, size_t len,
  1482.   loff_t *ppos)
  1483. {
  1484.     if (*ppos >= ascii_buf_bytes) return 0;
  1485.     if (*ppos + len > ascii_buf_bytes) len = ascii_buf_bytes - *ppos;
  1486.     if ( copy_to_user (buf, ascii_buffer + *ppos, len) ) return -EFAULT;
  1487.     *ppos += len;
  1488.     return len;
  1489. }   /*  End Function mtrr_read  */
  1490. static ssize_t mtrr_write (struct file *file, const char *buf, size_t len,
  1491.    loff_t *ppos)
  1492. /*  Format of control line:
  1493.     "base=%Lx size=%Lx type=%s"     OR:
  1494.     "disable=%d"
  1495. */
  1496. {
  1497.     int i, err;
  1498.     unsigned long reg;
  1499.     unsigned long long base, size;
  1500.     char *ptr;
  1501.     char line[LINE_SIZE];
  1502.     if ( !suser () ) return -EPERM;
  1503.     /*  Can't seek (pwrite) on this device  */
  1504.     if (ppos != &file->f_pos) return -ESPIPE;
  1505.     memset (line, 0, LINE_SIZE);
  1506.     if (len > LINE_SIZE) len = LINE_SIZE;
  1507.     if ( copy_from_user (line, buf, len - 1) ) return -EFAULT;
  1508.     ptr = line + strlen (line) - 1;
  1509.     if (*ptr == 'n') *ptr = '';
  1510.     if ( !strncmp (line, "disable=", 8) )
  1511.     {
  1512. reg = simple_strtoul (line + 8, &ptr, 0);
  1513. err = mtrr_del_page (reg, 0, 0);
  1514. if (err < 0) return err;
  1515. return len;
  1516.     }
  1517.     if ( strncmp (line, "base=", 5) )
  1518.     {
  1519. printk ("mtrr: no "base=" in line: "%s"n", line);
  1520. return -EINVAL;
  1521.     }
  1522.     base = simple_strtoull (line + 5, &ptr, 0);
  1523.     for (; isspace (*ptr); ++ptr);
  1524.     if ( strncmp (ptr, "size=", 5) )
  1525.     {
  1526. printk ("mtrr: no "size=" in line: "%s"n", line);
  1527. return -EINVAL;
  1528.     }
  1529.     size = simple_strtoull (ptr + 5, &ptr, 0);
  1530.     if ( (base & 0xfff) || (size & 0xfff) )
  1531.     {
  1532. printk ("mtrr: size and base must be multiples of 4 kiBn");
  1533. printk ("mtrr: size: 0x%Lx  base: 0x%Lxn", size, base);
  1534. return -EINVAL;
  1535.     }
  1536.     for (; isspace (*ptr); ++ptr);
  1537.     if ( strncmp (ptr, "type=", 5) )
  1538.     {
  1539. printk ("mtrr: no "type=" in line: "%s"n", line);
  1540. return -EINVAL;
  1541.     }
  1542.     ptr += 5;
  1543.     for (; isspace (*ptr); ++ptr);
  1544.     for (i = 0; i < MTRR_NUM_TYPES; ++i)
  1545.     {
  1546. if ( strcmp (ptr, mtrr_strings[i]) ) continue;
  1547. base >>= PAGE_SHIFT;
  1548. size >>= PAGE_SHIFT;
  1549. err = mtrr_add_page ((unsigned long)base, (unsigned long)size, i, 1);
  1550. if (err < 0) return err;
  1551. return len;
  1552.     }
  1553.     printk ("mtrr: illegal type: "%s"n", ptr);
  1554.     return -EINVAL;
  1555. }   /*  End Function mtrr_write  */
  1556. static int mtrr_ioctl (struct inode *inode, struct file *file,
  1557.        unsigned int cmd, unsigned long arg)
  1558. {
  1559.     int err;
  1560.     mtrr_type type;
  1561.     struct mtrr_sentry sentry;
  1562.     struct mtrr_gentry gentry;
  1563.     switch (cmd)
  1564.     {
  1565.       default:
  1566. return -ENOIOCTLCMD;
  1567.       case MTRRIOC_ADD_ENTRY:
  1568. if ( !suser () ) return -EPERM;
  1569. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1570.     return -EFAULT;
  1571. err = mtrr_file_add (sentry.base, sentry.size, sentry.type, 1, file, 0);
  1572. if (err < 0) return err;
  1573. break;
  1574.       case MTRRIOC_SET_ENTRY:
  1575. if ( !suser () ) return -EPERM;
  1576. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1577.     return -EFAULT;
  1578. err = mtrr_add (sentry.base, sentry.size, sentry.type, 0);
  1579. if (err < 0) return err;
  1580. break;
  1581.       case MTRRIOC_DEL_ENTRY:
  1582. if ( !suser () ) return -EPERM;
  1583. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1584.     return -EFAULT;
  1585. err = mtrr_file_del (sentry.base, sentry.size, file, 0);
  1586. if (err < 0) return err;
  1587. break;
  1588.       case MTRRIOC_KILL_ENTRY:
  1589. if ( !suser () ) return -EPERM;
  1590. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1591.     return -EFAULT;
  1592. err = mtrr_del (-1, sentry.base, sentry.size);
  1593. if (err < 0) return err;
  1594. break;
  1595.       case MTRRIOC_GET_ENTRY:
  1596. if ( copy_from_user (&gentry, (void *) arg, sizeof gentry) )
  1597.     return -EFAULT;
  1598. if ( gentry.regnum >= get_num_var_ranges () ) return -EINVAL;
  1599. (*get_mtrr) (gentry.regnum, &gentry.base, &gentry.size, &type);
  1600. /* Hide entries that go above 4GB */
  1601. if (gentry.base + gentry.size > 0x100000 || gentry.size == 0x100000)
  1602.     gentry.base = gentry.size = gentry.type = 0;
  1603. else {
  1604.     gentry.base <<= PAGE_SHIFT;
  1605.     gentry.size <<= PAGE_SHIFT;
  1606.     gentry.type = type;
  1607. }
  1608. if ( copy_to_user ( (void *) arg, &gentry, sizeof gentry) )
  1609.      return -EFAULT;
  1610. break;
  1611.       case MTRRIOC_ADD_PAGE_ENTRY:
  1612. if ( !suser () ) return -EPERM;
  1613. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1614.     return -EFAULT;
  1615. err = mtrr_file_add (sentry.base, sentry.size, sentry.type, 1, file, 1);
  1616. if (err < 0) return err;
  1617. break;
  1618.       case MTRRIOC_SET_PAGE_ENTRY:
  1619. if ( !suser () ) return -EPERM;
  1620. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1621.     return -EFAULT;
  1622. err = mtrr_add_page (sentry.base, sentry.size, sentry.type, 0);
  1623. if (err < 0) return err;
  1624. break;
  1625.       case MTRRIOC_DEL_PAGE_ENTRY:
  1626. if ( !suser () ) return -EPERM;
  1627. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1628.     return -EFAULT;
  1629. err = mtrr_file_del (sentry.base, sentry.size, file, 1);
  1630. if (err < 0) return err;
  1631. break;
  1632.       case MTRRIOC_KILL_PAGE_ENTRY:
  1633. if ( !suser () ) return -EPERM;
  1634. if ( copy_from_user (&sentry, (void *) arg, sizeof sentry) )
  1635.     return -EFAULT;
  1636. err = mtrr_del_page (-1, sentry.base, sentry.size);
  1637. if (err < 0) return err;
  1638. break;
  1639.       case MTRRIOC_GET_PAGE_ENTRY:
  1640. if ( copy_from_user (&gentry, (void *) arg, sizeof gentry) )
  1641.     return -EFAULT;
  1642. if ( gentry.regnum >= get_num_var_ranges () ) return -EINVAL;
  1643. (*get_mtrr) (gentry.regnum, &gentry.base, &gentry.size, &type);
  1644. gentry.type = type;
  1645. if ( copy_to_user ( (void *) arg, &gentry, sizeof gentry) )
  1646.      return -EFAULT;
  1647. break;
  1648.     }
  1649.     return 0;
  1650. }   /*  End Function mtrr_ioctl  */
  1651. static int mtrr_close (struct inode *ino, struct file *file)
  1652. {
  1653.     int i, max;
  1654.     unsigned int *fcount = file->private_data;
  1655.     if (fcount == NULL) return 0;
  1656.     lock_kernel();
  1657.     max = get_num_var_ranges ();
  1658.     for (i = 0; i < max; ++i)
  1659.     {
  1660. while (fcount[i] > 0)
  1661. {
  1662.     if (mtrr_del (i, 0, 0) < 0) printk ("mtrr: reg %d not usedn", i);
  1663.     --fcount[i];
  1664. }
  1665.     }
  1666.     unlock_kernel();
  1667.     kfree (fcount);
  1668.     file->private_data = NULL;
  1669.     return 0;
  1670. }   /*  End Function mtrr_close  */
  1671. static struct file_operations mtrr_fops =
  1672. {
  1673.     owner: THIS_MODULE,
  1674.     read: mtrr_read,
  1675.     write: mtrr_write,
  1676.     ioctl: mtrr_ioctl,
  1677.     release: mtrr_close,
  1678. };
  1679. #  ifdef CONFIG_PROC_FS
  1680. static struct proc_dir_entry *proc_root_mtrr;
  1681. #  endif  /*  CONFIG_PROC_FS  */
  1682. static devfs_handle_t devfs_handle;
  1683. static void compute_ascii (void)
  1684. {
  1685.     char factor;
  1686.     int i, max;
  1687.     mtrr_type type;
  1688.     unsigned long base, size;
  1689.     ascii_buf_bytes = 0;
  1690.     max = get_num_var_ranges ();
  1691.     for (i = 0; i < max; i++)
  1692.     {
  1693. (*get_mtrr) (i, &base, &size, &type);
  1694. if (size == 0) usage_table[i] = 0;
  1695. else
  1696. {
  1697.     if (size < (0x100000 >> PAGE_SHIFT))
  1698.     {
  1699. /* less than 1MB */
  1700. factor = 'K';
  1701. size <<= PAGE_SHIFT - 10;
  1702.     }
  1703.     else
  1704.     {
  1705. factor = 'M';
  1706. size >>= 20 - PAGE_SHIFT;
  1707.     }
  1708.     sprintf
  1709. (ascii_buffer + ascii_buf_bytes,
  1710.  "reg%02i: base=0x%05lx000 (%4liMB), size=%4li%cB: %s, count=%dn",
  1711.  i, base, base >> (20 - PAGE_SHIFT), size, factor,
  1712.  attrib_to_str (type), usage_table[i]);
  1713.     ascii_buf_bytes += strlen (ascii_buffer + ascii_buf_bytes);
  1714. }
  1715.     }
  1716.     devfs_set_file_size (devfs_handle, ascii_buf_bytes);
  1717. #  ifdef CONFIG_PROC_FS
  1718.     if (proc_root_mtrr)
  1719. proc_root_mtrr->size = ascii_buf_bytes;
  1720. #  endif  /*  CONFIG_PROC_FS  */
  1721. }   /*  End Function compute_ascii  */
  1722. #endif  /*  USERSPACE_INTERFACE  */
  1723. EXPORT_SYMBOL(mtrr_add);
  1724. EXPORT_SYMBOL(mtrr_del);
  1725. #ifdef CONFIG_SMP
  1726. typedef struct
  1727. {
  1728.     unsigned long base;
  1729.     unsigned long size;
  1730.     mtrr_type type;
  1731. } arr_state_t;
  1732. arr_state_t arr_state[8] __initdata =
  1733. {
  1734.     {0UL,0UL,0UL}, {0UL,0UL,0UL}, {0UL,0UL,0UL}, {0UL,0UL,0UL},
  1735.     {0UL,0UL,0UL}, {0UL,0UL,0UL}, {0UL,0UL,0UL}, {0UL,0UL,0UL}
  1736. };
  1737. unsigned char ccr_state[7] __initdata = { 0, 0, 0, 0, 0, 0, 0 };
  1738. static void __init cyrix_arr_init_secondary(void)
  1739. {
  1740.     struct set_mtrr_context ctxt;
  1741.     int i;
  1742.     /* flush cache and enable MAPEN */
  1743.     set_mtrr_prepare_save (&ctxt);
  1744.     set_mtrr_disable (&ctxt);
  1745.      /* the CCRs are not contiguous */
  1746.     for(i=0; i<4; i++) setCx86(CX86_CCR0 + i, ccr_state[i]);
  1747.     for(   ; i<7; i++) setCx86(CX86_CCR4 + i, ccr_state[i]);
  1748.     for(i=0; i<8; i++)
  1749.       cyrix_set_arr_up(i,
  1750.         arr_state[i].base, arr_state[i].size, arr_state[i].type, FALSE);
  1751.     set_mtrr_done (&ctxt); /* flush cache and disable MAPEN */
  1752. }   /*  End Function cyrix_arr_init_secondary  */
  1753. #endif
  1754. /*
  1755.  * On Cyrix 6x86(MX) and M II the ARR3 is special: it has connection
  1756.  * with the SMM (System Management Mode) mode. So we need the following:
  1757.  * Check whether SMI_LOCK (CCR3 bit 0) is set
  1758.  *   if it is set, write a warning message: ARR3 cannot be changed!
  1759.  *     (it cannot be changed until the next processor reset)
  1760.  *   if it is reset, then we can change it, set all the needed bits:
  1761.  *   - disable access to SMM memory through ARR3 range (CCR1 bit 7 reset)
  1762.  *   - disable access to SMM memory (CCR1 bit 2 reset)
  1763.  *   - disable SMM mode (CCR1 bit 1 reset)
  1764.  *   - disable write protection of ARR3 (CCR6 bit 1 reset)
  1765.  *   - (maybe) disable ARR3
  1766.  * Just to be sure, we enable ARR usage by the processor (CCR5 bit 5 set)
  1767.  */
  1768. static void __init cyrix_arr_init(void)
  1769. {
  1770.     struct set_mtrr_context ctxt;
  1771.     unsigned char ccr[7];
  1772.     int ccrc[7] = { 0, 0, 0, 0, 0, 0, 0 };
  1773. #ifdef CONFIG_SMP
  1774.     int i;
  1775. #endif
  1776.     /* flush cache and enable MAPEN */
  1777.     set_mtrr_prepare_save (&ctxt);
  1778.     set_mtrr_disable (&ctxt);
  1779.     /* Save all CCRs locally */
  1780.     ccr[0] = getCx86 (CX86_CCR0);
  1781.     ccr[1] = getCx86 (CX86_CCR1);
  1782.     ccr[2] = getCx86 (CX86_CCR2);
  1783.     ccr[3] = ctxt.ccr3;
  1784.     ccr[4] = getCx86 (CX86_CCR4);
  1785.     ccr[5] = getCx86 (CX86_CCR5);
  1786.     ccr[6] = getCx86 (CX86_CCR6);
  1787.     if (ccr[3] & 1)
  1788.     {
  1789. ccrc[3] = 1;
  1790. arr3_protected = 1;
  1791.     }
  1792.     else
  1793.     {
  1794. /* Disable SMM mode (bit 1), access to SMM memory (bit 2) and
  1795.  * access to SMM memory through ARR3 (bit 7).
  1796.  */
  1797. if (ccr[1] & 0x80) { ccr[1] &= 0x7f; ccrc[1] |= 0x80; }
  1798. if (ccr[1] & 0x04) { ccr[1] &= 0xfb; ccrc[1] |= 0x04; }
  1799. if (ccr[1] & 0x02) { ccr[1] &= 0xfd; ccrc[1] |= 0x02; }
  1800. arr3_protected = 0;
  1801. if (ccr[6] & 0x02) {
  1802.     ccr[6] &= 0xfd; ccrc[6] = 1; /* Disable write protection of ARR3 */
  1803.     setCx86 (CX86_CCR6, ccr[6]);
  1804. }
  1805. /* Disable ARR3. This is safe now that we disabled SMM. */
  1806. /* cyrix_set_arr_up (3, 0, 0, 0, FALSE); */
  1807.     }
  1808.     /* If we changed CCR1 in memory, change it in the processor, too. */
  1809.     if (ccrc[1]) setCx86 (CX86_CCR1, ccr[1]);
  1810.     /* Enable ARR usage by the processor */
  1811.     if (!(ccr[5] & 0x20))
  1812.     {
  1813. ccr[5] |= 0x20; ccrc[5] = 1;
  1814. setCx86 (CX86_CCR5, ccr[5]);
  1815.     }
  1816. #ifdef CONFIG_SMP
  1817.     for(i=0; i<7; i++) ccr_state[i] = ccr[i];
  1818.     for(i=0; i<8; i++)
  1819.       cyrix_get_arr(i,
  1820.         &arr_state[i].base, &arr_state[i].size, &arr_state[i].type);
  1821. #endif
  1822.     set_mtrr_done (&ctxt); /* flush cache and disable MAPEN */
  1823.     if ( ccrc[5] ) printk ("mtrr: ARR usage was not enabled, enabled manuallyn");
  1824.     if ( ccrc[3] ) printk ("mtrr: ARR3 cannot be changedn");
  1825. /*
  1826.     if ( ccrc[1] & 0x80) printk ("mtrr: SMM memory access through ARR3 disabledn");
  1827.     if ( ccrc[1] & 0x04) printk ("mtrr: SMM memory access disabledn");
  1828.     if ( ccrc[1] & 0x02) printk ("mtrr: SMM mode disabledn");
  1829. */
  1830.     if ( ccrc[6] ) printk ("mtrr: ARR3 was write protected, unprotectedn");
  1831. }   /*  End Function cyrix_arr_init  */
  1832. /*
  1833.  * Initialise the later (saner) Winchip MCR variant. In this version
  1834.  * the BIOS can pass us the registers it has used (but not their values)
  1835.  * and the control register is read/write
  1836.  */
  1837.  
  1838. static void __init centaur_mcr1_init(void)
  1839. {
  1840.     unsigned i;
  1841.     u32 lo, hi;
  1842.     /* Unfortunately, MCR's are read-only, so there is no way to
  1843.      * find out what the bios might have done.
  1844.      */
  1845.      
  1846.     rdmsr(MSR_IDT_MCR_CTRL, lo, hi);
  1847.     if(((lo>>17)&7)==1) /* Type 1 Winchip2 MCR */
  1848.     {
  1849.      lo&= ~0x1C0; /* clear key */
  1850.      lo|= 0x040; /* set key to 1 */
  1851. wrmsr(MSR_IDT_MCR_CTRL, lo, hi); /* unlock MCR */
  1852.     }    
  1853.     
  1854.     centaur_mcr_type = 1;
  1855.     
  1856.     /*
  1857.      * Clear any unconfigured MCR's.
  1858.      */
  1859.     for (i = 0; i < 8; ++i)
  1860.     {
  1861.      if(centaur_mcr[i]. high == 0 && centaur_mcr[i].low == 0)
  1862.      {
  1863.      if(!(lo & (1<<(9+i))))
  1864. wrmsr (MSR_IDT_MCR0 + i , 0, 0);
  1865. else
  1866. /*
  1867.  * If the BIOS set up an MCR we cannot see it
  1868.  * but we don't wish to obliterate it
  1869.  */
  1870. centaur_mcr_reserved |= (1<<i);
  1871. }
  1872.     }
  1873.     /*  
  1874.      * Throw the main write-combining switch... 
  1875.      * However if OOSTORE is enabled then people have already done far
  1876.      *  cleverer things and we should behave. 
  1877.      */
  1878.     lo |= 15; /* Write combine enables */
  1879.     wrmsr(MSR_IDT_MCR_CTRL, lo, hi);
  1880. }   /*  End Function centaur_mcr1_init  */
  1881. /*
  1882.  * Initialise the original winchip with read only MCR registers
  1883.  * no used bitmask for the BIOS to pass on and write only control
  1884.  */
  1885.  
  1886. static void __init centaur_mcr0_init(void)
  1887. {
  1888.     unsigned i;
  1889.     /* Unfortunately, MCR's are read-only, so there is no way to
  1890.      * find out what the bios might have done.
  1891.      */
  1892.      
  1893.     /* Clear any unconfigured MCR's.
  1894.      * This way we are sure that the centaur_mcr array contains the actual
  1895.      * values. The disadvantage is that any BIOS tweaks are thus undone.
  1896.      *
  1897.      */
  1898.     for (i = 0; i < 8; ++i)
  1899.     {
  1900.      if(centaur_mcr[i]. high == 0 && centaur_mcr[i].low == 0)
  1901. wrmsr (MSR_IDT_MCR0 + i , 0, 0);
  1902.     }
  1903.     wrmsr(MSR_IDT_MCR_CTRL, 0x01F0001F, 0); /* Write only */
  1904. }   /*  End Function centaur_mcr0_init  */
  1905. /*
  1906.  * Initialise Winchip series MCR registers
  1907.  */
  1908.  
  1909. static void __init centaur_mcr_init(void)
  1910. {
  1911.     struct set_mtrr_context ctxt;
  1912.     set_mtrr_prepare_save (&ctxt);
  1913.     set_mtrr_disable (&ctxt);
  1914.     if(boot_cpu_data.x86_model==4)
  1915.      centaur_mcr0_init();
  1916.     else if(boot_cpu_data.x86_model==8 || boot_cpu_data.x86_model == 9)
  1917.      centaur_mcr1_init();
  1918.     set_mtrr_done (&ctxt);
  1919. }   /*  End Function centaur_mcr_init  */
  1920. static int __init mtrr_setup(void)
  1921. {
  1922.     if ( test_bit(X86_FEATURE_MTRR, &boot_cpu_data.x86_capability) ) {
  1923. /* Intel (P6) standard MTRRs */
  1924. mtrr_if = MTRR_IF_INTEL;
  1925. get_mtrr = intel_get_mtrr;
  1926. set_mtrr_up = intel_set_mtrr_up;
  1927. switch (boot_cpu_data.x86_vendor) {
  1928. case X86_VENDOR_AMD:
  1929. /* The original Athlon docs said that
  1930.    total addressable memory is 44 bits wide.
  1931.    It was not really clear whether its MTRRs
  1932.    follow this or not. (Read: 44 or 36 bits).
  1933.    However, "x86-64_overview.pdf" explicitly
  1934.    states that "previous implementations support
  1935.    36 bit MTRRs" and also provides a way to
  1936.    query the width (in bits) of the physical
  1937.    addressable memory on the Hammer family.
  1938.  */
  1939. if (boot_cpu_data.x86 == 7 && (cpuid_eax(0x80000000) >= 0x80000008)) {
  1940. u32 phys_addr;
  1941. phys_addr = cpuid_eax(0x80000008) & 0xff ;
  1942. size_or_mask = ~((1 << (phys_addr - PAGE_SHIFT)) - 1);
  1943. size_and_mask = ~size_or_mask & 0xfff00000;
  1944. break;
  1945. }
  1946. size_or_mask  = 0xff000000; /* 36 bits */
  1947. size_and_mask = 0x00f00000;
  1948. break;
  1949. case X86_VENDOR_CENTAUR:
  1950. /* VIA Cyrix family have Intel style MTRRs, but don't support PAE */
  1951. if (boot_cpu_data.x86 == 6) {
  1952. size_or_mask  = 0xfff00000; /* 32 bits */
  1953. size_and_mask = 0;
  1954. }
  1955. break;
  1956. default:
  1957. /* Intel, etc. */
  1958. size_or_mask  = 0xff000000; /* 36 bits */
  1959. size_and_mask = 0x00f00000;
  1960. break;
  1961. }
  1962.     } else if ( test_bit(X86_FEATURE_K6_MTRR, &boot_cpu_data.x86_capability) ) {
  1963. /* Pre-Athlon (K6) AMD CPU MTRRs */
  1964. mtrr_if = MTRR_IF_AMD_K6;
  1965. get_mtrr = amd_get_mtrr;
  1966. set_mtrr_up = amd_set_mtrr_up;
  1967. size_or_mask  = 0xfff00000; /* 32 bits */
  1968. size_and_mask = 0;
  1969.     } else if ( test_bit(X86_FEATURE_CYRIX_ARR, &boot_cpu_data.x86_capability) ) {
  1970. /* Cyrix ARRs */
  1971. mtrr_if = MTRR_IF_CYRIX_ARR;
  1972. get_mtrr = cyrix_get_arr;
  1973. set_mtrr_up = cyrix_set_arr_up;
  1974. get_free_region = cyrix_get_free_region;
  1975. cyrix_arr_init();
  1976. size_or_mask  = 0xfff00000; /* 32 bits */
  1977. size_and_mask = 0;
  1978.     } else if ( test_bit(X86_FEATURE_CENTAUR_MCR, &boot_cpu_data.x86_capability) ) {
  1979. /* Centaur MCRs */
  1980. mtrr_if = MTRR_IF_CENTAUR_MCR;
  1981. get_mtrr = centaur_get_mcr;
  1982. set_mtrr_up = centaur_set_mcr_up;
  1983. get_free_region = centaur_get_free_region;
  1984. centaur_mcr_init();
  1985. size_or_mask  = 0xfff00000; /* 32 bits */
  1986. size_and_mask = 0;
  1987.     } else {
  1988. /* No supported MTRR interface */
  1989. mtrr_if = MTRR_IF_NONE;
  1990.     }
  1991.     printk ("mtrr: v%s Richard Gooch (rgooch@atnf.csiro.au)n"
  1992.     "mtrr: detected mtrr type: %sn",
  1993.     MTRR_VERSION, mtrr_if_name[mtrr_if]);
  1994.     return (mtrr_if != MTRR_IF_NONE);
  1995. }   /*  End Function mtrr_setup  */
  1996. #ifdef CONFIG_SMP
  1997. static volatile unsigned long smp_changes_mask __initdata = 0;
  1998. static struct mtrr_state smp_mtrr_state __initdata = {0, 0};
  1999. void __init mtrr_init_boot_cpu(void)
  2000. {
  2001.     if ( !mtrr_setup () )
  2002. return;
  2003.     if ( mtrr_if == MTRR_IF_INTEL ) {
  2004. /* Only for Intel MTRRs */
  2005. get_mtrr_state (&smp_mtrr_state);
  2006.     }
  2007. }   /*  End Function mtrr_init_boot_cpu  */
  2008. static void __init intel_mtrr_init_secondary_cpu(void)
  2009. {
  2010.     unsigned long mask, count;
  2011.     struct set_mtrr_context ctxt;
  2012.     /*  Note that this is not ideal, since the cache is only flushed/disabled
  2013. for this CPU while the MTRRs are changed, but changing this requires
  2014. more invasive changes to the way the kernel boots  */
  2015.     set_mtrr_prepare_save (&ctxt);
  2016.     set_mtrr_disable (&ctxt);
  2017.     mask = set_mtrr_state (&smp_mtrr_state, &ctxt);
  2018.     set_mtrr_done (&ctxt);
  2019.     /*  Use the atomic bitops to update the global mask  */
  2020.     for (count = 0; count < sizeof mask * 8; ++count)
  2021.     {
  2022. if (mask & 0x01) set_bit (count, &smp_changes_mask);
  2023. mask >>= 1;
  2024.     }
  2025. }   /*  End Function intel_mtrr_init_secondary_cpu  */
  2026. void __init mtrr_init_secondary_cpu(void)
  2027. {
  2028.     switch ( mtrr_if ) {
  2029.     case MTRR_IF_INTEL:
  2030. /* Intel (P6) standard MTRRs */
  2031. intel_mtrr_init_secondary_cpu();
  2032. break;
  2033.     case MTRR_IF_CYRIX_ARR:
  2034. /* This is _completely theoretical_!
  2035.  * I assume here that one day Cyrix will support Intel APIC.
  2036.  * In reality on non-Intel CPUs we won't even get to this routine.
  2037.  * Hopefully no one will plug two Cyrix processors in a dual P5 board.
  2038.  *  :-)
  2039.  */
  2040. cyrix_arr_init_secondary ();
  2041. break;
  2042.     case MTRR_IF_NONE:
  2043. break;
  2044.     default:
  2045. /* I see no MTRRs I can support in SMP mode... */
  2046. printk ("mtrr: SMP support incomplete for this vendorn");
  2047.     }
  2048. }   /*  End Function mtrr_init_secondary_cpu  */
  2049. #endif  /*  CONFIG_SMP  */
  2050. int __init mtrr_init(void)
  2051. {
  2052. #ifdef CONFIG_SMP
  2053.     /* mtrr_setup() should already have been called from mtrr_init_boot_cpu() */
  2054.     if ( mtrr_if == MTRR_IF_INTEL ) {
  2055. finalize_mtrr_state (&smp_mtrr_state);
  2056. mtrr_state_warn (smp_changes_mask);
  2057.     }
  2058. #else
  2059.     if ( !mtrr_setup() )
  2060. return 0; /* MTRRs not supported? */
  2061. #endif
  2062. #ifdef CONFIG_PROC_FS
  2063.     proc_root_mtrr = create_proc_entry ("mtrr", S_IWUSR | S_IRUGO, &proc_root);
  2064.     if (proc_root_mtrr) {
  2065. proc_root_mtrr->owner = THIS_MODULE;
  2066. proc_root_mtrr->proc_fops = &mtrr_fops;
  2067.     }
  2068. #endif
  2069. #ifdef USERSPACE_INTERFACE
  2070.     devfs_handle = devfs_register (NULL, "cpu/mtrr", DEVFS_FL_DEFAULT, 0, 0,
  2071.    S_IFREG | S_IRUGO | S_IWUSR,
  2072.    &mtrr_fops, NULL);
  2073. #endif
  2074.     init_table ();
  2075.     return 0;
  2076. }   /*  End Function mtrr_init  */
  2077. /*
  2078.  * Local Variables:
  2079.  * mode:c
  2080.  * c-file-style:"k&r"
  2081.  * c-basic-offset:4
  2082.  * End:
  2083.  */