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> 3254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann#include <linux/compat.h> 330aa366f351d044703e25c8425e508170e80d83b1Tony Luck#include <linux/clocksource.h> 340ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput#include <linux/uaccess.h> 355a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 360ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput#include <linux/io.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/current.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/div64.h> 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/acpi.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <acpi/acpi_bus.h> 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hpet.h> 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The High Precision Event Timer driver. 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This driver is closely modelled after the rtc.c driver. 49e45f2c07742d447597df001c878bc4a8aafcde37Denis V. Lunev * http://www.intel.com/hardwaredesign/hpetspec_1.pdf 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_USER_FREQ (64) 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DRIFT (500) 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 54757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap#define HPET_RANGE_SIZE 1024 /* from HPET spec */ 55757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 5664a76f667d987a559ad0726b4692c987800b22bcDavid Brownell 5764a76f667d987a559ad0726b4692c987800b22bcDavid Brownell/* WARNING -- don't get confused. These macros are never used 5864a76f667d987a559ad0726b4692c987800b22bcDavid Brownell * to write the (single) counter, and rarely to read it. 5964a76f667d987a559ad0726b4692c987800b22bcDavid Brownell * They're badly named; to fix, someday. 6064a76f667d987a559ad0726b4692c987800b22bcDavid Brownell */ 610aa366f351d044703e25c8425e508170e80d83b1Tony Luck#if BITS_PER_LONG == 64 620aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define write_counter(V, MC) writeq(V, MC) 630aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define read_counter(MC) readq(MC) 640aa366f351d044703e25c8425e508170e80d83b1Tony Luck#else 650aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define write_counter(V, MC) writel(V, MC) 660aa366f351d044703e25c8425e508170e80d83b1Tony Luck#define read_counter(MC) readl(MC) 670aa366f351d044703e25c8425e508170e80d83b1Tony Luck#endif 680aa366f351d044703e25c8425e508170e80d83b1Tony Luck 6954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannstatic DEFINE_MUTEX(hpet_mutex); /* replaces BKL */ 70642d30bbc73512269de1524251ccc378d7782b85Clemens Ladischstatic u32 hpet_nhpet, hpet_max_freq = HPET_USER_FREQ; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 723dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur/* This clocksource driver currently only works on ia64 */ 733dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur#ifdef CONFIG_IA64 740aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic void __iomem *hpet_mctr; 750aa366f351d044703e25c8425e508170e80d83b1Tony Luck 768e19608e8b5c001e4a66ce482edc474f05fb7355Magnus Dammstatic cycle_t read_hpet(struct clocksource *cs) 770aa366f351d044703e25c8425e508170e80d83b1Tony Luck{ 780aa366f351d044703e25c8425e508170e80d83b1Tony Luck return (cycle_t)read_counter((void __iomem *)hpet_mctr); 790aa366f351d044703e25c8425e508170e80d83b1Tony Luck} 800aa366f351d044703e25c8425e508170e80d83b1Tony Luck 810aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic struct clocksource clocksource_hpet = { 820ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput .name = "hpet", 830ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput .rating = 250, 840ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput .read = read_hpet, 850ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput .mask = CLOCKSOURCE_MASK(64), 860ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput .flags = CLOCK_SOURCE_IS_CONTINUOUS, 870aa366f351d044703e25c8425e508170e80d83b1Tony Luck}; 880aa366f351d044703e25c8425e508170e80d83b1Tony Luckstatic struct clocksource *hpet_clocksource; 893dffec45c2742961dd27f55aba426cb9cf3f0dcdS.Çağlar Onur#endif 900aa366f351d044703e25c8425e508170e80d83b1Tony Luck 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* A lock for concurrent access by app and isr hpet activity. */ 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(hpet_lock); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_DEV_NAME (7) 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpet_dev { 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hd_hpets; 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hd_hpet; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *hd_timer; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_ireqfreq; 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hd_irqdata; 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t hd_waitqueue; 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct fasync_struct *hd_async_queue; 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_flags; 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_irq; 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hd_hdwirq; 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char hd_name[HPET_DEV_NAME]; 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct hpets { 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hp_next; 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hp_hpet; 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_hpet_phys; 1140aa366f351d044703e25c8425e508170e80d83b1Tony Luck struct clocksource *hp_clocksource; 115ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long hp_tick_freq; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long hp_delta; 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_ntimer; 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int hp_which; 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev hp_dev[1]; 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct hpets *hpets; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_OPEN 0x0001 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_IE 0x0002 /* interrupt enabled */ 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define HPET_PERIODIC 0x0004 1270d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch#define HPET_SHARED_IRQ 0x0008 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef readq 131887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline unsigned long long readq(void __iomem *addr) 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return readl(addr) | (((unsigned long long)readl(addr + 4)) << 32LL); 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef writeq 138887c27f369abc458556a5ce8ab22ddd498474307Adrian Bunkstatic inline void writeq(unsigned long long v, void __iomem *addr) 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v & 0xffffffff, addr); 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v >> 32, addr + 4); 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1457d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t hpet_interrupt(int irq, void *data) 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long isr; 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = data; 1510d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 1520d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 1530d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if ((devp->hd_flags & HPET_SHARED_IRQ) && 1540d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch !(isr & readl(&devp->hd_hpet->hpet_isr))) 1550d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch return IRQ_NONE; 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&hpet_lock); 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata++; 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * For non-periodic timers, increment the accumulator. 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This has the effect of treating non-periodic like periodic. 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & (HPET_IE | HPET_PERIODIC)) == HPET_IE) { 165273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson unsigned long m, t, mc, base, k; 166273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson struct hpet __iomem *hpet = devp->hd_hpet; 167273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson struct hpets *hpetp = devp->hd_hpets; 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 170ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson m = read_counter(&devp->hd_timer->hpet_compare); 171273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson mc = read_counter(&hpet->hpet_mc); 172273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson /* The time for the next interrupt would logically be t + m, 173273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * however, if we are very unlucky and the interrupt is delayed 174273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * for longer than t then we will completely miss the next 175273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * interrupt if we set t + m and an application will hang. 176273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * Therefore we need to make a more complex computation assuming 177273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * that there exists a k for which the following is true: 178273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * k * t + base < mc + delta 179273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * (k + 1) * t + base > mc + delta 180273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * where t is the interval in hpet ticks for the given freq, 181273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * base is the theoretical start value 0 < base < t, 182273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * mc is the main counter value at the time of the interrupt, 183273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * delta is the time it takes to write the a value to the 184273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * comparator. 185273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson * k may then be computed as (mc - base + delta) / t . 186273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson */ 187273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson base = mc % t; 188273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson k = (mc - base + hpetp->hp_delta) / t; 189273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson write_counter(t * (k + 1) + base, 190273ef9509b7903e50f36aaf9f1d5dc9087fca506Nils Carlson &devp->hd_timer->hpet_compare); 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1930d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) 1940d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &devp->hd_hpet->hpet_isr); 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&hpet_lock); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up_interruptible(&devp->hd_waitqueue); 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kill_fasync(&devp->hd_async_queue, SIGIO, POLL_IN); 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Haostatic void hpet_timer_set_irq(struct hpet_dev *devp) 20570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao{ 20670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao unsigned long v; 20770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao int irq, gsi; 20870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao struct hpet_timer __iomem *timer; 20970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 21070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_lock_irq(&hpet_lock); 21170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (devp->hd_hdwirq) { 21270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 21370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao return; 21470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 21570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 21670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao timer = devp->hd_timer; 21770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 21870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* we prefer level triggered mode */ 21970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = readl(&timer->hpet_config); 22070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (!(v & Tn_INT_TYPE_CNF_MASK)) { 22170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v |= Tn_INT_TYPE_CNF_MASK; 22270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao writel(v, &timer->hpet_config); 22370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 22470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 22570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 22670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = (readq(&timer->hpet_config) & Tn_INT_ROUTE_CAP_MASK) >> 22770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao Tn_INT_ROUTE_CAP_SHIFT; 22870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 22970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* 23070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao * In PIC mode, skip IRQ0-4, IRQ6-9, IRQ12-15 which is always used by 23170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao * legacy device. In IO APIC mode, we skip all the legacy IRQS. 23270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao */ 23370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (acpi_irq_model == ACPI_IRQ_MODEL_PIC) 23470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v &= ~0xf3df; 23570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao else 23670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v &= ~0xffff; 23770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 238e5d6151115aee73825c1752aff7cd09adfece839Akinobu Mita for_each_set_bit(irq, &v, HPET_MAX_IRQ) { 2391f45f5621df82033cb4964d03530ade2f9a25e7bYinghai Lu if (irq >= nr_irqs) { 24070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao irq = HPET_MAX_IRQ; 24170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao break; 24270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 24370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 244a2f809b08ae4dddc1015c7dcd8659e5729e45b3eYinghai Lu gsi = acpi_register_gsi(NULL, irq, ACPI_LEVEL_SENSITIVE, 24570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao ACPI_ACTIVE_LOW); 24670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (gsi > 0) 24770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao break; 24870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 24970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao /* FIXME: Setup interrupt source table */ 25070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 25170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 25270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao if (irq < HPET_MAX_IRQ) { 25370ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_lock_irq(&hpet_lock); 25470ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v = readl(&timer->hpet_config); 25570ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao v |= irq << Tn_INT_ROUTE_CNF_SHIFT; 25670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao writel(v, &timer->hpet_config); 25770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao devp->hd_hdwirq = gsi; 25870ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao spin_unlock_irq(&hpet_lock); 25970ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao } 26070ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao return; 26170ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao} 26270ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_open(struct inode *inode, struct file *file) 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (file->f_mode & FMODE_WRITE) 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_lock(&hpet_mutex); 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (devp = NULL, hpetp = hpets; hpetp && !devp; hpetp = hpetp->hp_next) 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 27764a76f667d987a559ad0726b4692c987800b22bcDavid Brownell if (hpetp->hp_dev[i].hd_flags & HPET_OPEN) 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = &hpetp->hp_dev[i]; 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp) { 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 28654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_unlock(&hpet_mutex); 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = devp; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_OPEN; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 29454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_unlock(&hpet_mutex); 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29670ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao hpet_timer_set_irq(devp); 29770ef6d595b6e51618a0cbe44b848d8c9db11a010Kevin Hao 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ssize_t 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldshpet_read(struct file *file, char __user *buf, size_t count, loff_t * ppos) 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long data; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ssize_t retval; 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (count < sizeof(unsigned long)) 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&devp->hd_waitqueue, &wait); 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for ( ; ; ) { 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds data = devp->hd_irqdata; 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irqdata = 0; 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (data) 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (file->f_flags & O_NONBLOCK) { 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -EAGAIN; 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (signal_pending(current)) { 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -ERESTARTSYS; 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds schedule(); 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = put_user(data, (unsigned long __user *)buf); 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!retval) 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = sizeof(unsigned long); 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __set_current_state(TASK_RUNNING); 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&devp->hd_waitqueue, &wait); 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return retval; 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int hpet_poll(struct file *file, poll_table * wait) 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!devp->hd_ireqfreq) 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds poll_wait(file, &devp->hd_waitqueue, wait); 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = devp->hd_irqdata; 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (v != 0) 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return POLLIN | POLLRDNORM; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_mmap(struct file *file, struct vm_area_struct *vma) 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_HPET_MMAP 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long addr; 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (((vma->vm_end - vma->vm_start) != PAGE_SIZE) || vma->vm_pgoff) 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = devp->hd_hpets->hp_hpet_phys; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (addr & (PAGE_SIZE - 1)) 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_flags |= VM_IO; 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (io_remap_pfn_range(vma, vma->vm_start, addr >> PAGE_SHIFT, 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PAGE_SIZE, vma->vm_page_prot)) { 3903e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_ERR "%s: io_remap_pfn_range failed\n", 391bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EAGAIN; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOSYS; 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_fasync(int fd, struct file *file, int on) 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fasync_helper(fd, file, on, &devp->hd_async_queue) >= 0) 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_release(struct inode *inode, struct file *file) 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq = 0; 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp = file->private_data; 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq((readq(&timer->hpet_config) & ~Tn_INT_ENB_CNF_MASK), 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &timer->hpet_config); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_irq; 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_ireqfreq = 0; 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~(HPET_OPEN | HPET_IE | HPET_PERIODIC); 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(irq, devp); 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds file->private_data = NULL; 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_ioctl_ieon(struct hpet_dev *devp) 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int irq; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long g, v, t, m; 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags, isr; 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4649090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch if (!devp->hd_ireqfreq) 4659090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch return -EIO; 4669090e6db87e3bdb2a2c187ebc0f9175a9f9e5c6fClemens Ladisch 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_IE) { 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_IE; 4750d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch 4760d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (readl(&timer->hpet_config) & Tn_INT_TYPE_CNF_MASK) 4770d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_flags |= HPET_SHARED_IRQ; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = devp->hd_hdwirq; 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq) { 4830d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch unsigned long irq_flags; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 48596e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) { 48696e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch /* 48796e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch * To prevent the interrupt handler from seeing an 48896e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch * unwanted interrupt status bit, program the timer 48996e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch * so that it will not fire in the near future ... 49096e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch */ 49196e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch writel(readl(&timer->hpet_config) & ~Tn_TYPE_CNF_MASK, 49296e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch &timer->hpet_config); 49396e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch write_counter(read_counter(&hpet->hpet_mc), 49496e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch &timer->hpet_compare); 49596e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch /* ... and clear any left-over status. */ 49696e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 49796e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch writel(isr, &hpet->hpet_isr); 49896e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch } 49996e9694df446d1154ec2f4fdba8908588b9cba38Clemens Ladisch 5000d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch sprintf(devp->hd_name, "hpet%d", (int)(devp - hpetp->hp_dev)); 5010d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch irq_flags = devp->hd_flags & HPET_SHARED_IRQ 5020f2ed4c6bae23d2b7ef0ea2d272377e3de700c0cThomas Gleixner ? IRQF_SHARED : IRQF_DISABLED; 5030d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (request_irq(irq, hpet_interrupt, irq_flags, 5040d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch devp->hd_name, (void *)devp)) { 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "hpet: IRQ %d is not free\n", irq); 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irq = 0; 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (irq == 0) { 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&hpet_lock); 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&hpet_lock); 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = irq; 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = devp->hd_ireqfreq; 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 52064a76f667d987a559ad0726b4692c987800b22bcDavid Brownell 52164a76f667d987a559ad0726b4692c987800b22bcDavid Brownell /* 64-bit comparators are not yet supported through the ioctls, 52264a76f667d987a559ad0726b4692c987800b22bcDavid Brownell * so force this into 32-bit mode if it supports both modes 52364a76f667d987a559ad0726b4692c987800b22bcDavid Brownell */ 52464a76f667d987a559ad0726b4692c987800b22bcDavid Brownell g = v | Tn_32MODE_CNF_MASK | Tn_INT_ENB_CNF_MASK; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC) { 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds g |= Tn_TYPE_CNF_MASK; 528ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson v |= Tn_TYPE_CNF_MASK | Tn_VAL_SET_CNF_MASK; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 53164a76f667d987a559ad0726b4692c987800b22bcDavid Brownell 532ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson /* 533ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson * NOTE: First we modify the hidden accumulator 53464a76f667d987a559ad0726b4692c987800b22bcDavid Brownell * register supported by periodic-capable comparators. 53564a76f667d987a559ad0726b4692c987800b22bcDavid Brownell * We never want to modify the (single) counter; that 536ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson * would affect all the comparators. The value written 537ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson * is the counter value when the first interrupt is due. 53864a76f667d987a559ad0726b4692c987800b22bcDavid Brownell */ 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 541ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson /* 542ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson * Then we modify the comparator, indicating the period 543ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson * for subsequent interrupt. 544ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson */ 545ae21cf9248584d9b3776bfe2ebec47256bf098f8Nils Carlson write_counter(t, &timer->hpet_compare); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5520d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch if (devp->hd_flags & HPET_SHARED_IRQ) { 5533d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch isr = 1 << (devp - devp->hd_hpets->hp_dev); 5540d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch writel(isr, &hpet->hpet_isr); 5550d29086177aaa1e7d14e6ebb7fc067b3ca6d5c11Clemens Ladisch } 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(g, &timer->hpet_config); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 562ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch/* converts Hz to number of timer ticks */ 563ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladischstatic inline unsigned long hpet_time_div(struct hpets *hpets, 564ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long dis) 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 566ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long m; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 568ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch m = hpets->hp_tick_freq + (dis >> 1); 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_div(m, dis); 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (unsigned long)m; 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 57454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannhpet_ioctl_common(struct hpet_dev *devp, int cmd, unsigned long arg, 57554066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann struct hpet_info *info) 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long v; 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet = devp->hd_hpet; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp = devp->hd_hpets; 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_ON: 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_ioctl_ieon(devp); 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = 0; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IE_OFF: 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_IE) == 0) 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~Tn_INT_ENB_CNF_MASK; 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_irq) { 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(devp->hd_irq, devp); 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_irq = 0; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags ^= HPET_IE; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_INFO: 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 616dae512edc6e945e127f0848aa757055265d70aa2Vasiliy Kulikov memset(info, 0, sizeof(*info)); 617af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch if (devp->hd_ireqfreq) 61854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann info->hi_ireqfreq = 619af95eade68da4dfa29c5b64d79cffc9709facf00Clemens Ladisch hpet_time_div(hpetp, devp->hd_ireqfreq); 62054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann info->hi_flags = 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_PER_INT_CAP_MASK; 62254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann info->hi_hpet = hpetp->hp_which; 62354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann info->hi_timer = devp - hpetp->hp_dev; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_EPI: 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags |= HPET_PERIODIC; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_DPI: 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((v & Tn_PER_INT_CAP_MASK) == 0) { 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devp->hd_flags & HPET_PERIODIC && 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readq(&timer->hpet_config) & Tn_TYPE_CNF_MASK) { 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readq(&timer->hpet_config); 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v ^= Tn_TYPE_CNF_MASK; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(v, &timer->hpet_config); 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags &= ~HPET_PERIODIC; 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case HPET_IRQFREQ: 64954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann if ((arg > hpet_max_freq) && 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !capable(CAP_SYS_RESOURCE)) { 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EACCES; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 655189e2dd1376c1eb2f3a717a15f1ed8c7d0b3811aClemens Ladisch if (!arg) { 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINVAL; 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 660ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch devp->hd_ireqfreq = hpet_time_div(hpetp, arg); 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 66654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannstatic long 66754066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannhpet_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 66854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann{ 66954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann struct hpet_info info; 67054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann int err; 67154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 67254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_lock(&hpet_mutex); 67354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann err = hpet_ioctl_common(file->private_data, cmd, arg, &info); 67454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_unlock(&hpet_mutex); 67554066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 67654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann if ((cmd == HPET_INFO) && !err && 67754066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann (copy_to_user((void __user *)arg, &info, sizeof(info)))) 67854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann err = -EFAULT; 67954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 68054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann return err; 68154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann} 68254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 68354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann#ifdef CONFIG_COMPAT 68454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannstruct compat_hpet_info { 68554066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann compat_ulong_t hi_ireqfreq; /* Hz */ 68654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann compat_ulong_t hi_flags; /* information */ 68754066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann unsigned short hi_hpet; 68854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann unsigned short hi_timer; 68954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann}; 69054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 69154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannstatic long 69254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmannhpet_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 69354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann{ 69454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann struct hpet_info info; 69554066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann int err; 69654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 69754066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_lock(&hpet_mutex); 69854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann err = hpet_ioctl_common(file->private_data, cmd, arg, &info); 69954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann mutex_unlock(&hpet_mutex); 70054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 70154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann if ((cmd == HPET_INFO) && !err) { 70254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann struct compat_hpet_info __user *u = compat_ptr(arg); 70354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann if (put_user(info.hi_ireqfreq, &u->hi_ireqfreq) || 70454066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann put_user(info.hi_flags, &u->hi_flags) || 70554066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann put_user(info.hi_hpet, &u->hi_hpet) || 70654066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann put_user(info.hi_timer, &u->hi_timer)) 70754066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann err = -EFAULT; 70854066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann } 70954066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 71054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann return err; 71154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann} 71254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann#endif 71354066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann 71462322d2554d2f9680c8ace7bbf1f97d8fa84ad1aArjan van de Venstatic const struct file_operations hpet_fops = { 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = no_llseek, 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = hpet_read, 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = hpet_poll, 71955929332c92e5d34d65a8f784604c92677ea3e15Arnd Bergmann .unlocked_ioctl = hpet_ioctl, 72054066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann#ifdef CONFIG_COMPAT 72154066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann .compat_ioctl = hpet_compat_ioctl, 72254066a57c584ee8ce767053116fc4943ed1168b5Arnd Bergmann#endif 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = hpet_open, 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = hpet_release, 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fasync = hpet_fasync, 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = hpet_mmap, 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7293e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlapstatic int hpet_is_known(struct hpet_data *hdp) 7303e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap{ 7313e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap struct hpets *hpetp; 7323e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 7333e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap for (hpetp = hpets; hpetp; hpetp = hpetp->hp_next) 7343e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpetp->hp_hpet_phys == hdp->hd_phys_address) 7353e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 1; 7363e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 7373e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 7383e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap} 7393e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_table[] = { 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "max-user-freq", 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data = &hpet_max_freq, 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = sizeof(int), 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0644, 7466d4561110a3e9fa742aeec6717248a491dfb1878Eric W. Biederman .proc_handler = proc_dointvec, 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 748894d2491153a9f8270dbed21175d06fde4eba6c7Eric W. Biederman {} 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table hpet_root[] = { 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "hpet", 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_table, 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 758894d2491153a9f8270dbed21175d06fde4eba6c7Eric W. Biederman {} 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic ctl_table dev_root[] = { 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .procname = "dev", 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .maxlen = 0, 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mode = 0555, 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .child = hpet_root, 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 768894d2491153a9f8270dbed21175d06fde4eba6c7Eric W. Biederman {} 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct ctl_table_header *sysctl_header; 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Adjustment for when arming the timer with 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * initial conditions. That is, main counter 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ticks expired before interrupts are enabled. 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TICK_CALIBRATE (1000UL) 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 780303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Gotostatic unsigned long __hpet_calibrate(struct hpets *hpetp) 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer = NULL; 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long t, m, count, i, flags, start; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int j; 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (j = 0, devp = hpetp->hp_dev; j < hpetp->hp_ntimer; j++, devp++) 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((devp->hd_flags & HPET_OPEN) == 0) { 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = devp->hd_timer; 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!timer) 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7973d5640d1c7584689227256beeb63354c9a5baf2dClemens Ladisch hpet = hpetp->hp_hpet; 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t = read_counter(&timer->hpet_compare); 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = 0; 801ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch count = hpet_time_div(hpetp, TICK_CALIBRATE); 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_save(flags); 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start = read_counter(&hpet->hpet_mc); 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m = read_counter(&hpet->hpet_mc); 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (i++, (m - start) < count); 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds local_irq_restore(flags); 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (m - start) / i; 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 817303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Gotostatic unsigned long hpet_calibrate(struct hpets *hpetp) 818303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto{ 819303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto unsigned long ret = -1; 820303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto unsigned long tmp; 821303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto 822303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto /* 823303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto * Try to calibrate until return value becomes stable small value. 824303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto * If SMI interruption occurs in calibration loop, the return value 825303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto * will be big. This avoids its impact. 826303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto */ 827303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto for ( ; ; ) { 828303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto tmp = __hpet_calibrate(hpetp); 829303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto if (ret <= tmp) 830303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto break; 831303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto ret = tmp; 832303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto } 833303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto 834303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto return ret; 835303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto} 836303d379c54fc9ed553562e36c1cbd1791a3f5d17Yasunori Goto 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint hpet_alloc(struct hpet_data *hdp) 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8395761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner u64 cap, mcfg; 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_dev *devp; 8415761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner u32 i, ntimer; 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpets *hpetp; 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size_t siz; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet __iomem *hpet; 8450ca01763a028d0034042a9397534bc1f27848652Jaswinder Singh Rajput static struct hpets *last; 8465761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner unsigned long period; 847ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch unsigned long long temp; 848f92a789d259eb95afe7498ff5938fe2a93d39c82David Brownell u32 remainder; 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hpet_alloc can be called by platform dependent code. 8523e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * If platform dependent code has allocated the hpet that 8533e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap * ACPI has also reported, then we catch it here. 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8553e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 8563e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap printk(KERN_DEBUG "%s: duplicate HPET ignored\n", 857bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison __func__); 8583e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap return 0; 8593e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds siz = sizeof(struct hpets) + ((hdp->hd_nirqs - 1) * 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct hpet_dev)); 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8643e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap hpetp = kzalloc(siz, GFP_KERNEL); 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!hpetp) 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_which = hpet_nhpet++; 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet = hdp->hd_address; 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_hpet_phys = hdp->hd_phys_address; 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer = hdp->hd_nirqs; 874e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 8755761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner for (i = 0; i < hdp->hd_nirqs; i++) 8765761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner hpetp->hp_dev[i].hd_hdwirq = hdp->hd_irq[i]; 87737a47db8d7f0f38dac5acf5a13abbc8f401707faBalaji Rao 8785761d64b277c287a7520b868c32d656ef03374b4Thomas Gleixner hpet = hpetp->hp_hpet; 879e3f37a54f690d3e64995ea7ecea08c5ab3070fafBalaji Rao 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap = readq(&hpet->hpet_cap); 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ntimer = ((cap & HPET_NUM_TIM_CAP_MASK) >> HPET_NUM_TIM_CAP_SHIFT) + 1; 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hpetp->hp_ntimer != ntimer) { 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "hpet: number irqs doesn't agree" 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds " with number of timers\n"); 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(hpetp); 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last) 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last->hp_next = hpetp; 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpets = hpetp; 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last = hpetp; 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 898ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch period = (cap & HPET_COUNTER_CLK_PERIOD_MASK) >> 899ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch HPET_COUNTER_CLK_PERIOD_SHIFT; /* fs, 10^-15 */ 900ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp = 1000000000000000uLL; /* 10^15 femtoseconds per second */ 901ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch temp += period >> 1; /* round */ 902ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch do_div(temp, period); 903ba3f213f8a31af953b7e86b1d102c919e9935cd4Clemens Ladisch hpetp->hp_tick_freq = temp; /* ticks per second */ 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9053034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen printk(KERN_INFO "hpet%d: at MMIO 0x%lx, IRQ%s", 9063034d11c930f795d61321c9244c4ffaaabf0c282Andi Kleen hpetp->hp_which, hdp->hd_phys_address, 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_ntimer > 1 ? "s" : ""); 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < hpetp->hp_ntimer; i++) 9095da527aafed2834852fc4fe21daeaeadf7c61af3Kay Sievers printk(KERN_CONT "%s %d", i > 0 ? "," : "", hdp->hd_irq[i]); 9105da527aafed2834852fc4fe21daeaeadf7c61af3Kay Sievers printk(KERN_CONT "\n"); 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 912f92a789d259eb95afe7498ff5938fe2a93d39c82David Brownell temp = hpetp->hp_tick_freq; 913f92a789d259eb95afe7498ff5938fe2a93d39c82David Brownell remainder = do_div(temp, 1000000); 91464a76f667d987a559ad0726b4692c987800b22bcDavid Brownell printk(KERN_INFO 91564a76f667d987a559ad0726b4692c987800b22bcDavid Brownell "hpet%u: %u comparators, %d-bit %u.%06u MHz counter\n", 91664a76f667d987a559ad0726b4692c987800b22bcDavid Brownell hpetp->hp_which, hpetp->hp_ntimer, 91764a76f667d987a559ad0726b4692c987800b22bcDavid Brownell cap & HPET_COUNTER_SIZE_MASK ? 64 : 32, 918f92a789d259eb95afe7498ff5938fe2a93d39c82David Brownell (unsigned) temp, remainder); 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg = readq(&hpet->hpet_config); 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((mcfg & HPET_ENABLE_CNF_MASK) == 0) { 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_counter(0L, &hpet->hpet_mc); 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mcfg |= HPET_ENABLE_CNF_MASK; 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeq(mcfg, &hpet->hpet_config); 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 927642d30bbc73512269de1524251ccc378d7782b85Clemens Ladisch for (i = 0, devp = hpetp->hp_dev; i < hpetp->hp_ntimer; i++, devp++) { 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_timer __iomem *timer; 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timer = &hpet->hpet_timers[devp - hpetp->hp_dev]; 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpets = hpetp; 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_hpet = hpet; 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_timer = timer; 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If the timer was reserved by platform code, 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * then make timer unavailable for opens. 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hdp->hd_state & (1 << i)) { 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devp->hd_flags = HPET_OPEN; 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&devp->hd_waitqueue); 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpetp->hp_delta = hpet_calibrate(hpetp); 9490aa366f351d044703e25c8425e508170e80d83b1Tony Luck 9503b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds/* This clocksource driver currently only works on ia64 */ 9513b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#ifdef CONFIG_IA64 9520aa366f351d044703e25c8425e508170e80d83b1Tony Luck if (!hpet_clocksource) { 9530aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_mctr = (void __iomem *)&hpetp->hp_hpet->hpet_mc; 954574c44fa8fa6262ffd5939789ef51a6e98ed62d7Andy Lutomirski clocksource_hpet.archdata.fsys_mmio = hpet_mctr; 955d60c3041778c11f564969fb62b337df68232ee80John Stultz clocksource_register_hz(&clocksource_hpet, hpetp->hp_tick_freq); 9560aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpetp->hp_clocksource = &clocksource_hpet; 9570aa366f351d044703e25c8425e508170e80d83b1Tony Luck hpet_clocksource = &clocksource_hpet; 9580aa366f351d044703e25c8425e508170e80d83b1Tony Luck } 9593b2b64fd311c92f2137eb7cee7025794cd854057Linus Torvalds#endif 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic acpi_status hpet_resources(struct acpi_resource *res, void *data) 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data *hdp; 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status status; 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_resource_address64 addr; 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hdp = data; 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = acpi_resource_to_address64(res, &addr); 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_SUCCESS(status)) { 97550eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = addr.minimum; 9769224a867c497053842dc595e594ca6d32112221fBjorn Helgaas hdp->hd_address = ioremap(addr.minimum, addr.address_length); 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9783e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9793e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 98078e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 9813e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 98250eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_FIXED_MEMORY32) { 98350eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_fixed_memory32 *fixmem32; 984757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 985757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap fixmem32 = &res->data.fixed_memory32; 986757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap if (!fixmem32) 98778e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_NO_MEMORY; 988757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 98950eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_phys_address = fixmem32->address; 99050eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore hdp->hd_address = ioremap(fixmem32->address, 991757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap HPET_RANGE_SIZE); 992757c4724099a31a61754ea5202802eaa1def851cRandy Dunlap 9933e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap if (hpet_is_known(hdp)) { 9943e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap iounmap(hdp->hd_address); 99578e1ca49c7ead5cd00882ed0c776260857613122Zhao Yakui return AE_ALREADY_EXISTS; 9963e6716e748609a3a899e8d670e42832921bd45bcRandy Dunlap } 99750eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore } else if (res->type == ACPI_RESOURCE_TYPE_EXTENDED_IRQ) { 99850eca3eb89d73d9f0aa070b126c7ee6a616016abBob Moore struct acpi_resource_extended_irq *irqp; 999be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas int i, irq; 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds irqp = &res->data.extended_irq; 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1003be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas for (i = 0; i < irqp->interrupt_count; i++) { 1004a2f809b08ae4dddc1015c7dcd8659e5729e45b3eYinghai Lu irq = acpi_register_gsi(NULL, irqp->interrupts[i], 1005be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas irqp->triggering, irqp->polarity); 1006be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas if (irq < 0) 1007be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas return AE_ERROR; 1008be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas 1009be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_irq[hdp->hd_nirqs] = irq; 1010be5efffb762fa4a7b9a7a45ebf34b13e3bf5a2d8Bjorn Helgaas hdp->hd_nirqs++; 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return AE_OK; 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_add(struct acpi_device *device) 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_status result; 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct hpet_data data; 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&data, 0, sizeof(data)); 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_walk_resources(device->handle, METHOD_NAME__CRS, 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hpet_resources, &data); 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ACPI_FAILURE(result)) 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!data.hd_address || !data.hd_nirqs) { 1032a56d5318716d120e040294bb258901ba89fb9c90Jiri Slaby if (data.hd_address) 1033a56d5318716d120e040294bb258901ba89fb9c90Jiri Slaby iounmap(data.hd_address); 1034bf9d89295233ae2ba7b312c78ee5657307b09f4cHarvey Harrison printk("%s: no address or irqs in _CRS\n", __func__); 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hpet_alloc(&data); 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int hpet_acpi_remove(struct acpi_device *device, int type) 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10430aa366f351d044703e25c8425e508170e80d83b1Tony Luck /* XXX need to unregister clocksource, dealloc mem, etc */ 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10471ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renningerstatic const struct acpi_device_id hpet_device_ids[] = { 10481ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"PNP0103", 0}, 10491ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger {"", 0}, 10501ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger}; 10511ba90e3a87c46500623afdc3898573e4a5ebb21bThomas RenningerMODULE_DEVICE_TABLE(acpi, hpet_device_ids); 10521ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct acpi_driver hpet_acpi_driver = { 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "hpet", 10551ba90e3a87c46500623afdc3898573e4a5ebb21bThomas Renninger .ids = hpet_device_ids, 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ops = { 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .add = hpet_acpi_add, 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = hpet_acpi_remove, 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice hpet_misc = { HPET_MINOR, "hpet", &hpet_fops }; 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hpet_init(void) 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int result; 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = misc_register(&hpet_misc); 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10720b4d414714f0d2f922d39424b0c5c82ad900a381Eric W. Biederman sysctl_header = register_sysctl_table(dev_root); 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = acpi_bus_register_driver(&hpet_acpi_driver); 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (result < 0) { 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return result; 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit hpet_exit(void) 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_bus_unregister_driver(&hpet_acpi_driver); 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sysctl_header) 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_sysctl_table(sysctl_header); 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&hpet_misc); 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(hpet_init); 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(hpet_exit); 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Bob Picco <Robert.Picco@hp.com>"); 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 1100