git.oblomov.eu Git - linux-2.6/blob - arch/i386/kernel/cpuid.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2000 H. Peter Anvin - All Rights Reserved
   4  *
   5  *   This program is free software; you can redistribute it and/or modify
   6  *   it under the terms of the GNU General Public License as published by
   7  *   the Free Software Foundation, Inc., 675 Mass Ave, Cambridge MA 02139,
   8  *   USA; either version 2 of the License, or (at your option) any later
   9  *   version; incorporated herein by reference.
  10  *
  11  * ----------------------------------------------------------------------- */
  12
  13 /*
  14  * cpuid.c
  15  *
  16  * x86 CPUID access device
  17  *
  18  * This device is accessed by lseek() to the appropriate CPUID level
  19  * and then read in chunks of 16 bytes.  A larger size means multiple
  20  * reads of consecutive levels.
  21  *
  22  * This driver uses /dev/cpu/%d/cpuid where %d is the minor number, and on
  23  * an SMP box will direct the access to CPU %d.
  24  */
  25
  26 #include <linux/module.h>
  27 #include <linux/config.h>
  28
  29 #include <linux/types.h>
  30 #include <linux/errno.h>
  31 #include <linux/fcntl.h>
  32 #include <linux/init.h>
  33 #include <linux/poll.h>
  34 #include <linux/smp.h>
  35 #include <linux/major.h>
  36 #include <linux/fs.h>
  37 #include <linux/smp_lock.h>
  38 #include <linux/fs.h>
  39 #include <linux/device.h>
  40 #include <linux/cpu.h>
  41 #include <linux/notifier.h>
  42
  43 #include <asm/processor.h>
  44 #include <asm/msr.h>
  45 #include <asm/uaccess.h>
  46 #include <asm/system.h>
  47
  48 static struct class *cpuid_class;
  49
  50 #ifdef CONFIG_SMP
  51
  52 struct cpuid_command {
  53         int cpu;
  54         u32 reg;
  55         u32 *data;
  56 };
  57
  58 static void cpuid_smp_cpuid(void *cmd_block)
  59 {
  60         struct cpuid_command *cmd = (struct cpuid_command *)cmd_block;
  61
  62         if (cmd->cpu == smp_processor_id())
  63                 cpuid(cmd->reg, &cmd->data[0], &cmd->data[1], &cmd->data[2],
  64                       &cmd->data[3]);
  65 }
  66
  67 static inline void do_cpuid(int cpu, u32 reg, u32 * data)
  68 {
  69         struct cpuid_command cmd;
  70
  71         preempt_disable();
  72         if (cpu == smp_processor_id()) {
  73                 cpuid(reg, &data[0], &data[1], &data[2], &data[3]);
  74         } else {
  75                 cmd.cpu = cpu;
  76                 cmd.reg = reg;
  77                 cmd.data = data;
  78
  79                 smp_call_function(cpuid_smp_cpuid, &cmd, 1, 1);
  80         }
  81         preempt_enable();
  82 }
  83 #else                           /* ! CONFIG_SMP */
  84
  85 static inline void do_cpuid(int cpu, u32 reg, u32 * data)
  86 {
  87         cpuid(reg, &data[0], &data[1], &data[2], &data[3]);
  88 }
  89
  90 #endif                          /* ! CONFIG_SMP */
  91
  92 static loff_t cpuid_seek(struct file *file, loff_t offset, int orig)
  93 {
  94         loff_t ret;
  95
  96         lock_kernel();
  97
  98         switch (orig) {
  99         case 0:
 100                 file->f_pos = offset;
 101                 ret = file->f_pos;
 102                 break;
 103         case 1:
 104                 file->f_pos += offset;
 105                 ret = file->f_pos;
 106                 break;
 107         default:
 108                 ret = -EINVAL;
 109         }
 110
 111         unlock_kernel();
 112         return ret;
 113 }
 114
 115 static ssize_t cpuid_read(struct file *file, char __user *buf,
 116                           size_t count, loff_t * ppos)
 117 {
 118         char __user *tmp = buf;
 119         u32 data[4];
 120         u32 reg = *ppos;
 121         int cpu = iminor(file->f_dentry->d_inode);
 122
 123         if (count % 16)
 124                 return -EINVAL; /* Invalid chunk size */
 125
 126         for (; count; count -= 16) {
 127                 do_cpuid(cpu, reg, data);
 128                 if (copy_to_user(tmp, &data, 16))
 129                         return -EFAULT;
 130                 tmp += 16;
 131                 *ppos = reg++;
 132         }
 133
 134         return tmp - buf;
 135 }
 136
 137 static int cpuid_open(struct inode *inode, struct file *file)
 138 {
 139         unsigned int cpu = iminor(file->f_dentry->d_inode);
 140         struct cpuinfo_x86 *c = &(cpu_data)[cpu];
 141
 142         if (cpu >= NR_CPUS || !cpu_online(cpu))
 143                 return -ENXIO;  /* No such CPU */
 144         if (c->cpuid_level < 0)
 145                 return -EIO;    /* CPUID not supported */
 146
 147         return 0;
 148 }
 149
 150 /*
 151  * File operations we support
 152  */
 153 static struct file_operations cpuid_fops = {
 154         .owner = THIS_MODULE,
 155         .llseek = cpuid_seek,
 156         .read = cpuid_read,
 157         .open = cpuid_open,
 158 };
 159
 160 static int cpuid_class_device_create(int i)
 161 {
 162         int err = 0;
 163         struct class_device *class_err;
 164
 165         class_err = class_device_create(cpuid_class, NULL, MKDEV(CPUID_MAJOR, i), NULL, "cpu%d",i);
 166         if (IS_ERR(class_err))
 167                 err = PTR_ERR(class_err);
 168         return err;
 169 }
 170
 171 static int __devinit cpuid_class_cpu_callback(struct notifier_block *nfb, unsigned long action, void *hcpu)
 172 {
 173         unsigned int cpu = (unsigned long)hcpu;
 174
 175         switch (action) {
 176         case CPU_ONLINE:
 177                 cpuid_class_device_create(cpu);
 178                 break;
 179         case CPU_DEAD:
 180                 class_device_destroy(cpuid_class, MKDEV(CPUID_MAJOR, cpu));
 181                 break;
 182         }
 183         return NOTIFY_OK;
 184 }
 185
 186 static struct notifier_block cpuid_class_cpu_notifier =
 187 {
 188         .notifier_call = cpuid_class_cpu_callback,
 189 };
 190
 191 static int __init cpuid_init(void)
 192 {
 193         int i, err = 0;
 194         i = 0;
 195
 196         if (register_chrdev(CPUID_MAJOR, "cpu/cpuid", &cpuid_fops)) {
 197                 printk(KERN_ERR "cpuid: unable to get major %d for cpuid\n",
 198                        CPUID_MAJOR);
 199                 err = -EBUSY;
 200                 goto out;
 201         }
 202         cpuid_class = class_create(THIS_MODULE, "cpuid");
 203         if (IS_ERR(cpuid_class)) {
 204                 err = PTR_ERR(cpuid_class);
 205                 goto out_chrdev;
 206         }
 207         for_each_online_cpu(i) {
 208                 err = cpuid_class_device_create(i);
 209                 if (err != 0)
 210                         goto out_class;
 211         }
 212         register_cpu_notifier(&cpuid_class_cpu_notifier);
 213
 214         err = 0;
 215         goto out;
 216
 217 out_class:
 218         i = 0;
 219         for_each_online_cpu(i) {
 220                 class_device_destroy(cpuid_class, MKDEV(CPUID_MAJOR, i));
 221         }
 222         class_destroy(cpuid_class);
 223 out_chrdev:
 224         unregister_chrdev(CPUID_MAJOR, "cpu/cpuid");
 225 out:
 226         return err;
 227 }
 228
 229 static void __exit cpuid_exit(void)
 230 {
 231         int cpu = 0;
 232
 233         for_each_online_cpu(cpu)
 234                 class_device_destroy(cpuid_class, MKDEV(CPUID_MAJOR, cpu));
 235         class_destroy(cpuid_class);
 236         unregister_chrdev(CPUID_MAJOR, "cpu/cpuid");
 237         unregister_cpu_notifier(&cpuid_class_cpu_notifier);
 238 }
 239
 240 module_init(cpuid_init);
 241 module_exit(cpuid_exit);
 242
 243 MODULE_AUTHOR("H. Peter Anvin <hpa@zytor.com>");
 244 MODULE_DESCRIPTION("x86 generic CPUID driver");
 245 MODULE_LICENSE("GPL");