diff options
| author | Linus Torvalds <torvalds@linux-foundation.org> | 2014-01-20 15:09:31 -0500 |
|---|---|---|
| committer | Linus Torvalds <torvalds@linux-foundation.org> | 2014-01-20 15:09:31 -0500 |
| commit | 74e8ee8262c3f93bbc41804037b43f07b95897bb (patch) | |
| tree | 03c713506de19f5f9fd7634c04a19b9534ed0962 | |
| parent | 8bd6964cbd177de731b4b3ff624ef7fb6eaca15c (diff) | |
| parent | ca1e631c3acf80bc5f5934ce9054a9b4880c96e1 (diff) | |
Merge branch 'x86-platform-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip
Pull Intel SoC changes from Ingo Molnar:
"Improved Intel SoC platform support"
* 'x86-platform-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip:
x86, tsc, apic: Unbreak static (MSR) calibration when CONFIG_X86_LOCAL_APIC=n
x86, tsc: Add static (MSR) TSC calibration on Intel Atom SoCs
arch: x86: New MailBox support driver for Intel SOC's
| -rw-r--r-- | arch/x86/Kconfig | 8 | ||||
| -rw-r--r-- | arch/x86/include/asm/iosf_mbi.h | 90 | ||||
| -rw-r--r-- | arch/x86/include/asm/tsc.h | 3 | ||||
| -rw-r--r-- | arch/x86/kernel/Makefile | 3 | ||||
| -rw-r--r-- | arch/x86/kernel/iosf_mbi.c | 226 | ||||
| -rw-r--r-- | arch/x86/kernel/tsc.c | 10 | ||||
| -rw-r--r-- | arch/x86/kernel/tsc_msr.c | 127 |
7 files changed, 466 insertions, 1 deletions
diff --git a/arch/x86/Kconfig b/arch/x86/Kconfig index 6a990e2107f5..5216e283820d 100644 --- a/arch/x86/Kconfig +++ b/arch/x86/Kconfig | |||
| @@ -2358,6 +2358,14 @@ config X86_DMA_REMAP | |||
| 2358 | bool | 2358 | bool |
| 2359 | depends on STA2X11 | 2359 | depends on STA2X11 |
| 2360 | 2360 | ||
| 2361 | config IOSF_MBI | ||
| 2362 | bool | ||
| 2363 | depends on PCI | ||
| 2364 | ---help--- | ||
| 2365 | To be selected by modules requiring access to the Intel OnChip System | ||
| 2366 | Fabric (IOSF) Sideband MailBox Interface (MBI). For MBI platforms | ||
| 2367 | enumerable by PCI. | ||
| 2368 | |||
| 2361 | source "net/Kconfig" | 2369 | source "net/Kconfig" |
| 2362 | 2370 | ||
| 2363 | source "drivers/Kconfig" | 2371 | source "drivers/Kconfig" |
diff --git a/arch/x86/include/asm/iosf_mbi.h b/arch/x86/include/asm/iosf_mbi.h new file mode 100644 index 000000000000..8e71c7941767 --- /dev/null +++ b/arch/x86/include/asm/iosf_mbi.h | |||
| @@ -0,0 +1,90 @@ | |||
| 1 | /* | ||
| 2 | * iosf_mbi.h: Intel OnChip System Fabric MailBox access support | ||
| 3 | */ | ||
| 4 | |||
| 5 | #ifndef IOSF_MBI_SYMS_H | ||
| 6 | #define IOSF_MBI_SYMS_H | ||
| 7 | |||
| 8 | #define MBI_MCR_OFFSET 0xD0 | ||
| 9 | #define MBI_MDR_OFFSET 0xD4 | ||
| 10 | #define MBI_MCRX_OFFSET 0xD8 | ||
| 11 | |||
| 12 | #define MBI_RD_MASK 0xFEFFFFFF | ||
| 13 | #define MBI_WR_MASK 0X01000000 | ||
| 14 | |||
| 15 | #define MBI_MASK_HI 0xFFFFFF00 | ||
| 16 | #define MBI_MASK_LO 0x000000FF | ||
| 17 | #define MBI_ENABLE 0xF0 | ||
| 18 | |||
| 19 | /* Baytrail available units */ | ||
| 20 | #define BT_MBI_UNIT_AUNIT 0x00 | ||
| 21 | #define BT_MBI_UNIT_SMC 0x01 | ||
| 22 | #define BT_MBI_UNIT_CPU 0x02 | ||
| 23 | #define BT_MBI_UNIT_BUNIT 0x03 | ||
| 24 | #define BT_MBI_UNIT_PMC 0x04 | ||
| 25 | #define BT_MBI_UNIT_GFX 0x06 | ||
| 26 | #define BT_MBI_UNIT_SMI 0x0C | ||
| 27 | #define BT_MBI_UNIT_USB 0x43 | ||
| 28 | #define BT_MBI_UNIT_SATA 0xA3 | ||
| 29 | #define BT_MBI_UNIT_PCIE 0xA6 | ||
| 30 | |||
| 31 | /* Baytrail read/write opcodes */ | ||
| 32 | #define BT_MBI_AUNIT_READ 0x10 | ||
| 33 | #define BT_MBI_AUNIT_WRITE 0x11 | ||
| 34 | #define BT_MBI_SMC_READ 0x10 | ||
| 35 | #define BT_MBI_SMC_WRITE 0x11 | ||
| 36 | #define BT_MBI_CPU_READ 0x10 | ||
| 37 | #define BT_MBI_CPU_WRITE 0x11 | ||
| 38 | #define BT_MBI_BUNIT_READ 0x10 | ||
| 39 | #define BT_MBI_BUNIT_WRITE 0x11 | ||
| 40 | #define BT_MBI_PMC_READ 0x06 | ||
| 41 | #define BT_MBI_PMC_WRITE 0x07 | ||
| 42 | #define BT_MBI_GFX_READ 0x00 | ||
| 43 | #define BT_MBI_GFX_WRITE 0x01 | ||
| 44 | #define BT_MBI_SMIO_READ 0x06 | ||
| 45 | #define BT_MBI_SMIO_WRITE 0x07 | ||
| 46 | #define BT_MBI_USB_READ 0x06 | ||
| 47 | #define BT_MBI_USB_WRITE 0x07 | ||
| 48 | #define BT_MBI_SATA_READ 0x00 | ||
| 49 | #define BT_MBI_SATA_WRITE 0x01 | ||
| 50 | #define BT_MBI_PCIE_READ 0x00 | ||
| 51 | #define BT_MBI_PCIE_WRITE 0x01 | ||
| 52 | |||
| 53 | /** | ||
| 54 | * iosf_mbi_read() - MailBox Interface read command | ||
| 55 | * @port: port indicating subunit being accessed | ||
| 56 | * @opcode: port specific read or write opcode | ||
| 57 | * @offset: register address offset | ||
| 58 | * @mdr: register data to be read | ||
| 59 | * | ||
| 60 | * Locking is handled by spinlock - cannot sleep. | ||
| 61 | * Return: Nonzero on error | ||
| 62 | */ | ||
| 63 | int iosf_mbi_read(u8 port, u8 opcode, u32 offset, u32 *mdr); | ||
| 64 | |||
| 65 | /** | ||
| 66 | * iosf_mbi_write() - MailBox unmasked write command | ||
| 67 | * @port: port indicating subunit being accessed | ||
| 68 | * @opcode: port specific read or write opcode | ||
| 69 | * @offset: register address offset | ||
| 70 | * @mdr: register data to be written | ||
| 71 | * | ||
| 72 | * Locking is handled by spinlock - cannot sleep. | ||
| 73 | * Return: Nonzero on error | ||
| 74 | */ | ||
| 75 | int iosf_mbi_write(u8 port, u8 opcode, u32 offset, u32 mdr); | ||
| 76 | |||
| 77 | /** | ||
| 78 | * iosf_mbi_modify() - MailBox masked write command | ||
| 79 | * @port: port indicating subunit being accessed | ||
| 80 | * @opcode: port specific read or write opcode | ||
| 81 | * @offset: register address offset | ||
| 82 | * @mdr: register data being modified | ||
| 83 | * @mask: mask indicating bits in mdr to be modified | ||
| 84 | * | ||
| 85 | * Locking is handled by spinlock - cannot sleep. | ||
| 86 | * Return: Nonzero on error | ||
| 87 | */ | ||
| 88 | int iosf_mbi_modify(u8 port, u8 opcode, u32 offset, u32 mdr, u32 mask); | ||
| 89 | |||
| 90 | #endif /* IOSF_MBI_SYMS_H */ | ||
diff --git a/arch/x86/include/asm/tsc.h b/arch/x86/include/asm/tsc.h index 235be70d5bb4..57ae63cd6ee2 100644 --- a/arch/x86/include/asm/tsc.h +++ b/arch/x86/include/asm/tsc.h | |||
| @@ -65,4 +65,7 @@ extern int notsc_setup(char *); | |||
| 65 | extern void tsc_save_sched_clock_state(void); | 65 | extern void tsc_save_sched_clock_state(void); |
| 66 | extern void tsc_restore_sched_clock_state(void); | 66 | extern void tsc_restore_sched_clock_state(void); |
| 67 | 67 | ||
| 68 | /* MSR based TSC calibration for Intel Atom SoC platforms */ | ||
| 69 | int try_msr_calibrate_tsc(unsigned long *fast_calibrate); | ||
| 70 | |||
| 68 | #endif /* _ASM_X86_TSC_H */ | 71 | #endif /* _ASM_X86_TSC_H */ |
diff --git a/arch/x86/kernel/Makefile b/arch/x86/kernel/Makefile index 4b7b9273100a..cb648c84b327 100644 --- a/arch/x86/kernel/Makefile +++ b/arch/x86/kernel/Makefile | |||
| @@ -33,7 +33,7 @@ obj-$(CONFIG_SYSFS) += ksysfs.o | |||
| 33 | obj-y += bootflag.o e820.o | 33 | obj-y += bootflag.o e820.o |
| 34 | obj-y += pci-dma.o quirks.o topology.o kdebugfs.o | 34 | obj-y += pci-dma.o quirks.o topology.o kdebugfs.o |
| 35 | obj-y += alternative.o i8253.o pci-nommu.o hw_breakpoint.o | 35 | obj-y += alternative.o i8253.o pci-nommu.o hw_breakpoint.o |
| 36 | obj-y += tsc.o io_delay.o rtc.o | 36 | obj-y += tsc.o tsc_msr.o io_delay.o rtc.o |
| 37 | obj-y += pci-iommu_table.o | 37 | obj-y += pci-iommu_table.o |
| 38 | obj-y += resource.o | 38 | obj-y += resource.o |
| 39 | 39 | ||
| @@ -103,6 +103,7 @@ obj-$(CONFIG_EFI) += sysfb_efi.o | |||
| 103 | 103 | ||
| 104 | obj-$(CONFIG_PERF_EVENTS) += perf_regs.o | 104 | obj-$(CONFIG_PERF_EVENTS) += perf_regs.o |
| 105 | obj-$(CONFIG_TRACING) += tracepoint.o | 105 | obj-$(CONFIG_TRACING) += tracepoint.o |
| 106 | obj-$(CONFIG_IOSF_MBI) += iosf_mbi.o | ||
| 106 | 107 | ||
| 107 | ### | 108 | ### |
| 108 | # 64 bit specific files | 109 | # 64 bit specific files |
diff --git a/arch/x86/kernel/iosf_mbi.c b/arch/x86/kernel/iosf_mbi.c new file mode 100644 index 000000000000..c3aae6672843 --- /dev/null +++ b/arch/x86/kernel/iosf_mbi.c | |||
| @@ -0,0 +1,226 @@ | |||
| 1 | /* | ||
| 2 | * IOSF-SB MailBox Interface Driver | ||
| 3 | * Copyright (c) 2013, Intel Corporation. | ||
| 4 | * | ||
| 5 | * This program is free software; you can redistribute it and/or modify it | ||
| 6 | * under the terms and conditions of the GNU General Public License, | ||
| 7 | * version 2, as published by the Free Software Foundation. | ||
| 8 | * | ||
| 9 | * This program is distributed in the hope it will be useful, but WITHOUT | ||
| 10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | ||
| 11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | ||
| 12 | * more details. | ||
| 13 | * | ||
| 14 | * | ||
| 15 | * The IOSF-SB is a fabric bus available on Atom based SOC's that uses a | ||
| 16 | * mailbox interface (MBI) to communicate with mutiple devices. This | ||
| 17 | * driver implements access to this interface for those platforms that can | ||
| 18 | * enumerate the device using PCI. | ||
| 19 | */ | ||
| 20 | |||
| 21 | #include <linux/module.h> | ||
| 22 | #include <linux/init.h> | ||
| 23 | #include <linux/spinlock.h> | ||
| 24 | #include <linux/pci.h> | ||
| 25 | |||
| 26 | #include <asm/iosf_mbi.h> | ||
| 27 | |||
| 28 | static DEFINE_SPINLOCK(iosf_mbi_lock); | ||
| 29 | |||
| 30 | static inline u32 iosf_mbi_form_mcr(u8 op, u8 port, u8 offset) | ||
| 31 | { | ||
| 32 | return (op << 24) | (port << 16) | (offset << 8) | MBI_ENABLE; | ||
| 33 | } | ||
| 34 | |||
| 35 | static struct pci_dev *mbi_pdev; /* one mbi device */ | ||
| 36 | |||
| 37 | static int iosf_mbi_pci_read_mdr(u32 mcrx, u32 mcr, u32 *mdr) | ||
| 38 | { | ||
| 39 | int result; | ||
| 40 | |||
| 41 | if (!mbi_pdev) | ||
| 42 | return -ENODEV; | ||
| 43 | |||
| 44 | if (mcrx) { | ||
| 45 | result = pci_write_config_dword(mbi_pdev, MBI_MCRX_OFFSET, | ||
| 46 | mcrx); | ||
| 47 | if (result < 0) | ||
| 48 | goto fail_read; | ||
| 49 | } | ||
| 50 | |||
| 51 | result = pci_write_config_dword(mbi_pdev, MBI_MCR_OFFSET, mcr); | ||
| 52 | if (result < 0) | ||
| 53 | goto fail_read; | ||
| 54 | |||
| 55 | result = pci_read_config_dword(mbi_pdev, MBI_MDR_OFFSET, mdr); | ||
| 56 | if (result < 0) | ||
| 57 | goto fail_read; | ||
| 58 | |||
| 59 | return 0; | ||
| 60 | |||
| 61 | fail_read: | ||
| 62 | dev_err(&mbi_pdev->dev, "PCI config access failed with %d\n", result); | ||
| 63 | return result; | ||
| 64 | } | ||
| 65 | |||
| 66 | static int iosf_mbi_pci_write_mdr(u32 mcrx, u32 mcr, u32 mdr) | ||
| 67 | { | ||
| 68 | int result; | ||
| 69 | |||
| 70 | if (!mbi_pdev) | ||
| 71 | return -ENODEV; | ||
| 72 | |||
| 73 | result = pci_write_config_dword(mbi_pdev, MBI_MDR_OFFSET, mdr); | ||
| 74 | if (result < 0) | ||
| 75 | goto fail_write; | ||
| 76 | |||
| 77 | if (mcrx) { | ||
| 78 | result = pci_write_config_dword(mbi_pdev, MBI_MCRX_OFFSET, | ||
| 79 | mcrx); | ||
| 80 | if (result < 0) | ||
| 81 | goto fail_write; | ||
| 82 | } | ||
| 83 | |||
| 84 | result = pci_write_config_dword(mbi_pdev, MBI_MCR_OFFSET, mcr); | ||
| 85 | if (result < 0) | ||
| 86 | goto fail_write; | ||
| 87 | |||
| 88 | return 0; | ||
| 89 | |||
| 90 | fail_write: | ||
| 91 | dev_err(&mbi_pdev->dev, "PCI config access failed with %d\n", result); | ||
| 92 | return result; | ||
| 93 | } | ||
| 94 | |||
| 95 | int iosf_mbi_read(u8 port, u8 opcode, u32 offset, u32 *mdr) | ||
| 96 | { | ||
| 97 | u32 mcr, mcrx; | ||
| 98 | unsigned long flags; | ||
| 99 | int ret; | ||
| 100 | |||
| 101 | /*Access to the GFX unit is handled by GPU code */ | ||
| 102 | if (port == BT_MBI_UNIT_GFX) { | ||
| 103 | WARN_ON(1); | ||
| 104 | return -EPERM; | ||
| 105 | } | ||
| 106 | |||
| 107 | mcr = iosf_mbi_form_mcr(opcode, port, offset & MBI_MASK_LO); | ||
| 108 | mcrx = offset & MBI_MASK_HI; | ||
| 109 | |||
| 110 | spin_lock_irqsave(&iosf_mbi_lock, flags); | ||
| 111 | ret = iosf_mbi_pci_read_mdr(mcrx, mcr, mdr); | ||
| 112 | spin_unlock_irqrestore(&iosf_mbi_lock, flags); | ||
| 113 | |||
| 114 | return ret; | ||
| 115 | } | ||
| 116 | EXPORT_SYMBOL(iosf_mbi_read); | ||
| 117 | |||
| 118 | int iosf_mbi_write(u8 port, u8 opcode, u32 offset, u32 mdr) | ||
| 119 | { | ||
| 120 | u32 mcr, mcrx; | ||
| 121 | unsigned long flags; | ||
| 122 | int ret; | ||
| 123 | |||
| 124 | /*Access to the GFX unit is handled by GPU code */ | ||
| 125 | if (port == BT_MBI_UNIT_GFX) { | ||
| 126 | WARN_ON(1); | ||
| 127 | return -EPERM; | ||
| 128 | } | ||
| 129 | |||
| 130 | mcr = iosf_mbi_form_mcr(opcode, port, offset & MBI_MASK_LO); | ||
| 131 | mcrx = offset & MBI_MASK_HI; | ||
| 132 | |||
| 133 | spin_lock_irqsave(&iosf_mbi_lock, flags); | ||
| 134 | ret = iosf_mbi_pci_write_mdr(mcrx, mcr, mdr); | ||
| 135 | spin_unlock_irqrestore(&iosf_mbi_lock, flags); | ||
| 136 | |||
| 137 | return ret; | ||
| 138 | } | ||
| 139 | EXPORT_SYMBOL(iosf_mbi_write); | ||
| 140 | |||
| 141 | int iosf_mbi_modify(u8 port, u8 opcode, u32 offset, u32 mdr, u32 mask) | ||
| 142 | { | ||
| 143 | u32 mcr, mcrx; | ||
| 144 | u32 value; | ||
| 145 | unsigned long flags; | ||
| 146 | int ret; | ||
| 147 | |||
| 148 | /*Access to the GFX unit is handled by GPU code */ | ||
| 149 | if (port == BT_MBI_UNIT_GFX) { | ||
| 150 | WARN_ON(1); | ||
| 151 | return -EPERM; | ||
| 152 | } | ||
| 153 | |||
| 154 | mcr = iosf_mbi_form_mcr(opcode, port, offset & MBI_MASK_LO); | ||
| 155 | mcrx = offset & MBI_MASK_HI; | ||
| 156 | |||
| 157 | spin_lock_irqsave(&iosf_mbi_lock, flags); | ||
| 158 | |||
| 159 | /* Read current mdr value */ | ||
| 160 | ret = iosf_mbi_pci_read_mdr(mcrx, mcr & MBI_RD_MASK, &value); | ||
| 161 | if (ret < 0) { | ||
| 162 | spin_unlock_irqrestore(&iosf_mbi_lock, flags); | ||
| 163 | return ret; | ||
| 164 | } | ||
| 165 | |||
| 166 | /* Apply mask */ | ||
| 167 | value &= ~mask; | ||
| 168 | mdr &= mask; | ||
| 169 | value |= mdr; | ||
| 170 | |||
| 171 | /* Write back */ | ||
| 172 | ret = iosf_mbi_pci_write_mdr(mcrx, mcr | MBI_WR_MASK, value); | ||
| 173 | |||
| 174 | spin_unlock_irqrestore(&iosf_mbi_lock, flags); | ||
| 175 | |||
| 176 | return ret; | ||
| 177 | } | ||
| 178 | EXPORT_SYMBOL(iosf_mbi_modify); | ||
| 179 | |||
| 180 | static int iosf_mbi_probe(struct pci_dev *pdev, | ||
| 181 | const struct pci_device_id *unused) | ||
| 182 | { | ||
| 183 | int ret; | ||
| 184 | |||
| 185 | ret = pci_enable_device(pdev); | ||
| 186 | if (ret < 0) { | ||
| 187 | dev_err(&pdev->dev, "error: could not enable device\n"); | ||
| 188 | return ret; | ||
| 189 | } | ||
| 190 | |||
| 191 | mbi_pdev = pci_dev_get(pdev); | ||
| 192 | return 0; | ||
| 193 | } | ||
| 194 | |||
| 195 | static DEFINE_PCI_DEVICE_TABLE(iosf_mbi_pci_ids) = { | ||
| 196 | { PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x0F00) }, | ||
| 197 | { 0, }, | ||
| 198 | }; | ||
| 199 | MODULE_DEVICE_TABLE(pci, iosf_mbi_pci_ids); | ||
| 200 | |||
| 201 | static struct pci_driver iosf_mbi_pci_driver = { | ||
| 202 | .name = "iosf_mbi_pci", | ||
| 203 | .probe = iosf_mbi_probe, | ||
| 204 | .id_table = iosf_mbi_pci_ids, | ||
| 205 | }; | ||
| 206 | |||
| 207 | static int __init iosf_mbi_init(void) | ||
| 208 | { | ||
| 209 | return pci_register_driver(&iosf_mbi_pci_driver); | ||
| 210 | } | ||
| 211 | |||
| 212 | static void __exit iosf_mbi_exit(void) | ||
| 213 | { | ||
| 214 | pci_unregister_driver(&iosf_mbi_pci_driver); | ||
| 215 | if (mbi_pdev) { | ||
| 216 | pci_dev_put(mbi_pdev); | ||
| 217 | mbi_pdev = NULL; | ||
| 218 | } | ||
| 219 | } | ||
| 220 | |||
| 221 | module_init(iosf_mbi_init); | ||
| 222 | module_exit(iosf_mbi_exit); | ||
| 223 | |||
| 224 | MODULE_AUTHOR("David E. Box <david.e.box@linux.intel.com>"); | ||
| 225 | MODULE_DESCRIPTION("IOSF Mailbox Interface accessor"); | ||
| 226 | MODULE_LICENSE("GPL v2"); | ||
diff --git a/arch/x86/kernel/tsc.c b/arch/x86/kernel/tsc.c index 6377fb28b958..a3acbac2ee72 100644 --- a/arch/x86/kernel/tsc.c +++ b/arch/x86/kernel/tsc.c | |||
| @@ -651,6 +651,16 @@ unsigned long native_calibrate_tsc(void) | |||
| 651 | unsigned long flags, latch, ms, fast_calibrate; | 651 | unsigned long flags, latch, ms, fast_calibrate; |
| 652 | int hpet = is_hpet_enabled(), i, loopmin; | 652 | int hpet = is_hpet_enabled(), i, loopmin; |
| 653 | 653 | ||
| 654 | /* Calibrate TSC using MSR for Intel Atom SoCs */ | ||
| 655 | local_irq_save(flags); | ||
| 656 | i = try_msr_calibrate_tsc(&fast_calibrate); | ||
| 657 | local_irq_restore(flags); | ||
| 658 | if (i >= 0) { | ||
| 659 | if (i == 0) | ||
| 660 | pr_warn("Fast TSC calibration using MSR failed\n"); | ||
| 661 | return fast_calibrate; | ||
| 662 | } | ||
| 663 | |||
| 654 | local_irq_save(flags); | 664 | local_irq_save(flags); |
| 655 | fast_calibrate = quick_pit_calibrate(); | 665 | fast_calibrate = quick_pit_calibrate(); |
| 656 | local_irq_restore(flags); | 666 | local_irq_restore(flags); |
diff --git a/arch/x86/kernel/tsc_msr.c b/arch/x86/kernel/tsc_msr.c new file mode 100644 index 000000000000..8b5434f4389f --- /dev/null +++ b/arch/x86/kernel/tsc_msr.c | |||
| @@ -0,0 +1,127 @@ | |||
| 1 | /* | ||
| 2 | * tsc_msr.c - MSR based TSC calibration on Intel Atom SoC platforms. | ||
| 3 | * | ||
| 4 | * TSC in Intel Atom SoC runs at a constant rate which can be figured | ||
| 5 | * by this formula: | ||
| 6 | * <maximum core-clock to bus-clock ratio> * <maximum resolved frequency> | ||
| 7 | * See Intel 64 and IA-32 System Programming Guid section 16.12 and 30.11.5 | ||
| 8 | * for details. | ||
| 9 | * Especially some Intel Atom SoCs don't have PIT(i8254) or HPET, so MSR | ||
| 10 | * based calibration is the only option. | ||
| 11 | * | ||
| 12 | * | ||
| 13 | * Copyright (C) 2013 Intel Corporation | ||
| 14 | * Author: Bin Gao <bin.gao@intel.com> | ||
| 15 | * | ||
| 16 | * This file is released under the GPLv2. | ||
| 17 | */ | ||
| 18 | |||
| 19 | #include <linux/kernel.h> | ||
| 20 | #include <asm/processor.h> | ||
| 21 | #include <asm/setup.h> | ||
| 22 | #include <asm/apic.h> | ||
| 23 | #include <asm/param.h> | ||
| 24 | |||
| 25 | /* CPU reference clock frequency: in KHz */ | ||
| 26 | #define FREQ_83 83200 | ||
| 27 | #define FREQ_100 99840 | ||
| 28 | #define FREQ_133 133200 | ||
| 29 | #define FREQ_166 166400 | ||
| 30 | |||
| 31 | #define MAX_NUM_FREQS 8 | ||
| 32 | |||
| 33 | /* | ||
| 34 | * According to Intel 64 and IA-32 System Programming Guide, | ||
| 35 | * if MSR_PERF_STAT[31] is set, the maximum resolved bus ratio can be | ||
| 36 | * read in MSR_PLATFORM_ID[12:8], otherwise in MSR_PERF_STAT[44:40]. | ||
| 37 | * Unfortunately some Intel Atom SoCs aren't quite compliant to this, | ||
| 38 | * so we need manually differentiate SoC families. This is what the | ||
| 39 | * field msr_plat does. | ||
| 40 | */ | ||
| 41 | struct freq_desc { | ||
| 42 | u8 x86_family; /* CPU family */ | ||
| 43 | u8 x86_model; /* model */ | ||
| 44 | u8 msr_plat; /* 1: use MSR_PLATFORM_INFO, 0: MSR_IA32_PERF_STATUS */ | ||
| 45 | u32 freqs[MAX_NUM_FREQS]; | ||
| 46 | }; | ||
| 47 | |||
| 48 | static struct freq_desc freq_desc_tables[] = { | ||
| 49 | /* PNW */ | ||
| 50 | { 6, 0x27, 0, { 0, 0, 0, 0, 0, FREQ_100, 0, FREQ_83 } }, | ||
| 51 | /* CLV+ */ | ||
| 52 | { 6, 0x35, 0, { 0, FREQ_133, 0, 0, 0, FREQ_100, 0, FREQ_83 } }, | ||
| 53 | /* TNG */ | ||
| 54 | { 6, 0x4a, 1, { 0, FREQ_100, FREQ_133, 0, 0, 0, 0, 0 } }, | ||
| 55 | /* VLV2 */ | ||
| 56 | { 6, 0x37, 1, { 0, FREQ_100, FREQ_133, FREQ_166, 0, 0, 0, 0 } }, | ||
| 57 | /* ANN */ | ||
| 58 | { 6, 0x5a, 1, { FREQ_83, FREQ_100, FREQ_133, FREQ_100, 0, 0, 0, 0 } }, | ||
| 59 | }; | ||
| 60 | |||
| 61 | static int match_cpu(u8 family, u8 model) | ||
| 62 | { | ||
| 63 | int i; | ||
| 64 | |||
| 65 | for (i = 0; i < ARRAY_SIZE(freq_desc_tables); i++) { | ||
| 66 | if ((family == freq_desc_tables[i].x86_family) && | ||
| 67 | (model == freq_desc_tables[i].x86_model)) | ||
| 68 | return i; | ||
| 69 | } | ||
| 70 | |||
| 71 | return -1; | ||
| 72 | } | ||
| 73 | |||
| 74 | /* Map CPU reference clock freq ID(0-7) to CPU reference clock freq(KHz) */ | ||
| 75 | #define id_to_freq(cpu_index, freq_id) \ | ||
| 76 | (freq_desc_tables[cpu_index].freqs[freq_id]) | ||
| 77 | |||
| 78 | /* | ||
| 79 | * Do MSR calibration only for known/supported CPUs. | ||
| 80 | * Return values: | ||
| 81 | * -1: CPU is unknown/unsupported for MSR based calibration | ||
| 82 | * 0: CPU is known/supported, but calibration failed | ||
| 83 | * 1: CPU is known/supported, and calibration succeeded | ||
| 84 | */ | ||
| 85 | int try_msr_calibrate_tsc(unsigned long *fast_calibrate) | ||
| 86 | { | ||
| 87 | int cpu_index; | ||
| 88 | u32 lo, hi, ratio, freq_id, freq; | ||
| 89 | |||
| 90 | cpu_index = match_cpu(boot_cpu_data.x86, boot_cpu_data.x86_model); | ||
| 91 | if (cpu_index < 0) | ||
| 92 | return -1; | ||
| 93 | |||
| 94 | *fast_calibrate = 0; | ||
| 95 | |||
| 96 | if (freq_desc_tables[cpu_index].msr_plat) { | ||
| 97 | rdmsr(MSR_PLATFORM_INFO, lo, hi); | ||
| 98 | ratio = (lo >> 8) & 0x1f; | ||
| 99 | } else { | ||
| 100 | rdmsr(MSR_IA32_PERF_STATUS, lo, hi); | ||
| 101 | ratio = (hi >> 8) & 0x1f; | ||
| 102 | } | ||
| 103 | pr_info("Maximum core-clock to bus-clock ratio: 0x%x\n", ratio); | ||
| 104 | |||
| 105 | if (!ratio) | ||
| 106 | return 0; | ||
| 107 | |||
| 108 | /* Get FSB FREQ ID */ | ||
| 109 | rdmsr(MSR_FSB_FREQ, lo, hi); | ||
| 110 | freq_id = lo & 0x7; | ||
| 111 | freq = id_to_freq(cpu_index, freq_id); | ||
| 112 | pr_info("Resolved frequency ID: %u, frequency: %u KHz\n", | ||
| 113 | freq_id, freq); | ||
| 114 | if (!freq) | ||
| 115 | return 0; | ||
| 116 | |||
| 117 | /* TSC frequency = maximum resolved freq * maximum resolved bus ratio */ | ||
| 118 | *fast_calibrate = freq * ratio; | ||
| 119 | pr_info("TSC runs at %lu KHz\n", *fast_calibrate); | ||
| 120 | |||
| 121 | #ifdef CONFIG_X86_LOCAL_APIC | ||
| 122 | lapic_timer_frequency = (freq * 1000) / HZ; | ||
| 123 | pr_info("lapic_timer_frequency = %d\n", lapic_timer_frequency); | ||
| 124 | #endif | ||
| 125 | |||
| 126 | return 1; | ||
| 127 | } | ||
