intel.c revision 181430
1/*- 2 * Copyright (c) 2006, 2008 Stanislav Sedov <stas@FreeBSD.org>. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 19 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 20 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 21 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 22 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24 */ 25 26#include <sys/cdefs.h> 27__FBSDID("$FreeBSD: head/usr.sbin/cpucontrol/intel.c 181430 2008-08-08 16:26:53Z stas $"); 28 29#include <assert.h> 30#include <stdio.h> 31#include <stdlib.h> 32#include <string.h> 33#include <unistd.h> 34#include <fcntl.h> 35#include <err.h> 36 37#include <sys/types.h> 38#include <sys/stat.h> 39#include <sys/mman.h> 40#include <sys/ioctl.h> 41#include <sys/ioccom.h> 42#include <sys/cpuctl.h> 43 44#include <machine/cpufunc.h> 45#include <machine/specialreg.h> 46 47#include "cpucontrol.h" 48#include "intel.h" 49 50#define DEFAULT_UCODE_SIZE 2000 /* Size of update data if not specified. */ 51 52int 53intel_probe(int fd) 54{ 55 char vendor[13]; 56 int error; 57 cpuctl_cpuid_args_t idargs = { 58 .level = 0, 59 }; 60 61 error = ioctl(fd, CPUCTL_CPUID, &idargs); 62 if (error < 0) { 63 WARN(0, "ioctl()"); 64 return (1); 65 } 66 ((uint32_t *)vendor)[0] = idargs.data[1]; 67 ((uint32_t *)vendor)[1] = idargs.data[3]; 68 ((uint32_t *)vendor)[2] = idargs.data[2]; 69 vendor[12] = '\0'; 70 if (strncmp(vendor, INTEL_VENDOR_ID, sizeof(INTEL_VENDOR_ID)) != 0) 71 return (1); 72 return (0); 73} 74 75void 76intel_update(const char *dev, const char *path) 77{ 78 int fd, devfd; 79 struct stat st; 80 uint32_t *fw_image; 81 int have_ext_table; 82 uint32_t sum; 83 unsigned int i; 84 size_t payload_size; 85 intel_fw_header_t *fw_header; 86 intel_cpu_signature_t *ext_table; 87 intel_ext_header_t *ext_header; 88 uint32_t signature, flags; 89 int32_t revision; 90 ssize_t ext_size; 91 size_t ext_table_size; 92 void *fw_data; 93 size_t data_size, total_size; 94 cpuctl_msr_args_t msrargs = { 95 .msr = MSR_IA32_PLATFORM_ID, 96 }; 97 cpuctl_cpuid_args_t idargs = { 98 .level = 1, /* Signature. */ 99 }; 100 cpuctl_update_args_t args; 101 int error; 102 103 assert(path); 104 assert(dev); 105 106 fd = -1; 107 devfd = -1; 108 fw_image = MAP_FAILED; 109 ext_table = NULL; 110 ext_header = NULL; 111 devfd = open(dev, O_RDWR); 112 if (devfd < 0) { 113 WARN(0, "could not open %s for writing", dev); 114 return; 115 } 116 error = ioctl(devfd, CPUCTL_CPUID, &idargs); 117 if (error < 0) { 118 WARN(0, "ioctl(%s)", dev); 119 goto fail; 120 } 121 signature = idargs.data[0]; 122 error = ioctl(devfd, CPUCTL_RDMSR, &msrargs); 123 if (error < 0) { 124 WARN(0, "ioctl(%s)", dev); 125 goto fail; 126 } 127 128 /* 129 * MSR_IA32_PLATFORM_ID contains flag in BCD in bits 52-50. 130 */ 131 flags = 1 << ((msrargs.data >> 50) & 7); 132 msrargs.msr = MSR_BIOS_SIGN; 133 error = ioctl(devfd, CPUCTL_RDMSR, &msrargs); 134 if (error < 0) { 135 WARN(0, "ioctl(%s)", dev); 136 goto fail; 137 } 138 revision = msrargs.data >> 32; /* Revision in the high dword. */ 139 WARNX(2, "found cpu type %#x family %#x model %#x stepping %#x.", 140 (signature >> 12) & 0x03, (signature >> 8) & 0x0f, 141 (signature >> 4) & 0x0f, (signature >> 0) & 0x0f); 142 /* 143 * Open firmware image. 144 */ 145 fd = open(path, O_RDONLY, 0); 146 if (fd < 0) { 147 WARN(0, "open(%s)", path); 148 return; 149 } 150 error = fstat(fd, &st); 151 if (error != 0) { 152 WARN(0, "fstat(%s)", path); 153 goto fail; 154 } 155 if (st.st_size < 0 || (unsigned)st.st_size < sizeof(*fw_header)) { 156 WARNX(2, "file too short: %s", path); 157 goto fail; 158 } 159 160 /* 161 * mmap the whole image. 162 */ 163 fw_image = (uint32_t *)mmap(NULL, st.st_size, PROT_READ, 164 MAP_PRIVATE, fd, 0); 165 if (fw_image == MAP_FAILED) { 166 WARN(0, "mmap(%s)", path); 167 goto fail; 168 } 169 fw_header = (intel_fw_header_t *)fw_image; 170 if (fw_header->header_version != INTEL_HEADER_VERSION || 171 fw_header->loader_revision != INTEL_LOADER_REVISION) { 172 WARNX(2, "%s is not a valid intel firmware: version mismatch", 173 path); 174 goto fail; 175 } 176 /* 177 * According to spec, if data_size == 0, then size of ucode = 2000. 178 */ 179 if (fw_header->data_size == 0) 180 data_size = DEFAULT_UCODE_SIZE; 181 else 182 data_size = fw_header->data_size; 183 if (fw_header->total_size == 0) 184 total_size = data_size + sizeof(*fw_header); 185 else 186 total_size = fw_header->total_size; 187 if (total_size > (unsigned)st.st_size || st.st_size < 0) { 188 WARNX(2, "file too short: %s", path); 189 goto fail; 190 } 191 payload_size = data_size + sizeof(*fw_header); 192 193 /* 194 * Check the primary checksum. 195 */ 196 sum = 0; 197 for (i = 0; i < (payload_size / sizeof(uint32_t)); i++) 198 sum += *((uint32_t *)fw_image + i); 199 if (sum != 0) { 200 WARNX(2, "%s: update data checksum invalid", path); 201 goto fail; 202 } 203 204 /* 205 * Check if there is an extended signature table. 206 */ 207 ext_size = total_size - payload_size; 208 have_ext_table = 0; 209 210 if (ext_size > (signed)sizeof(*ext_header)) { 211 ext_header = 212 (intel_ext_header_t *)((char *)fw_image + payload_size); 213 ext_table = (intel_cpu_signature_t *)(ext_header + 1); 214 215 /* 216 * Check the extended table size. 217 */ 218 ext_table_size = sizeof(*ext_header) + 219 ext_header->sig_count * sizeof(*ext_table); 220 if (ext_table_size + payload_size > total_size) { 221 WARNX(2, "%s: broken extended signature table", path); 222 goto no_table; 223 } 224 225 /* 226 * Check the extended table signature. 227 */ 228 sum = 0; 229 for (i = 0; i < (ext_table_size / sizeof(uint32_t)); i++) 230 sum += *((uint32_t *)ext_header + i); 231 if (sum != 0) { 232 WARNX(2, "%s: extended signature table checksum invalid", 233 path); 234 goto no_table; 235 } 236 have_ext_table = 1; 237 } 238 239no_table: 240 fw_data = fw_header + 1; /* Pointer to the update data. */ 241 242 /* 243 * Check if the given image is ok for this cpu. 244 */ 245 if (signature == fw_header->cpu_signature && 246 (flags & fw_header->cpu_flags) != 0) 247 goto matched; 248 else if (have_ext_table != 0) { 249 for (i = 0; i < ext_header->sig_count; i++) { 250 uint32_t sig = ext_table[i].cpu_signature; 251 if (signature == sig && 252 (flags & ext_table[i].cpu_flags) != 0) 253 goto matched; 254 } 255 } else 256 goto fail; 257 258matched: 259 if (revision >= fw_header->revision) { 260 WARNX(1, "skipping %s of rev %#x: up to date", 261 path, fw_header->revision); 262 return; 263 } 264 fprintf(stderr, "%s: updating cpu %s from rev %#x to rev %#x... ", 265 path, dev, revision, fw_header->revision); 266 args.data = fw_data; 267 args.size = data_size; 268 error = ioctl(devfd, CPUCTL_UPDATE, &args); 269 if (error < 0) { 270 fprintf(stderr, "failed.\n"); 271 WARN(0, "ioctl()"); 272 goto fail; 273 } 274 fprintf(stderr, "done.\n"); 275 276fail: 277 if (fw_image != MAP_FAILED) 278 if (munmap(fw_image, st.st_size) != 0) 279 warn("munmap(%s)", path); 280 if (devfd >= 0) 281 close(devfd); 282 if (fd >= 0) 283 close(fd); 284 return; 285} 286