hpet.c revision 37a47db8d7f0f38dac5acf5a13abbc8f401707fa
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/interrupt.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/miscdevice.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/major.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioport.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fcntl.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/poll.h> 24f23f6e08c47acbdd20e9c49a79da8c404ea168e1Al Viro#include <linux/mm.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> 320aa366f351d044703e25c8425e508170e80d83b1Tony Luck#include <linux/clocksource.h> 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/current.h> 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/system.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/div64.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/acpi.h> 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <acpi/acpi_bus.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hpet.h> 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The High Precision Event Timer driver. 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This driver is closely modelled after the rtc.c driver. 4896803820b3d9830518083c02681fd3f72987ae4dAlex Williamson * http://www.intel.com/hardwaredesign/hpetspec.htm 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_USER_FREQ (64) 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DRIFT (500) 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 53757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap#define HPET_RANGE_SIZE 1024 /* from HPET spec */ 54757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 550aa366f351d044703e25c8425e508170e80d83b1Tony Luck#if BITS_PER_LONG == 64 560aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define write_counter(V, MC) writeq(V, MC) 570aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define read_counter(MC) readq(MC) 580aa366f351d044703e25c8425e508170e80d83b1Tony Luck#else 590aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define write_counter(V, MC) writel(V, MC) 600aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define read_counter(MC) readl(MC) 610aa366f351d044703e25c8425e508170e80d83b1Tony Luck#endif 620aa366f351d044703e25c8425e508170e80d83b1Tony Luck 63642d30bbc73512269de1524251ccc378d7782b85Clemens Ladischstatic u32 hpet_nhpet, hpet_max_freq = HPET_USER_FREQ; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 653dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur/* This clocksource driver currently only works on ia64 */ 663dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur#ifdef CONFIG_IA64 670aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic void __iomem *hpet_mctr; 680aa366f351d044703e25c8425e508170e80d83b1Tony Luck 690aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic cycle_t read_hpet(void) 700aa366f351d044703e25c8425e508170e80d83b1Tony Luck{ 710aa366f351d044703e25c8425e508170e80d83b1Tony Luck return (cycle_t)read_counter((void __iomem *)hpet_mctr); 720aa366f351d044703e25c8425e508170e80d83b1Tony Luck} 730aa366f351d044703e25c8425e508170e80d83b1Tony Luck 740aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic struct clocksource clocksource_hpet = { 750aa366f351d044703e25c8425e508170e80d83b1Tony Luck .name = "hpet", 760aa366f351d044703e25c8425e508170e80d83b1Tony Luck .rating = 250, 770aa366f351d044703e25c8425e508170e80d83b1Tony Luck .read = read_hpet, 78712aaa1cb1c0a83e5ffb5376e1d7ee3dd539f4e4Al Viro .mask = CLOCKSOURCE_MASK(64), 790aa366f351d044703e25c8425e508170e80d83b1Tony Luck .mult = 0, /*to be caluclated*/ 800aa366f351d044703e25c8425e508170e80d83b1Tony Luck .shift = 10, 810aa366f351d044703e25c8425e508170e80d83b1Tony Luck .flags = CLOCK_SOURCE_IS_CONTINUOUS, 820aa366f351d044703e25c8425e508170e80d83b1Tony Luck}; 830aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic struct clocksource *hpet_clocksource; 843dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur#endif 850aa366f351d044703e25c8425e508170e80d83b1Tony Luck 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* A lock for concurrent access by app and isr hpet activity. */ 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(hpet_lock); 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* A lock for concurrent intermodule access to hpet and isr hpet activity. */ 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(hpet_task_lock); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DEV_NAME (7) 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpet_dev { 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hd_hpets; 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hd_hpet; 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *hd_timer; 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_ireqfreq; 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_irqdata; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t hd_waitqueue; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct fasync_struct *hd_async_queue; 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_task *hd_task; 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_flags; 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_irq; 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_hdwirq; 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char hd_name[HPET_DEV_NAME]; 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpets { 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hp_next; 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hp_hpet; 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_hpet_phys; 1120aa366f351d044703e25c8425e508170e80d83b1Tony Luck struct clocksource *hp_clocksource; 113ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long hp_tick_freq; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_delta; 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_ntimer; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_which; 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev hp_dev[1]; 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct hpets *hpets; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_OPEN 0x0001 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_IE 0x0002 /* interrupt enabled */ 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_PERIODIC 0x0004 1250d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch#define HPET_SHARED_IRQ 0x0008 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef readq 129887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline unsigned long long readq(void __iomem *addr) 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return readl(addr) | (((unsigned long long)readl(addr + 4)) << 32LL); 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef writeq 136887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline void writeq(unsigned long long v, void __iomem *addr) 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v & 0xffffffff, addr); 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v >> 32, addr + 4); 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1437d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t hpet_interrupt(int irq, void *data) 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long isr; 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = data; 1490d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 1500d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 1510d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if ((devp->hd_flags & HPET_SHARED_IRQ) && 1520d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch !(isr & readl(&devp->hd_hpet->hpet_isr))) 1530d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch return IRQ_NONE; 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata++; 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * For non-periodic timers, increment the accumulator. 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This has the effect of treating non-periodic like periodic. 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & (HPET_IE | HPET_PERIODIC)) == HPET_IE) { 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long m, t; 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&devp->hd_hpet->hpet_mc); 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + devp->hd_hpets->hp_delta, 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &devp->hd_timer->hpet_compare); 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1710d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) 1720d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &devp->hd_hpet->hpet_isr); 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_task_lock); 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task) 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task->ht_func(devp->hd_task->ht_data); 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_task_lock); 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up_interruptible(&devp->hd_waitqueue); 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kill_fasync(&devp->hd_async_queue, SIGIO, POLL_IN); 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_open(struct inode *inode, struct file *file) 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_mode & FMODE_WRITE) 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_dev[i].hd_flags & HPET_OPEN 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds || hpetp->hp_dev[i].hd_task) 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) { 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = devp; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_OPEN; 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ssize_t 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_read(struct file *file, char __user *buf, size_t count, loff_t * ppos) 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long data; 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ssize_t retval; 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (count < sizeof(unsigned long)) 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&devp->hd_waitqueue, &wait); 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for ( ; ; ) { 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds data = devp->hd_irqdata; 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (data) 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (file->f_flags & O_NONBLOCK) { 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -EAGAIN; 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (signal_pending(current)) { 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -ERESTARTSYS; 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds schedule(); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = put_user(data, (unsigned long __user *)buf); 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!retval) 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = sizeof(unsigned long); 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __set_current_state(TASK_RUNNING); 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&devp->hd_waitqueue, &wait); 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return retval; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int hpet_poll(struct file *file, poll_table * wait) 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds poll_wait(file, &devp->hd_waitqueue, wait); 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = devp->hd_irqdata; 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (v != 0) 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return POLLIN | POLLRDNORM; 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_mmap(struct file *file, struct vm_area_struct *vma) 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_HPET_MMAP 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long addr; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (((vma->vm_end - vma->vm_start) != PAGE_SIZE) || vma->vm_pgoff) 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = devp->hd_hpets->hp_hpet_phys; 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (addr & (PAGE_SIZE - 1)) 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_flags |= VM_IO; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (io_remap_pfn_range(vma, vma->vm_start, addr >> PAGE_SHIFT, 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PAGE_SIZE, vma->vm_page_prot)) { 3103e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_ERR "%s: io_remap_pfn_range failed\n", 3113e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__); 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EAGAIN; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_fasync(int fd, struct file *file, int on) 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fasync_helper(fd, file, on, &devp->hd_async_queue) >= 0) 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_release(struct inode *inode, struct file *file) 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq = 0; 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_irq; 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_ireqfreq = 0; 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_OPEN | HPET_IE | HPET_PERIODIC); 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(irq, devp); 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_flags & FASYNC) 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_fasync(-1, file, 0); 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = NULL; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_common(struct hpet_dev *, int, unsigned long, int); 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl(struct inode *inode, struct file *file, unsigned int cmd, 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long arg) 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_common(devp, cmd, arg, 0); 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_ieon(struct hpet_dev *devp) 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq; 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long g, v, t, m; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags, isr; 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3999090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch if (!devp->hd_ireqfreq) 4009090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch return -EIO; 4019090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_IE) { 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_IE; 4100d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 4110d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (readl(&timer->hpet_config) & Tn_INT_TYPE_CNF_MASK) 4120d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_flags |= HPET_SHARED_IRQ; 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_hdwirq; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) { 4180d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch unsigned long irq_flags; 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4200d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch sprintf(devp->hd_name, "hpet%d", (int)(devp - hpetp->hp_dev)); 4210d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch irq_flags = devp->hd_flags & HPET_SHARED_IRQ 4220f2ed4c6bae23d2b7ef0ea2d272377e3de700c0cThomas Gleixner ? IRQF_SHARED : IRQF_DISABLED; 4230d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (request_irq(irq, hpet_interrupt, irq_flags, 4240d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_name, (void *)devp)) { 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "hpet: IRQ %d is not free\n", irq); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = 0; 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq == 0) { 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = irq; 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g = v | Tn_INT_ENB_CNF_MASK; 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC) { 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t, &timer->hpet_compare); 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g |= Tn_TYPE_CNF_MASK; 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_TYPE_CNF_MASK; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_VAL_SET_CNF_MASK; 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4580d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) { 4593d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 4600d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &hpet->hpet_isr); 4610d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch } 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(g, &timer->hpet_config); 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 468ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch/* converts Hz to number of timer ticks */ 469ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladischstatic inline unsigned long hpet_time_div(struct hpets *hpets, 470ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long dis) 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 472ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long m; 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 474ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch m = hpets->hp_tick_freq + (dis >> 1); 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_div(m, dis); 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (unsigned long)m; 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl_common(struct hpet_dev *devp, int cmd, unsigned long arg, int kernel) 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_ON: 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_ieon(devp); 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = 0; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_IE) == 0) 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~Tn_INT_ENB_CNF_MASK; 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_irq) { 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(devp->hd_irq, devp); 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_info info; 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 523af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch if (devp->hd_ireqfreq) 524af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 525af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch hpet_time_div(hpetp, devp->hd_ireqfreq); 526af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch else 527af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 0; 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info.hi_flags = 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK; 530c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_hpet = hpetp->hp_which; 531c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_timer = devp - hpetp->hp_dev; 5328e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (kernel) 5338e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch memcpy((void *)arg, &info, sizeof(info)); 5348e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch else 5358e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (copy_to_user((void __user *)arg, &info, 5368e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch sizeof(info))) 5378e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch err = -EFAULT; 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_PERIODIC; 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC && 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~HPET_PERIODIC; 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!kernel && (arg > hpet_max_freq) && 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !capable(CAP_SYS_RESOURCE)) { 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EACCES; 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 569189e2dd1376c1eb2f3a717a15f1ed8c7d0b3811aClemens Ladisch if (!arg) { 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINVAL; 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 574ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch devp->hd_ireqfreq = hpet_time_div(hpetp, arg); 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 58062322d2554d2f9680c8ace7bbf1f97d8fa84ad1aArjan van de Venstatic const struct file_operations hpet_fops = { 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = no_llseek, 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = hpet_read, 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = hpet_poll, 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = hpet_ioctl, 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = hpet_open, 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = hpet_release, 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fasync = hpet_fasync, 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = hpet_mmap, 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5923e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlapstatic int hpet_is_known(struct hpet_data *hdp) 5933e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap{ 5943e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap struct hpets *hpetp; 5953e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 5963e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 5973e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpetp->hp_hpet_phys == hdp->hd_phys_address) 5983e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 1; 5993e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 6003e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 6013e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap} 6023e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_alloc); 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_register); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_unregister); 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hpet_control); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_register(struct hpet_task *tp, int periodic) 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int i; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u64 mask; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (periodic) { 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask = Tn_PER_INT_CAP_MASK; 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask = 0; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6277522e4ecdfdf86b9816f06d55766a6f88baa0348Clemens Ladisch tp->ht_opaque = NULL; 6287522e4ecdfdf86b9816f06d55766a6f88baa0348Clemens Ladisch 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_task_lock); 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (timer = hpetp->hp_hpet->hpet_timers, i = 0; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i < hpetp->hp_ntimer; i++, timer++) { 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK) 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds != mask) 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_OPEN || devp->hd_task) { 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = NULL; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tp->ht_opaque = devp; 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task = tp; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (tp->ht_opaque) 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int hpet_tpcheck(struct hpet_task *tp) 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp >= hpetp->hp_dev 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp < (hpetp->hp_dev + hpetp->hp_ntimer) 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp->hd_hpet == hpetp->hp_hpet) 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_unregister(struct hpet_task *tp) 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((err = hpet_tpcheck(tp))) 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_task_lock); 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task != tp) { 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_IE | HPET_PERIODIC); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task = NULL; 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_control(struct hpet_task *tp, unsigned int cmd, unsigned long arg) 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((err = hpet_tpcheck(tp))) 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task != tp) { 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_common(devp, cmd, arg, 1); 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_table[] = { 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 72922943364cffd404e1bba4f097ac21bc74031eba3Eric W. Biederman .ctl_name = CTL_UNNUMBERED, 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "max-user-freq", 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data = &hpet_max_freq, 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = sizeof(int), 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0644, 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .proc_handler = &proc_dointvec, 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_root[] = { 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 74122943364cffd404e1bba4f097ac21bc74031eba3Eric W. Biederman .ctl_name = CTL_UNNUMBERED, 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "hpet", 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_table, 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table dev_root[] = { 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ctl_name = CTL_DEV, 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "dev", 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_root, 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct ctl_table_header *sysctl_header; 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Adjustment for when arming the timer with 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * initial conditions. That is, main counter 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ticks expired before interrupts are enabled. 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TICK_CALIBRATE (1000UL) 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned long hpet_calibrate(struct hpets *hpetp) 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer = NULL; 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long t, m, count, i, flags, start; 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int j; 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (j = 0, devp = hpetp->hp_dev; j < hpetp->hp_ntimer; j++, devp++) 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_OPEN) == 0) { 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!timer) 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7873d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch hpet = hpetp->hp_hpet; 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = read_counter(&timer->hpet_compare); 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = 0; 791ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch count = hpet_time_div(hpetp, TICK_CALIBRATE); 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start = read_counter(&hpet->hpet_mc); 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (i++, (m - start) < count); 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (m - start) / i; 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_alloc(struct hpet_data *hdp) 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 809e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao u64 cap, mcfg, hpet_config; 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 811e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao u32 i, ntimer, irq; 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size_t siz; 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 8153e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap static struct hpets *last = NULL; 816e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao unsigned long period, irq_bitmap; 817ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long temp; 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hpet_alloc can be called by platform dependent code. 8213e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * If platform dependent code has allocated the hpet that 8223e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * ACPI has also reported, then we catch it here. 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8243e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 8253e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: duplicate HPET ignored\n", 8263e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__); 8273e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 8283e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds siz = sizeof(struct hpets) + ((hdp->hd_nirqs - 1) * 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct hpet_dev)); 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8333e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap hpetp = kzalloc(siz, GFP_KERNEL); 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!hpetp) 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_which = hpet_nhpet++; 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet = hdp->hd_address; 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet_phys = hdp->hd_phys_address; 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer = hdp->hd_nirqs; 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = hpetp->hp_hpet; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 845e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao /* Assign IRQs statically for legacy devices */ 846e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpetp->hp_dev[0].hd_hdwirq = hdp->hd_irq[0]; 847e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpetp->hp_dev[1].hd_hdwirq = hdp->hd_irq[1]; 848e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 849e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao /* Assign IRQs dynamically for the others */ 850e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao for (i = 2, devp = &hpetp->hp_dev[2]; i < hdp->hd_nirqs; i++, devp++) { 851e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao struct hpet_timer __iomem *timer; 852e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 853e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao timer = &hpet->hpet_timers[devp - hpetp->hp_dev]; 854e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 85537a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao /* Check if there's already an IRQ assigned to the timer */ 85637a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao if (hdp->hd_irq[i]) { 85737a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao hpetp->hp_dev[i].hd_hdwirq = hdp->hd_irq[i]; 85837a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao continue; 85937a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao } 86037a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao 861e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpet_config = readq(&timer->hpet_config); 862e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao irq_bitmap = (hpet_config & Tn_INT_ROUTE_CAP_MASK) 863e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao >> Tn_INT_ROUTE_CAP_SHIFT; 864e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao if (!irq_bitmap) 865e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao irq = 0; /* No valid IRQ Assignable */ 866e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao else { 867e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao irq = find_first_bit(&irq_bitmap, 32); 868e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao do { 869e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpet_config |= irq << Tn_INT_ROUTE_CNF_SHIFT; 870e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao writeq(hpet_config, &timer->hpet_config); 871e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 872e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao /* 873e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao * Verify whether we have written a valid 874e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao * IRQ number by reading it back again 875e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao */ 876e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpet_config = readq(&timer->hpet_config); 877e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao if (irq == (hpet_config & Tn_INT_ROUTE_CNF_MASK) 878e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao >> Tn_INT_ROUTE_CNF_SHIFT) 879e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao break; /* Success */ 880e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao } while ((irq = (find_next_bit(&irq_bitmap, 32, irq)))); 881e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao } 882e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpetp->hp_dev[i].hd_hdwirq = irq; 883e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao } 884e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap = readq(&hpet->hpet_cap); 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ntimer = ((cap & HPET_NUM_TIM_CAP_MASK) >> HPET_NUM_TIM_CAP_SHIFT) + 1; 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_ntimer != ntimer) { 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "hpet: number irqs doesn't agree" 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds " with number of timers\n"); 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(hpetp); 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last) 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last->hp_next = hpetp; 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpets = hpetp; 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last = hpetp; 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 903ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch period = (cap & HPET_COUNTER_CLK_PERIOD_MASK) >> 904ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch HPET_COUNTER_CLK_PERIOD_SHIFT; /* fs, 10^-15 */ 905ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp = 1000000000000000uLL; /* 10^15 femtoseconds per second */ 906ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp += period >> 1; /* round */ 907ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch do_div(temp, period); 908ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch hpetp->hp_tick_freq = temp; /* ticks per second */ 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9103034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen printk(KERN_INFO "hpet%d: at MMIO 0x%lx, IRQ%s", 9113034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen hpetp->hp_which, hdp->hd_phys_address, 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer > 1 ? "s" : ""); 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 914e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao printk("%s %d", i > 0 ? "," : "", 915e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao hpetp->hp_dev[i].hd_hdwirq); 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("\n"); 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 918318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch printk(KERN_INFO "hpet%u: %u %d-bit timers, %Lu Hz\n", 919318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch hpetp->hp_which, hpetp->hp_ntimer, 920318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch cap & HPET_COUNTER_SIZE_MASK ? 64 : 32, hpetp->hp_tick_freq); 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg = readq(&hpet->hpet_config); 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((mcfg & HPET_ENABLE_CNF_MASK) == 0) { 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(0L, &hpet->hpet_mc); 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg |= HPET_ENABLE_CNF_MASK; 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(mcfg, &hpet->hpet_config); 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 929642d30bbc73512269de1524251ccc378d7782b85Clemens Ladisch for (i = 0, devp = hpetp->hp_dev; i < hpetp->hp_ntimer; i++, devp++) { 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = &hpet->hpet_timers[devp - hpetp->hp_dev]; 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpets = hpetp; 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpet = hpet; 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_timer = timer; 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If the timer was reserved by platform code, 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * then make timer unavailable for opens. 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hdp->hd_state & (1 << i)) { 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags = HPET_OPEN; 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&devp->hd_waitqueue); 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_delta = hpet_calibrate(hpetp); 9510aa366f351d044703e25c8425e508170e80d83b1Tony Luck 9523b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds/* This clocksource driver currently only works on ia64 */ 9533b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#ifdef CONFIG_IA64 9540aa366f351d044703e25c8425e508170e80d83b1Tony Luck if (!hpet_clocksource) { 9550aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_mctr = (void __iomem *)&hpetp->hp_hpet->hpet_mc; 9560aa366f351d044703e25c8425e508170e80d83b1Tony Luck CLKSRC_FSYS_MMIO_SET(clocksource_hpet.fsys_mmio, hpet_mctr); 9570aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_hpet.mult = clocksource_hz2mult(hpetp->hp_tick_freq, 9580aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_hpet.shift); 9590aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_register(&clocksource_hpet); 9600aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpetp->hp_clocksource = &clocksource_hpet; 9610aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_clocksource = &clocksource_hpet; 9620aa366f351d044703e25c8425e508170e80d83b1Tony Luck } 9633b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#endif 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic acpi_status hpet_resources(struct acpi_resource *res, void *data) 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data *hdp; 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status status; 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_resource_address64 addr; 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp = data; 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = acpi_resource_to_address64(res, &addr); 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_SUCCESS(status)) { 97950eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = addr.minimum; 9809224a867c497053842dc595e594ca6d32112221fBjorn Helgaas hdp->hd_address = ioremap(addr.minimum, addr.address_length); 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9823e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9833e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 9843e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__, hdp->hd_phys_address); 9853e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 98678e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 9873e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 98850eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_FIXED_MEMORY32) { 98950eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_fixed_memory32 *fixmem32; 990757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 991757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap fixmem32 = &res->data.fixed_memory32; 992757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap if (!fixmem32) 99378e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_NO_MEMORY; 994757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 99550eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = fixmem32->address; 99650eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_address = ioremap(fixmem32->address, 997757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap HPET_RANGE_SIZE); 998757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 9993e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 10003e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 10013e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap __FUNCTION__, hdp->hd_phys_address); 10023e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 100378e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 10043e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 100550eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_EXTENDED_IRQ) { 100650eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_extended_irq *irqp; 1007be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas int i, irq; 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp = &res->data.extended_irq; 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1011be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas for (i = 0; i < irqp->interrupt_count; i++) { 1012be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas irq = acpi_register_gsi(irqp->interrupts[i], 1013be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas irqp->triggering, irqp->polarity); 1014be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas if (irq < 0) 1015be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas return AE_ERROR; 1016be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas 1017be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_irq[hdp->hd_nirqs] = irq; 1018be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_nirqs++; 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return AE_OK; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_add(struct acpi_device *device) 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status result; 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data data; 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&data, 0, sizeof(data)); 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_walk_resources(device->handle, METHOD_NAME__CRS, 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_resources, &data); 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_FAILURE(result)) 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!data.hd_address || !data.hd_nirqs) { 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%s: no address or irqs in _CRS\n", __FUNCTION__); 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_alloc(&data); 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_remove(struct acpi_device *device, int type) 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10490aa366f351d044703e25c8425e508170e80d83b1Tony Luck /* XXX need to unregister clocksource, dealloc mem, etc */ 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10531ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renningerstatic const struct acpi_device_id hpet_device_ids[] = { 10541ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"PNP0103", 0}, 10551ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"", 0}, 10561ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger}; 10571ba90e3a87c46500623afdc3898573e4a5ebb21bThomas RenningerMODULE_DEVICE_TABLE(acpi, hpet_device_ids); 10581ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct acpi_driver hpet_acpi_driver = { 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "hpet", 10611ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger .ids = hpet_device_ids, 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ops = { 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .add = hpet_acpi_add, 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = hpet_acpi_remove, 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice hpet_misc = { HPET_MINOR, "hpet", &hpet_fops }; 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hpet_init(void) 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int result; 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = misc_register(&hpet_misc); 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10780b4d414714f0d2f922d39424b0c5c82ad900a381Eric W. Biederman sysctl_header = register_sysctl_table(dev_root); 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = acpi_bus_register_driver(&hpet_acpi_driver); 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) { 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return result; 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit hpet_exit(void) 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_bus_unregister_driver(&hpet_acpi_driver); 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(hpet_init); 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(hpet_exit); 11041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Bob Picco <Robert.Picco@hp.com>"); 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1106