hpet.c revision 3e6716e748609a3a899e8d670e42832921bd45bc
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Intel & MS High Precision Event Timer Implementation. 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2003 Intel Corporation 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Venki Pallipadi 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (c) Copyright 2004 Hewlett-Packard Development Company, L.P. 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Bob Picco <robert.picco@hp.com> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License version 2 as 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * published by the Free Software Foundation. 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/config.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/interrupt.h> 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/miscdevice.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/major.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioport.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fcntl.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/poll.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/proc_fs.h> 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/sysctl.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/wait.h> 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/bcd.h> 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/seq_file.h> 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/bitops.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/current.h> 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/system.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/div64.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/acpi.h> 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <acpi/acpi_bus.h> 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hpet.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The High Precision Event Timer driver. 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This driver is closely modelled after the rtc.c driver. 4796803820b3d9830518083c02681fd3f72987ae4dAlex Williamson * http://www.intel.com/hardwaredesign/hpetspec.htm 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_USER_FREQ (64) 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DRIFT (500) 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 52757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap#define HPET_RANGE_SIZE 1024 /* from HPET spec */ 53757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 54642d30bbc73512269de1524251ccc378d7782b85Clemens Ladischstatic u32 hpet_nhpet, hpet_max_freq = HPET_USER_FREQ; 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* A lock for concurrent access by app and isr hpet activity. */ 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(hpet_lock); 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* A lock for concurrent intermodule access to hpet and isr hpet activity. */ 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(hpet_task_lock); 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DEV_NAME (7) 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpet_dev { 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hd_hpets; 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hd_hpet; 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *hd_timer; 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_ireqfreq; 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_irqdata; 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t hd_waitqueue; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct fasync_struct *hd_async_queue; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_task *hd_task; 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_flags; 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_irq; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_hdwirq; 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char hd_name[HPET_DEV_NAME]; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpets { 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hp_next; 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hp_hpet; 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_hpet_phys; 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct time_interpolator *hp_interpolator; 83ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long hp_tick_freq; 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_delta; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_ntimer; 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_which; 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev hp_dev[1]; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct hpets *hpets; 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_OPEN 0x0001 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_IE 0x0002 /* interrupt enabled */ 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_PERIODIC 0x0004 950d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch#define HPET_SHARED_IRQ 0x0008 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if BITS_PER_LONG == 64 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define write_counter(V, MC) writeq(V, MC) 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define read_counter(MC) readq(MC) 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define write_counter(V, MC) writel(V, MC) 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define read_counter(MC) readl(MC) 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef readq 106887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline unsigned long long readq(void __iomem *addr) 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return readl(addr) | (((unsigned long long)readl(addr + 4)) << 32LL); 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef writeq 113887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline void writeq(unsigned long long v, void __iomem *addr) 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v & 0xffffffff, addr); 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v >> 32, addr + 4); 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic irqreturn_t hpet_interrupt(int irq, void *data, struct pt_regs *regs) 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long isr; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = data; 1260d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 1270d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 1280d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if ((devp->hd_flags & HPET_SHARED_IRQ) && 1290d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch !(isr & readl(&devp->hd_hpet->hpet_isr))) 1300d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch return IRQ_NONE; 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata++; 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * For non-periodic timers, increment the accumulator. 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This has the effect of treating non-periodic like periodic. 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & (HPET_IE | HPET_PERIODIC)) == HPET_IE) { 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long m, t; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&devp->hd_hpet->hpet_mc); 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + devp->hd_hpets->hp_delta, 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &devp->hd_timer->hpet_compare); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1480d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) 1490d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &devp->hd_hpet->hpet_isr); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_task_lock); 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task) 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task->ht_func(devp->hd_task->ht_data); 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_task_lock); 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up_interruptible(&devp->hd_waitqueue); 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kill_fasync(&devp->hd_async_queue, SIGIO, POLL_IN); 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_open(struct inode *inode, struct file *file) 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_mode & FMODE_WRITE) 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_dev[i].hd_flags & HPET_OPEN 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds || hpetp->hp_dev[i].hd_task) 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) { 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = devp; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_OPEN; 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ssize_t 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_read(struct file *file, char __user *buf, size_t count, loff_t * ppos) 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long data; 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ssize_t retval; 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (count < sizeof(unsigned long)) 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&devp->hd_waitqueue, &wait); 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for ( ; ; ) { 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds data = devp->hd_irqdata; 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (data) 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (file->f_flags & O_NONBLOCK) { 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -EAGAIN; 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (signal_pending(current)) { 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -ERESTARTSYS; 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds schedule(); 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = put_user(data, (unsigned long __user *)buf); 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!retval) 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = sizeof(unsigned long); 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __set_current_state(TASK_RUNNING); 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&devp->hd_waitqueue, &wait); 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return retval; 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int hpet_poll(struct file *file, poll_table * wait) 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds poll_wait(file, &devp->hd_waitqueue, wait); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = devp->hd_irqdata; 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (v != 0) 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return POLLIN | POLLRDNORM; 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_mmap(struct file *file, struct vm_area_struct *vma) 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_HPET_MMAP 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long addr; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (((vma->vm_end - vma->vm_start) != PAGE_SIZE) || vma->vm_pgoff) 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = devp->hd_hpets->hp_hpet_phys; 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (addr & (PAGE_SIZE - 1)) 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_flags |= VM_IO; 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (io_remap_pfn_range(vma, vma->vm_start, addr >> PAGE_SHIFT, 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PAGE_SIZE, vma->vm_page_prot)) { 2873e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_ERR "%s: io_remap_pfn_range failed\n", 2883e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__); 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EAGAIN; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_fasync(int fd, struct file *file, int on) 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fasync_helper(fd, file, on, &devp->hd_async_queue) >= 0) 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_release(struct inode *inode, struct file *file) 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq = 0; 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_irq; 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_ireqfreq = 0; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_OPEN | HPET_IE | HPET_PERIODIC); 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(irq, devp); 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_flags & FASYNC) 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_fasync(-1, file, 0); 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = NULL; 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_common(struct hpet_dev *, int, unsigned long, int); 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl(struct inode *inode, struct file *file, unsigned int cmd, 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long arg) 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_common(devp, cmd, arg, 0); 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_ieon(struct hpet_dev *devp) 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq; 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long g, v, t, m; 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags, isr; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3769090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch if (!devp->hd_ireqfreq) 3779090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch return -EIO; 3789090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_IE) { 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_IE; 3870d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 3880d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (readl(&timer->hpet_config) & Tn_INT_TYPE_CNF_MASK) 3890d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_flags |= HPET_SHARED_IRQ; 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_hdwirq; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) { 3950d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch unsigned long irq_flags; 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3970d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch sprintf(devp->hd_name, "hpet%d", (int)(devp - hpetp->hp_dev)); 3980d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch irq_flags = devp->hd_flags & HPET_SHARED_IRQ 3990d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch ? SA_SHIRQ : SA_INTERRUPT; 4000d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (request_irq(irq, hpet_interrupt, irq_flags, 4010d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_name, (void *)devp)) { 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "hpet: IRQ %d is not free\n", irq); 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = 0; 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq == 0) { 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = irq; 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g = v | Tn_INT_ENB_CNF_MASK; 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC) { 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t, &timer->hpet_compare); 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g |= Tn_TYPE_CNF_MASK; 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_TYPE_CNF_MASK; 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_VAL_SET_CNF_MASK; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4350d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) { 4363d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 4370d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &hpet->hpet_isr); 4380d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch } 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(g, &timer->hpet_config); 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 445ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch/* converts Hz to number of timer ticks */ 446ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladischstatic inline unsigned long hpet_time_div(struct hpets *hpets, 447ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long dis) 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 449ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long m; 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch m = hpets->hp_tick_freq + (dis >> 1); 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_div(m, dis); 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (unsigned long)m; 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl_common(struct hpet_dev *devp, int cmd, unsigned long arg, int kernel) 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_ON: 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_ieon(devp); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = 0; 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_IE) == 0) 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~Tn_INT_ENB_CNF_MASK; 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_irq) { 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(devp->hd_irq, devp); 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_info info; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 500af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch if (devp->hd_ireqfreq) 501af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 502af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch hpet_time_div(hpetp, devp->hd_ireqfreq); 503af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch else 504af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 0; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info.hi_flags = 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK; 507c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_hpet = hpetp->hp_which; 508c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_timer = devp - hpetp->hp_dev; 5098e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (kernel) 5108e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch memcpy((void *)arg, &info, sizeof(info)); 5118e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch else 5128e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (copy_to_user((void __user *)arg, &info, 5138e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch sizeof(info))) 5148e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch err = -EFAULT; 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_PERIODIC; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC && 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~HPET_PERIODIC; 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!kernel && (arg > hpet_max_freq) && 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !capable(CAP_SYS_RESOURCE)) { 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EACCES; 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 546189e2dd1376c1eb2f3a717a15f1ed8c7d0b3811aClemens Ladisch if (!arg) { 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINVAL; 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch devp->hd_ireqfreq = hpet_time_div(hpetp, arg); 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct file_operations hpet_fops = { 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = no_llseek, 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = hpet_read, 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = hpet_poll, 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = hpet_ioctl, 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = hpet_open, 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = hpet_release, 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fasync = hpet_fasync, 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = hpet_mmap, 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5693e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlapstatic int hpet_is_known(struct hpet_data *hdp) 5703e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap{ 5713e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap struct hpets *hpetp; 5723e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 5733e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 5743e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpetp->hp_hpet_phys == hdp->hd_phys_address) 5753e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 1; 5763e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 5773e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 5783e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap} 5793e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_alloc); 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_register); 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_unregister); 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_control); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_register(struct hpet_task *tp, int periodic) 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int i; 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u64 mask; 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (periodic) { 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask = Tn_PER_INT_CAP_MASK; 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask = 0; 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6047522e4ecdfdf86b9816f06d55766a6f88baa0348Clemens Ladisch tp->ht_opaque = NULL; 6057522e4ecdfdf86b9816f06d55766a6f88baa0348Clemens Ladisch 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_task_lock); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (timer = hpetp->hp_hpet->hpet_timers, i = 0; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i < hpetp->hp_ntimer; i++, timer++) { 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK) 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds != mask) 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_OPEN || devp->hd_task) { 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = NULL; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tp->ht_opaque = devp; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task = tp; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (tp->ht_opaque) 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int hpet_tpcheck(struct hpet_task *tp) 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp >= hpetp->hp_dev 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp < (hpetp->hp_dev + hpetp->hp_ntimer) 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp->hd_hpet == hpetp->hp_hpet) 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_unregister(struct hpet_task *tp) 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((err = hpet_tpcheck(tp))) 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_task_lock); 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task != tp) { 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_IE | HPET_PERIODIC); 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task = NULL; 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_control(struct hpet_task *tp, unsigned int cmd, unsigned long arg) 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((err = hpet_tpcheck(tp))) 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task != tp) { 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_common(devp, cmd, arg, 1); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_table[] = { 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ctl_name = 1, 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "max-user-freq", 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data = &hpet_max_freq, 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = sizeof(int), 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0644, 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .proc_handler = &proc_dointvec, 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_root[] = { 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ctl_name = 1, 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "hpet", 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_table, 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table dev_root[] = { 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ctl_name = CTL_DEV, 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "dev", 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_root, 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct ctl_table_header *sysctl_header; 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void hpet_register_interpolator(struct hpets *hpetp) 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_TIME_INTERPOLATION 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct time_interpolator *ti; 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7453e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap ti = kzalloc(sizeof(*ti), GFP_KERNEL); 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!ti) 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ti->source = TIME_SOURCE_MMIO64; 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ti->shift = 10; 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ti->addr = &hpetp->hp_hpet->hpet_mc; 752ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch ti->frequency = hpetp->hp_tick_freq; 75396803820b3d9830518083c02681fd3f72987ae4dAlex Williamson ti->drift = HPET_DRIFT; 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ti->mask = -1; 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_interpolator = ti; 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds register_time_interpolator(ti); 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Adjustment for when arming the timer with 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * initial conditions. That is, main counter 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ticks expired before interrupts are enabled. 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TICK_CALIBRATE (1000UL) 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned long hpet_calibrate(struct hpets *hpetp) 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer = NULL; 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long t, m, count, i, flags, start; 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int j; 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (j = 0, devp = hpetp->hp_dev; j < hpetp->hp_ntimer; j++, devp++) 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_OPEN) == 0) { 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!timer) 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7853d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch hpet = hpetp->hp_hpet; 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = read_counter(&timer->hpet_compare); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = 0; 789ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch count = hpet_time_div(hpetp, TICK_CALIBRATE); 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start = read_counter(&hpet->hpet_mc); 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (i++, (m - start) < count); 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (m - start) / i; 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_alloc(struct hpet_data *hdp) 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u64 cap, mcfg; 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 i, ntimer; 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size_t siz; 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 8133e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap static struct hpets *last = NULL; 814318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch unsigned long period; 815ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long temp; 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hpet_alloc can be called by platform dependent code. 8193e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * If platform dependent code has allocated the hpet that 8203e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * ACPI has also reported, then we catch it here. 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8223e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 8233e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: duplicate HPET ignored\n", 8243e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__); 8253e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 8263e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds siz = sizeof(struct hpets) + ((hdp->hd_nirqs - 1) * 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct hpet_dev)); 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8313e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap hpetp = kzalloc(siz, GFP_KERNEL); 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!hpetp) 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_which = hpet_nhpet++; 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet = hdp->hd_address; 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet_phys = hdp->hd_phys_address; 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer = hdp->hd_nirqs; 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hdp->hd_nirqs; i++) 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_dev[i].hd_hdwirq = hdp->hd_irq[i]; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = hpetp->hp_hpet; 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap = readq(&hpet->hpet_cap); 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ntimer = ((cap & HPET_NUM_TIM_CAP_MASK) >> HPET_NUM_TIM_CAP_SHIFT) + 1; 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_ntimer != ntimer) { 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "hpet: number irqs doesn't agree" 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds " with number of timers\n"); 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(hpetp); 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last) 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last->hp_next = hpetp; 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpets = hpetp; 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last = hpetp; 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 865ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch period = (cap & HPET_COUNTER_CLK_PERIOD_MASK) >> 866ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch HPET_COUNTER_CLK_PERIOD_SHIFT; /* fs, 10^-15 */ 867ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp = 1000000000000000uLL; /* 10^15 femtoseconds per second */ 868ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp += period >> 1; /* round */ 869ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch do_div(temp, period); 870ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch hpetp->hp_tick_freq = temp; /* ticks per second */ 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 872b6ab126211e2ab17eecbd063b99742a6b04b228eRandy Dunlap printk(KERN_INFO "hpet%d: at MMIO 0x%lx (virtual 0x%p), IRQ%s", 873b6ab126211e2ab17eecbd063b99742a6b04b228eRandy Dunlap hpetp->hp_which, hdp->hd_phys_address, hdp->hd_address, 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer > 1 ? "s" : ""); 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%s %d", i > 0 ? "," : "", hdp->hd_irq[i]); 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("\n"); 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 879318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch printk(KERN_INFO "hpet%u: %u %d-bit timers, %Lu Hz\n", 880318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch hpetp->hp_which, hpetp->hp_ntimer, 881318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch cap & HPET_COUNTER_SIZE_MASK ? 64 : 32, hpetp->hp_tick_freq); 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg = readq(&hpet->hpet_config); 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((mcfg & HPET_ENABLE_CNF_MASK) == 0) { 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(0L, &hpet->hpet_mc); 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg |= HPET_ENABLE_CNF_MASK; 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(mcfg, &hpet->hpet_config); 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 890642d30bbc73512269de1524251ccc378d7782b85Clemens Ladisch for (i = 0, devp = hpetp->hp_dev; i < hpetp->hp_ntimer; i++, devp++) { 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = &hpet->hpet_timers[devp - hpetp->hp_dev]; 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpets = hpetp; 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpet = hpet; 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_timer = timer; 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If the timer was reserved by platform code, 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * then make timer unavailable for opens. 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hdp->hd_state & (1 << i)) { 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags = HPET_OPEN; 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&devp->hd_waitqueue); 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_delta = hpet_calibrate(hpetp); 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_register_interpolator(hpetp); 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic acpi_status hpet_resources(struct acpi_resource *res, void *data) 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data *hdp; 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status status; 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_resource_address64 addr; 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp = data; 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = acpi_resource_to_address64(res, &addr); 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_SUCCESS(status)) { 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long size; 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = addr.max_address_range - addr.min_address_range + 1; 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp->hd_phys_address = addr.min_address_range; 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp->hd_address = ioremap(addr.min_address_range, size); 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9343e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9353e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 9363e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__, hdp->hd_phys_address); 9373e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 9383e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return -EBUSY; 9393e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 940757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap } else if (res->id == ACPI_RSTYPE_FIXED_MEM32) { 941757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap struct acpi_resource_fixed_mem32 *fixmem32; 942757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 943757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap fixmem32 = &res->data.fixed_memory32; 944757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap if (!fixmem32) 945757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap return -EINVAL; 946757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 947757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap hdp->hd_phys_address = fixmem32->range_base_address; 948757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap hdp->hd_address = ioremap(fixmem32->range_base_address, 949757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap HPET_RANGE_SIZE); 950757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 9513e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9523e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 9533e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__, hdp->hd_phys_address); 9543e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 9553e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return -EBUSY; 9563e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (res->id == ACPI_RSTYPE_EXT_IRQ) { 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_resource_ext_irq *irqp; 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp = &res->data.extended_irq; 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irqp->number_of_interrupts > 0) { 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp->hd_nirqs = irqp->number_of_interrupts; 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 966a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige for (i = 0; i < hdp->hd_nirqs; i++) { 967a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige int rc = 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_register_gsi(irqp->interrupts[i], 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp->edge_level, 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp->active_high_low); 971a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige if (rc < 0) 972a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige return AE_ERROR; 973a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige hdp->hd_irq[i] = rc; 974a9bd53bc49ee8984633e57c1d9d45111c58e9457Kenji Kaneshige } 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return AE_OK; 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_add(struct acpi_device *device) 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status result; 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data data; 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&data, 0, sizeof(data)); 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_walk_resources(device->handle, METHOD_NAME__CRS, 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_resources, &data); 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_FAILURE(result)) 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!data.hd_address || !data.hd_nirqs) { 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%s: no address or irqs in _CRS\n", __FUNCTION__); 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_alloc(&data); 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_remove(struct acpi_device *device, int type) 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* XXX need to unregister interpolator, dealloc mem, etc */ 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct acpi_driver hpet_acpi_driver = { 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "hpet", 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ids = "PNP0103", 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ops = { 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .add = hpet_acpi_add, 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = hpet_acpi_remove, 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice hpet_misc = { HPET_MINOR, "hpet", &hpet_fops }; 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hpet_init(void) 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int result; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = misc_register(&hpet_misc); 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sysctl_header = register_sysctl_table(dev_root, 0); 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = acpi_bus_register_driver(&hpet_acpi_driver); 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) { 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return result; 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit hpet_exit(void) 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_bus_unregister_driver(&hpet_acpi_driver); 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(hpet_init); 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(hpet_exit); 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Bob Picco <Robert.Picco@hp.com>"); 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1056