hpet.c revision 70ef6d595b6e51618a0cbe44b848d8c9db11a010
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 18770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Haostatic void hpet_timer_set_irq(struct hpet_dev *devp) 18870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao{ 18970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao unsigned long v; 19070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao int irq, gsi; 19170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao struct hpet_timer __iomem *timer; 19270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 19370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_lock_irq(&hpet_lock); 19470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (devp->hd_hdwirq) { 19570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 19670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao return; 19770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 19870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 19970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao timer = devp->hd_timer; 20070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 20170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* we prefer level triggered mode */ 20270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = readl(&timer->hpet_config); 20370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (!(v & Tn_INT_TYPE_CNF_MASK)) { 20470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v |= Tn_INT_TYPE_CNF_MASK; 20570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao writel(v, &timer->hpet_config); 20670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 20770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 20870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 20970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = (readq(&timer->hpet_config) & Tn_INT_ROUTE_CAP_MASK) >> 21070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao Tn_INT_ROUTE_CAP_SHIFT; 21170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 21270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* 21370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao * In PIC mode, skip IRQ0-4, IRQ6-9, IRQ12-15 which is always used by 21470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao * legacy device. In IO APIC mode, we skip all the legacy IRQS. 21570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao */ 21670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (acpi_irq_model == ACPI_IRQ_MODEL_PIC) 21770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v &= ~0xf3df; 21870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao else 21970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v &= ~0xffff; 22070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 22170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao for (irq = find_first_bit(&v, HPET_MAX_IRQ); irq < HPET_MAX_IRQ; 22270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao irq = find_next_bit(&v, HPET_MAX_IRQ, 1 + irq)) { 22370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 22470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (irq >= NR_IRQS) { 22570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao irq = HPET_MAX_IRQ; 22670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao break; 22770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 22870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 22970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao gsi = acpi_register_gsi(irq, ACPI_LEVEL_SENSITIVE, 23070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao ACPI_ACTIVE_LOW); 23170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (gsi > 0) 23270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao break; 23370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 23470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* FIXME: Setup interrupt source table */ 23570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 23670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 23770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (irq < HPET_MAX_IRQ) { 23870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_lock_irq(&hpet_lock); 23970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = readl(&timer->hpet_config); 24070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v |= irq << Tn_INT_ROUTE_CNF_SHIFT; 24170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao writel(v, &timer->hpet_config); 24270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao devp->hd_hdwirq = gsi; 24370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 24470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 24570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao return; 24670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao} 24770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_open(struct inode *inode, struct file *file) 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_mode & FMODE_WRITE) 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_dev[i].hd_flags & HPET_OPEN 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds || hpetp->hp_dev[i].hd_task) 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) { 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = devp; 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_OPEN; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao hpet_timer_set_irq(devp); 28070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ssize_t 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_read(struct file *file, char __user *buf, size_t count, loff_t * ppos) 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long data; 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ssize_t retval; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (count < sizeof(unsigned long)) 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&devp->hd_waitqueue, &wait); 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for ( ; ; ) { 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds data = devp->hd_irqdata; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (data) 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (file->f_flags & O_NONBLOCK) { 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -EAGAIN; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (signal_pending(current)) { 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -ERESTARTSYS; 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds schedule(); 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = put_user(data, (unsigned long __user *)buf); 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!retval) 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = sizeof(unsigned long); 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __set_current_state(TASK_RUNNING); 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&devp->hd_waitqueue, &wait); 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return retval; 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int hpet_poll(struct file *file, poll_table * wait) 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds poll_wait(file, &devp->hd_waitqueue, wait); 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = devp->hd_irqdata; 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (v != 0) 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return POLLIN | POLLRDNORM; 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_mmap(struct file *file, struct vm_area_struct *vma) 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_HPET_MMAP 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long addr; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (((vma->vm_end - vma->vm_start) != PAGE_SIZE) || vma->vm_pgoff) 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = devp->hd_hpets->hp_hpet_phys; 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (addr & (PAGE_SIZE - 1)) 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_flags |= VM_IO; 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (io_remap_pfn_range(vma, vma->vm_start, addr >> PAGE_SHIFT, 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PAGE_SIZE, vma->vm_page_prot)) { 3733e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_ERR "%s: io_remap_pfn_range failed\n", 374bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__); 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EAGAIN; 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_fasync(int fd, struct file *file, int on) 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fasync_helper(fd, file, on, &devp->hd_async_queue) >= 0) 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_release(struct inode *inode, struct file *file) 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq = 0; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_irq; 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_ireqfreq = 0; 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_OPEN | HPET_IE | HPET_PERIODIC); 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(irq, devp); 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_flags & FASYNC) 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_fasync(-1, file, 0); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = NULL; 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_common(struct hpet_dev *, int, unsigned long, int); 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl(struct inode *inode, struct file *file, unsigned int cmd, 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long arg) 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_common(devp, cmd, arg, 0); 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_ieon(struct hpet_dev *devp) 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long g, v, t, m; 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags, isr; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4629090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch if (!devp->hd_ireqfreq) 4639090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch return -EIO; 4649090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_IE) { 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_IE; 4730d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 4740d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (readl(&timer->hpet_config) & Tn_INT_TYPE_CNF_MASK) 4750d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_flags |= HPET_SHARED_IRQ; 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_hdwirq; 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) { 4810d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch unsigned long irq_flags; 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4830d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch sprintf(devp->hd_name, "hpet%d", (int)(devp - hpetp->hp_dev)); 4840d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch irq_flags = devp->hd_flags & HPET_SHARED_IRQ 4850f2ed4c6bae23d2b7ef0ea2d272377e3de700c0cThomas Gleixner ? IRQF_SHARED : IRQF_DISABLED; 4860d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (request_irq(irq, hpet_interrupt, irq_flags, 4870d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_name, (void *)devp)) { 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "hpet: IRQ %d is not free\n", irq); 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = 0; 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq == 0) { 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = irq; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g = v | Tn_INT_ENB_CNF_MASK; 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC) { 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t, &timer->hpet_compare); 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g |= Tn_TYPE_CNF_MASK; 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_TYPE_CNF_MASK; 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= Tn_VAL_SET_CNF_MASK; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5210d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) { 5223d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 5230d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &hpet->hpet_isr); 5240d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch } 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(g, &timer->hpet_config); 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 531ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch/* converts Hz to number of timer ticks */ 532ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladischstatic inline unsigned long hpet_time_div(struct hpets *hpets, 533ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long dis) 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 535ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long m; 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 537ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch m = hpets->hp_tick_freq + (dis >> 1); 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_div(m, dis); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (unsigned long)m; 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_ioctl_common(struct hpet_dev *devp, int cmd, unsigned long arg, int kernel) 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_ON: 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_ieon(devp); 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = 0; 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_IE) == 0) 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~Tn_INT_ENB_CNF_MASK; 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_irq) { 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(devp->hd_irq, devp); 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_info info; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 586af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch if (devp->hd_ireqfreq) 587af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 588af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch hpet_time_div(hpetp, devp->hd_ireqfreq); 589af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch else 590af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch info.hi_ireqfreq = 0; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info.hi_flags = 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK; 593c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_hpet = hpetp->hp_which; 594c860ed9fb5d320407f99190ab2e31bfe74db6724Clemens Ladisch info.hi_timer = devp - hpetp->hp_dev; 5958e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (kernel) 5968e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch memcpy((void *)arg, &info, sizeof(info)); 5978e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch else 5988e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch if (copy_to_user((void __user *)arg, &info, 5998e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch sizeof(info))) 6008e8505be9c0ba608cbd634faa8fba361f17d2512Clemens Ladisch err = -EFAULT; 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_PERIODIC; 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC && 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~HPET_PERIODIC; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!kernel && (arg > hpet_max_freq) && 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !capable(CAP_SYS_RESOURCE)) { 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EACCES; 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 632189e2dd1376c1eb2f3a717a15f1ed8c7d0b3811aClemens Ladisch if (!arg) { 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINVAL; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 637ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch devp->hd_ireqfreq = hpet_time_div(hpetp, arg); 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 64362322d2554d2f9680c8ace7bbf1f97d8fa84ad1aArjan van de Venstatic const struct file_operations hpet_fops = { 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = no_llseek, 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = hpet_read, 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = hpet_poll, 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = hpet_ioctl, 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = hpet_open, 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = hpet_release, 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fasync = hpet_fasync, 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = hpet_mmap, 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6553e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlapstatic int hpet_is_known(struct hpet_data *hdp) 6563e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap{ 6573e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap struct hpets *hpetp; 6583e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 6593e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 6603e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpetp->hp_hpet_phys == hdp->hd_phys_address) 6613e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 1; 6623e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 6633e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 6643e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap} 6653e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int hpet_tpcheck(struct hpet_task *tp) 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp >= hpetp->hp_dev 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp < (hpetp->hp_dev + hpetp->hp_ntimer) 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && devp->hd_hpet == hpetp->hp_hpet) 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_unregister(struct hpet_task *tp) 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 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_task_lock); 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = tp->ht_opaque; 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_task != tp) { 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_IE | HPET_PERIODIC); 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_task = NULL; 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_task_lock); 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_table[] = { 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 71722943364cffd404e1bba4f097ac21bc74031eba3Eric W. Biederman .ctl_name = CTL_UNNUMBERED, 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "max-user-freq", 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data = &hpet_max_freq, 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = sizeof(int), 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0644, 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .proc_handler = &proc_dointvec, 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_root[] = { 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 72922943364cffd404e1bba4f097ac21bc74031eba3Eric W. Biederman .ctl_name = CTL_UNNUMBERED, 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "hpet", 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_table, 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table dev_root[] = { 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ctl_name = CTL_DEV, 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "dev", 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_root, 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds {.ctl_name = 0} 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct ctl_table_header *sysctl_header; 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Adjustment for when arming the timer with 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * initial conditions. That is, main counter 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ticks expired before interrupts are enabled. 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TICK_CALIBRATE (1000UL) 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned long hpet_calibrate(struct hpets *hpetp) 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer = NULL; 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long t, m, count, i, flags, start; 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int j; 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (j = 0, devp = hpetp->hp_dev; j < hpetp->hp_ntimer; j++, devp++) 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_OPEN) == 0) { 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!timer) 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7753d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch hpet = hpetp->hp_hpet; 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = read_counter(&timer->hpet_compare); 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = 0; 779ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch count = hpet_time_div(hpetp, TICK_CALIBRATE); 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start = read_counter(&hpet->hpet_mc); 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (i++, (m - start) < count); 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (m - start) / i; 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_alloc(struct hpet_data *hdp) 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7975761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner u64 cap, mcfg; 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7995761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner u32 i, ntimer; 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size_t siz; 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 8033e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap static struct hpets *last = NULL; 8045761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner unsigned long period; 805ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long temp; 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hpet_alloc can be called by platform dependent code. 8093e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * If platform dependent code has allocated the hpet that 8103e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * ACPI has also reported, then we catch it here. 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8123e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 8133e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: duplicate HPET ignored\n", 814bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__); 8153e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 8163e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds siz = sizeof(struct hpets) + ((hdp->hd_nirqs - 1) * 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct hpet_dev)); 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8213e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap hpetp = kzalloc(siz, GFP_KERNEL); 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!hpetp) 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_which = hpet_nhpet++; 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet = hdp->hd_address; 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet_phys = hdp->hd_phys_address; 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer = hdp->hd_nirqs; 831e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 8325761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner for (i = 0; i < hdp->hd_nirqs; i++) 8335761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner hpetp->hp_dev[i].hd_hdwirq = hdp->hd_irq[i]; 83437a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao 8355761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner hpet = hpetp->hp_hpet; 836e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap = readq(&hpet->hpet_cap); 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ntimer = ((cap & HPET_NUM_TIM_CAP_MASK) >> HPET_NUM_TIM_CAP_SHIFT) + 1; 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_ntimer != ntimer) { 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "hpet: number irqs doesn't agree" 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds " with number of timers\n"); 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(hpetp); 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last) 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last->hp_next = hpetp; 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpets = hpetp; 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last = hpetp; 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 855ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch period = (cap & HPET_COUNTER_CLK_PERIOD_MASK) >> 856ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch HPET_COUNTER_CLK_PERIOD_SHIFT; /* fs, 10^-15 */ 857ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp = 1000000000000000uLL; /* 10^15 femtoseconds per second */ 858ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp += period >> 1; /* round */ 859ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch do_div(temp, period); 860ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch hpetp->hp_tick_freq = temp; /* ticks per second */ 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8623034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen printk(KERN_INFO "hpet%d: at MMIO 0x%lx, IRQ%s", 8633034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen hpetp->hp_which, hdp->hd_phys_address, 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer > 1 ? "s" : ""); 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 8665761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner printk("%s %d", i > 0 ? "," : "", hdp->hd_irq[i]); 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("\n"); 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 869318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch printk(KERN_INFO "hpet%u: %u %d-bit timers, %Lu Hz\n", 870318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch hpetp->hp_which, hpetp->hp_ntimer, 871318db8f03bc06e6de98e98a568b6b2fa64233b87Clemens Ladisch cap & HPET_COUNTER_SIZE_MASK ? 64 : 32, hpetp->hp_tick_freq); 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg = readq(&hpet->hpet_config); 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((mcfg & HPET_ENABLE_CNF_MASK) == 0) { 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(0L, &hpet->hpet_mc); 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg |= HPET_ENABLE_CNF_MASK; 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(mcfg, &hpet->hpet_config); 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 880642d30bbc73512269de1524251ccc378d7782b85Clemens Ladisch for (i = 0, devp = hpetp->hp_dev; i < hpetp->hp_ntimer; i++, devp++) { 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = &hpet->hpet_timers[devp - hpetp->hp_dev]; 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpets = hpetp; 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpet = hpet; 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_timer = timer; 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If the timer was reserved by platform code, 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * then make timer unavailable for opens. 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hdp->hd_state & (1 << i)) { 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags = HPET_OPEN; 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&devp->hd_waitqueue); 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_delta = hpet_calibrate(hpetp); 9020aa366f351d044703e25c8425e508170e80d83b1Tony Luck 9033b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds/* This clocksource driver currently only works on ia64 */ 9043b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#ifdef CONFIG_IA64 9050aa366f351d044703e25c8425e508170e80d83b1Tony Luck if (!hpet_clocksource) { 9060aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_mctr = (void __iomem *)&hpetp->hp_hpet->hpet_mc; 9070aa366f351d044703e25c8425e508170e80d83b1Tony Luck CLKSRC_FSYS_MMIO_SET(clocksource_hpet.fsys_mmio, hpet_mctr); 9080aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_hpet.mult = clocksource_hz2mult(hpetp->hp_tick_freq, 9090aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_hpet.shift); 9100aa366f351d044703e25c8425e508170e80d83b1Tony Luck clocksource_register(&clocksource_hpet); 9110aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpetp->hp_clocksource = &clocksource_hpet; 9120aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_clocksource = &clocksource_hpet; 9130aa366f351d044703e25c8425e508170e80d83b1Tony Luck } 9143b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#endif 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic acpi_status hpet_resources(struct acpi_resource *res, void *data) 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data *hdp; 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status status; 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_resource_address64 addr; 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp = data; 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = acpi_resource_to_address64(res, &addr); 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_SUCCESS(status)) { 93050eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = addr.minimum; 9319224a867c497053842dc595e594ca6d32112221fBjorn Helgaas hdp->hd_address = ioremap(addr.minimum, addr.address_length); 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9333e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9343e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 935bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__, hdp->hd_phys_address); 9363e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 93778e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 9383e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 93950eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_FIXED_MEMORY32) { 94050eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_fixed_memory32 *fixmem32; 941757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 942757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap fixmem32 = &res->data.fixed_memory32; 943757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap if (!fixmem32) 94478e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_NO_MEMORY; 945757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 94650eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = fixmem32->address; 94750eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_address = ioremap(fixmem32->address, 948757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap HPET_RANGE_SIZE); 949757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 9503e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9513e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: 0x%lx is busy\n", 952bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__, hdp->hd_phys_address); 9533e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 95478e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 9553e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 95650eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_EXTENDED_IRQ) { 95750eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_extended_irq *irqp; 958be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas int i, irq; 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp = &res->data.extended_irq; 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 962be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas for (i = 0; i < irqp->interrupt_count; i++) { 963be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas irq = acpi_register_gsi(irqp->interrupts[i], 964be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas irqp->triggering, irqp->polarity); 965be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas if (irq < 0) 966be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas return AE_ERROR; 967be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas 968be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_irq[hdp->hd_nirqs] = irq; 969be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_nirqs++; 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return AE_OK; 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_add(struct acpi_device *device) 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status result; 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data data; 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&data, 0, sizeof(data)); 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_walk_resources(device->handle, METHOD_NAME__CRS, 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_resources, &data); 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_FAILURE(result)) 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!data.hd_address || !data.hd_nirqs) { 991bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison printk("%s: no address or irqs in _CRS\n", __func__); 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_alloc(&data); 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_remove(struct acpi_device *device, int type) 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10000aa366f351d044703e25c8425e508170e80d83b1Tony Luck /* XXX need to unregister clocksource, dealloc mem, etc */ 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10041ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renningerstatic const struct acpi_device_id hpet_device_ids[] = { 10051ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"PNP0103", 0}, 10061ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"", 0}, 10071ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger}; 10081ba90e3a87c46500623afdc3898573e4a5ebb21bThomas RenningerMODULE_DEVICE_TABLE(acpi, hpet_device_ids); 10091ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct acpi_driver hpet_acpi_driver = { 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "hpet", 10121ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger .ids = hpet_device_ids, 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ops = { 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .add = hpet_acpi_add, 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = hpet_acpi_remove, 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice hpet_misc = { HPET_MINOR, "hpet", &hpet_fops }; 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hpet_init(void) 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int result; 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = misc_register(&hpet_misc); 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10290b4d414714f0d2f922d39424b0c5c82ad900a381Eric W. Biederman sysctl_header = register_sysctl_table(dev_root); 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = acpi_bus_register_driver(&hpet_acpi_driver); 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) { 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return result; 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit hpet_exit(void) 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_bus_unregister_driver(&hpet_acpi_driver); 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(hpet_init); 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(hpet_exit); 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Bob Picco <Robert.Picco@hp.com>"); 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1057