11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * HP i8042-based System Device Controller driver. 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (c) 2001 Brian S. Julin 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * All rights reserved. 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Redistribution and use in source and binary forms, with or without 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * modification, are permitted provided that the following conditions 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * are met: 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1. Redistributions of source code must retain the above copyright 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * notice, this list of conditions, and the following disclaimer, 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * without modification. 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2. The name of the author may not be used to endorse or promote products 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * derived from this software without specific prior written permission. 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Alternatively, this software may be distributed under the terms of the 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License ("GPL"). 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * References: 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * System Device Controller Microprocessor Firmware Theory of Operation 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for Part Number 1820-4784 Revision B. Dwg No. A-1820-4784-2 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Helge Deller's original hilkbd.c port for PA-RISC. 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Driver theory of operation: 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 37ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * hp_sdc_put does all writing to the SDC. ISR can run on a different 38ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * CPU than hp_sdc_put, but only one CPU runs hp_sdc_put at a time 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (it cannot really benefit from SMP anyway.) A tasket fit this perfectly. 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * All data coming back from the SDC is sent via interrupt and can be read 42ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * fully in the ISR, so there are no latency/throughput problems there. 43ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * The problem is with output, due to the slow clock speed of the SDC 44ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * compared to the CPU. This should not be too horrible most of the time, 45ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * but if used with HIL devices that support the multibyte transfer command, 46ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * keeping outbound throughput flowing at the 6500KBps that the HIL is 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * capable of is more than can be done at HZ=100. 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 49ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * Busy polling for IBF clear wastes CPU cycles and bus cycles. hp_sdc.ibf 50ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * is set to 0 when the IBF flag in the status register has cleared. ISR 51ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * may do this, and may also access the parts of queued transactions related 52ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * to reading data back from the SDC, but otherwise will not touch the 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hp_sdc state. Whenever a register is written hp_sdc.ibf is set to 1. 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The i8042 write index and the values in the 4-byte input buffer 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * starting at 0x70 are kept track of in hp_sdc.wi, and .r7[], respectively, 57ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * to minimize the amount of IO needed to the SDC. However these values 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * do not need to be locked since they are only ever accessed by hp_sdc_put. 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A timer task schedules the tasklet once per second just to make 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * sure it doesn't freeze up and to allow for bad reads to time out. 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hp_sdc.h> 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioport.h> 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/time.h> 700f17e4c796e89d1f69f13b653aba60e6ccfb8ae0Matthew Wilcox#include <linux/semaphore.h> 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/slab.h> 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hil.h> 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Machine-specific abstraction */ 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# include <asm/parisc-device.h> 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# define sdc_readb(p) gsc_readb(p) 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# define sdc_writeb(v,p) gsc_writeb((v),(p)) 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#elif defined(__mc68000__) 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# include <asm/uaccess.h> 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# define sdc_readb(p) in_8(p) 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# define sdc_writeb(v,p) out_8((p),(v)) 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds# error "HIL is not supported on this platform" 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define PREFIX "HP SDC: " 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Brian S. Julin <bri@calyx.com>"); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("HP i8042-based SDC Driver"); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("Dual BSD/GPL"); 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_request_timer_irq); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_request_hil_irq); 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_request_cooked_irq); 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_release_timer_irq); 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_release_hil_irq); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_release_cooked_irq); 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1039575499dfebc0f0fbbf122223f02e9e92630661dHelge DellerEXPORT_SYMBOL(__hp_sdc_enqueue_transaction); 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_enqueue_transaction); 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(hp_sdc_dequeue_transaction); 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10790ab5ee94171b3e28de6bb42ee30b527014e0be7Rusty Russellstatic bool hp_sdc_disabled; 108305e342bba16730a0821131af6d7d0df43bfff4cHelge Dellermodule_param_named(no_hpsdc, hp_sdc_disabled, bool, 0); 109305e342bba16730a0821131af6d7d0df43bfff4cHelge DellerMODULE_PARM_DESC(no_hpsdc, "Do not enable HP SDC driver."); 110305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic hp_i8042_sdc hp_sdc; /* All driver state is kept in here. */ 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/*************** primitives for use in any context *********************/ 114ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic inline uint8_t hp_sdc_status_in8(void) 115ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t status; 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irqsave(&hp_sdc.ibf_lock, flags); 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = sdc_readb(hp_sdc.status_io); 121ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (!(status & HP_SDC_STATUS_IBF)) 122ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.ibf = 0; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return status; 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 128ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic inline uint8_t hp_sdc_data_in8(void) 129ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 130ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller return sdc_readb(hp_sdc.data_io); 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 133ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic inline void hp_sdc_status_out8(uint8_t val) 134ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irqsave(&hp_sdc.ibf_lock, flags); 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.ibf = 1; 139ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if ((val & 0xf0) == 0xe0) 140ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wi = 0xff; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sdc_writeb(val, hp_sdc.status_io); 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 145ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic inline void hp_sdc_data_out8(uint8_t val) 146ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irqsave(&hp_sdc.ibf_lock, flags); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.ibf = 1; 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sdc_writeb(val, hp_sdc.data_io); 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irqrestore(&hp_sdc.ibf_lock, flags); 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 155ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller/* Care must be taken to only invoke hp_sdc_spin_ibf when 156ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * absolutely needed, or in rarely invoked subroutines. 157ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * Not only does it waste CPU cycles, it also wastes bus cycles. 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 159ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic inline void hp_sdc_spin_ibf(void) 160ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rwlock_t *lock; 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds lock = &hp_sdc.ibf_lock; 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock_irqsave(lock, flags); 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!hp_sdc.ibf) { 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irqrestore(lock, flags); 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(lock); 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock(lock); 173ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller while (sdc_readb(hp_sdc.status_io) & HP_SDC_STATUS_IBF) 174ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller { } 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.ibf = 0; 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irqrestore(lock, flags); 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/************************ Interrupt context functions ************************/ 181ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic void hp_sdc_take(int irq, void *dev_id, uint8_t status, uint8_t data) 182ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_transaction *curr; 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.rtq_lock); 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.rcurr < 0) { 187ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller read_unlock(&hp_sdc.rtq_lock); 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr = hp_sdc.tq[hp_sdc.rcurr]; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.rtq_lock); 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->seq[curr->idx++] = status; 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->seq[curr->idx++] = data; 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.rqty -= 2; 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_gettimeofday(&hp_sdc.rtv); 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.rqty <= 0) { 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* All data has been gathered. */ 200ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->seq[curr->actidx] & HP_SDC_ACT_SEMAPHORE) 201ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->act.semaphore) 202ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller up(curr->act.semaphore); 203ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 204ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->seq[curr->actidx] & HP_SDC_ACT_CALLBACK) 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->act.irqhook) 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->act.irqhook(irq, dev_id, status, data); 207ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->actidx = curr->idx; 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Return control of this transaction */ 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock(&hp_sdc.rtq_lock); 212ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.rcurr = -1; 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.rqty = 0; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock(&hp_sdc.rtq_lock); 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 219ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic irqreturn_t hp_sdc_isr(int irq, void *dev_id) 220ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t status, data; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = hp_sdc_status_in8(); 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Read data unconditionally to advance i8042. */ 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds data = hp_sdc_data_in8(); 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* For now we are ignoring these until we get the SDC to behave. */ 228ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (((status & 0xf1) == 0x51) && data == 0x82) 229ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller return IRQ_HANDLED; 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller switch (status & HP_SDC_STATUS_IRQMASK) { 232ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case 0: /* This case is not documented. */ 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 234ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 235ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_USERTIMER: 236ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_PERIODIC: 237ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_TIMER: 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.hook_lock); 239ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.timer != NULL) 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.timer(irq, dev_id, status, data); 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.hook_lock); 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 243ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 244ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_REG: 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_take(irq, dev_id, status, data); 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 247ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 248ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_HILCMD: 249ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_HILDATA: 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.hook_lock); 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.hil != NULL) 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.hil(irq, dev_id, status, data); 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.hook_lock); 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 255ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 256ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller case HP_SDC_STATUS_PUP: 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.hook_lock); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.pup != NULL) 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.pup(irq, dev_id, status, data); 260ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller else 261ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller printk(KERN_INFO PREFIX "HP SDC reports successful PUP.\n"); 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.hook_lock); 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 264ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 265ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller default: 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.hook_lock); 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.cooked != NULL) 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.cooked(irq, dev_id, status, data); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.hook_lock); 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 272ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 277ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic irqreturn_t hp_sdc_nmisr(int irq, void *dev_id) 278ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int status; 280ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = hp_sdc_status_in8(); 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "NMI !\n"); 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 284ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller#if 0 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & HP_SDC_NMISTATUS_FHS) { 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock(&hp_sdc.hook_lock); 287ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.timer != NULL) 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.timer(irq, dev_id, status, 0); 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock(&hp_sdc.hook_lock); 290ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller } else { 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* TODO: pass this on to the HIL handler, or do SAK here? */ 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "HIL NMI\n"); 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 295ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/***************** Kernel (tasklet) context functions ****************/ 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsunsigned long hp_sdc_put(void); 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 304ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerstatic void hp_sdc_tasklet(unsigned long foo) 305ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.rtq_lock); 307ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.rcurr >= 0) { 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct timeval tv; 310ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_gettimeofday(&tv); 312ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (tv.tv_sec > hp_sdc.rtv.tv_sec) 313ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller tv.tv_usec += USEC_PER_SEC; 314ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (tv.tv_usec - hp_sdc.rtv.tv_usec > HP_SDC_MAX_REG_DELAY) { 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_transaction *curr; 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t tmp; 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr = hp_sdc.tq[hp_sdc.rcurr]; 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If this turns out to be a normal failure mode 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we'll need to figure out a way to communicate 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it back to the application. and be less verbose. 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "read timeout (%ius)!\n", 3257477fb6fbc339469ea945e007f3f7b3bb13b25f7Geert Uytterhoeven (int)(tv.tv_usec - hp_sdc.rtv.tv_usec)); 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx += hp_sdc.rqty; 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.rqty = 0; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = curr->seq[curr->actidx]; 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->seq[curr->actidx] |= HP_SDC_ACT_DEAD; 330ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (tmp & HP_SDC_ACT_SEMAPHORE) 331ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->act.semaphore) 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds up(curr->act.semaphore); 333ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 334ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (tmp & HP_SDC_ACT_CALLBACK) { 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Note this means that irqhooks may be called 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in tasklet/bh context. 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 338ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->act.irqhook) 3396ce6b3aeeae75eee34670bcd42870ac839bfec4cAl Viro curr->act.irqhook(0, NULL, 0, 0); 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 341ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->actidx = curr->idx; 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 344ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.rcurr = -1; 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.rtq_lock); 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_put(); 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 351ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerunsigned long hp_sdc_put(void) 352ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_transaction *curr; 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t act; 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx, curridx; 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int limit = 0; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock(&hp_sdc.lock); 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If i8042 buffers are full, we cannot do anything that 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds requires output, so we skip to the administrativa. */ 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.ibf) { 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_in8(); 365ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.ibf) 366ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto finish; 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds anew: 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* See if we are in the middle of a sequence. */ 371ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr < 0) 372ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr = 0; 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock_irq(&hp_sdc.rtq_lock); 374ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.rcurr == hp_sdc.wcurr) 375ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr++; 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irq(&hp_sdc.rtq_lock); 377ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) 378ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr = 0; 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curridx = hp_sdc.wcurr; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.tq[curridx] != NULL) 382ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto start; 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (++curridx != hp_sdc.wcurr) { 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curridx >= HP_SDC_QUEUE_LEN) { 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curridx = -1; /* Wrap to top */ 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock_irq(&hp_sdc.rtq_lock); 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.rcurr == curridx) { 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irq(&hp_sdc.rtq_lock); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irq(&hp_sdc.rtq_lock); 395ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.tq[curridx] != NULL) 396ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller break; /* Found one. */ 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curridx == hp_sdc.wcurr) { /* There's nothing queued to do. */ 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curridx = -1; 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wcurr = curridx; 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start: 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check to see if the interrupt mask needs to be set. */ 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.set_im) { 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_out8(hp_sdc.im | HP_SDC_CMD_SET_IM); 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 0; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 412ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr == -1) 413ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto done; 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr = hp_sdc.tq[curridx]; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx = curr->actidx; 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->actidx >= curr->endidx) { 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.tq[curridx] = NULL; 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Interleave outbound data between the transactions. */ 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wcurr++; 422ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) 423ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr = 0; 424ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto finish; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act = curr->seq[idx]; 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx++; 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->idx >= curr->endidx) { 431ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (act & HP_SDC_ACT_DEALLOC) 432ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller kfree(curr); 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.tq[curridx] = NULL; 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Interleave outbound data between the transactions. */ 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wcurr++; 436ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) 437ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr = 0; 438ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto finish; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (act & HP_SDC_ACT_PRECMD) { 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->idx != idx) { 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx++; 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act &= ~HP_SDC_ACT_PRECMD; 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_out8(curr->seq[idx]); 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* act finished? */ 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_PRECMD) 451ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto actdone; 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* skip quantity field if data-out sequence follows. */ 453ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (act & HP_SDC_ACT_DATAOUT) 454ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller curr->idx++; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (act & HP_SDC_ACT_DATAOUT) { 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int qty; 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds qty = curr->seq[idx]; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx++; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->idx - idx < qty) { 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_data_out8(curr->seq[curr->idx]); 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* act finished? */ 466ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (curr->idx - idx >= qty && 467ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller (act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAOUT) 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto actdone; 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx += qty; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act &= ~HP_SDC_ACT_DATAOUT; 473ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller } else 474ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller while (act & HP_SDC_ACT_DATAREG) { 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int mask; 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t w7[4]; 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask = curr->seq[idx]; 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx != curr->idx) { 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx++; 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx += !!(mask & 1); 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx += !!(mask & 2); 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx += !!(mask & 4); 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx += !!(mask & 8); 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act &= ~HP_SDC_ACT_DATAREG; 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 488ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds w7[0] = (mask & 1) ? curr->seq[++idx] : hp_sdc.r7[0]; 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds w7[1] = (mask & 2) ? curr->seq[++idx] : hp_sdc.r7[1]; 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds w7[2] = (mask & 4) ? curr->seq[++idx] : hp_sdc.r7[2]; 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds w7[3] = (mask & 8) ? curr->seq[++idx] : hp_sdc.r7[3]; 493ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.wi > 0x73 || hp_sdc.wi < 0x70 || 495ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller w7[hp_sdc.wi - 0x70] == hp_sdc.r7[hp_sdc.wi - 0x70]) { 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i = 0; 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 498ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller /* Need to point the write index register */ 499ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller while (i < 4 && w7[i] == hp_sdc.r7[i]) 500ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller i++; 501ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i < 4) { 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_out8(HP_SDC_CMD_SET_D0 + i); 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wi = 0x70 + i; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 507ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idx++; 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((act & HP_SDC_ACT_DURING) == HP_SDC_ACT_DATAREG) 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto actdone; 511ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx = idx; 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act &= ~HP_SDC_ACT_DATAREG; 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_data_out8(w7[hp_sdc.wi - 0x70]); 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7[hp_sdc.wi - 0x70] = w7[hp_sdc.wi - 0x70]; 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wi++; /* write index register autoincrements */ 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i = 0; 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 523ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller while ((i < 4) && w7[i] == hp_sdc.r7[i]) 524ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller i++; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (i >= 4) { 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx = idx + 1; 527ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if ((act & HP_SDC_ACT_DURING) == 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds HP_SDC_ACT_DATAREG) 529ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto actdone; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* We don't go any further in the command if there is a pending read, 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds because we don't want interleaved results. */ 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_lock_irq(&hp_sdc.rtq_lock); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.rcurr >= 0) { 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irq(&hp_sdc.rtq_lock); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_unlock_irq(&hp_sdc.rtq_lock); 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (act & HP_SDC_ACT_POSTCMD) { 545ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller uint8_t postcmd; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* curr->idx should == idx at this point. */ 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds postcmd = curr->seq[idx]; 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (act & HP_SDC_ACT_DATAIN) { 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Start a new read */ 553ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.rqty = curr->seq[curr->idx]; 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_gettimeofday(&hp_sdc.rtv); 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx++; 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Still need to lock here in case of spurious irq. */ 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.rtq_lock); 558ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.rcurr = curridx; 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.rtq_lock); 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_out8(postcmd); 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto finish; 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_out8(postcmd); 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto actdone; 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 567ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller actdone: 568ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (act & HP_SDC_ACT_SEMAPHORE) 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds up(curr->act.semaphore); 570ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller else if (act & HP_SDC_ACT_CALLBACK) 5716ce6b3aeeae75eee34670bcd42870ac839bfec4cAl Viro curr->act.irqhook(0,NULL,0,0); 572ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr->idx >= curr->endidx) { /* This transaction is over. */ 574ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (act & HP_SDC_ACT_DEALLOC) 575ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller kfree(curr); 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.tq[curridx] = NULL; 577ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller } else { 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->actidx = idx + 1; 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr->idx = idx + 2; 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Interleave outbound data between the transactions. */ 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wcurr++; 583ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr >= HP_SDC_QUEUE_LEN) 584ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.wcurr = 0; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds finish: 587ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller /* If by some quirk IBF has cleared and our ISR has run to 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds see that that has happened, do it all again. */ 589ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (!hp_sdc.ibf && limit++ < 20) 590ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto anew; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds done: 593ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.wcurr >= 0) 594ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller tasklet_schedule(&hp_sdc.task); 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock(&hp_sdc.lock); 596ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/******* Functions called in either user or kernel context ****/ 6019575499dfebc0f0fbbf122223f02e9e92630661dHelge Dellerint __hp_sdc_enqueue_transaction(hp_sdc_transaction *this) 602ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (this == NULL) { 6069575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller BUG(); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 608ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller } 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Can't have same transaction on queue twice */ 611ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller for (i = 0; i < HP_SDC_QUEUE_LEN; i++) 612ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.tq[i] == this) 613ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto fail; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds this->actidx = 0; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds this->idx = 1; 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Search for empty slot */ 619ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller for (i = 0; i < HP_SDC_QUEUE_LEN; i++) 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.tq[i] == NULL) { 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.tq[i] = this; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 625ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "No free slot to add transaction.\n"); 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fail: 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "Transaction add failed: transaction already queued?\n"); 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6349575499dfebc0f0fbbf122223f02e9e92630661dHelge Dellerint hp_sdc_enqueue_transaction(hp_sdc_transaction *this) { 6359575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller unsigned long flags; 6369575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller int ret; 6379575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller 6389575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller write_lock_irqsave(&hp_sdc.lock, flags); 6399575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller ret = __hp_sdc_enqueue_transaction(this); 6409575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller write_unlock_irqrestore(&hp_sdc.lock,flags); 6419575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller 6429575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller return ret; 6439575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller} 6449575499dfebc0f0fbbf122223f02e9e92630661dHelge Deller 645ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_dequeue_transaction(hp_sdc_transaction *this) 646ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irqsave(&hp_sdc.lock, flags); 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* TODO: don't remove it if it's not done. */ 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 654ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller for (i = 0; i < HP_SDC_QUEUE_LEN; i++) 655ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.tq[i] == this) 656ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc.tq[i] = NULL; 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irqrestore(&hp_sdc.lock, flags); 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/********************** User context functions **************************/ 665ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_request_timer_irq(hp_sdc_irqhook *callback) 666ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 667ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (callback == NULL || hp_sdc.dev == NULL) 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 669ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.timer != NULL) { 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.timer = callback; 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Enable interrupts from the timers */ 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im &= ~HP_SDC_IM_FH; 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im &= ~HP_SDC_IM_PT; 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im &= ~HP_SDC_IM_TIMERS; 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 689ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_request_hil_irq(hp_sdc_irqhook *callback) 690ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 691ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (callback == NULL || hp_sdc.dev == NULL) 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 693ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.hil != NULL) { 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.hil = callback; 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im &= ~(HP_SDC_IM_HIL | HP_SDC_IM_RESET); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 710ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_request_cooked_irq(hp_sdc_irqhook *callback) 711ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 712ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (callback == NULL || hp_sdc.dev == NULL) 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 714ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.cooked != NULL) { 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Enable interrupts from the HIL MLC */ 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.cooked = callback; 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im &= ~(HP_SDC_IM_HIL | HP_SDC_IM_RESET); 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 732ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_release_timer_irq(hp_sdc_irqhook *callback) 733ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((callback != hp_sdc.timer) || 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (hp_sdc.timer == NULL)) { 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Disable interrupts from the timers */ 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.timer = NULL; 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im |= HP_SDC_IM_TIMERS; 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im |= HP_SDC_IM_FH; 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im |= HP_SDC_IM_PT; 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 753ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_release_hil_irq(hp_sdc_irqhook *callback) 754ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((callback != hp_sdc.hil) || 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (hp_sdc.hil == NULL)) { 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.hil = NULL; 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Disable interrupts from HIL only if there is no cooked driver. */ 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(hp_sdc.cooked == NULL) { 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im |= (HP_SDC_IM_HIL | HP_SDC_IM_RESET); 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 774ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Dellerint hp_sdc_release_cooked_irq(hp_sdc_irqhook *callback) 775ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.hook_lock); 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((callback != hp_sdc.cooked) || 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (hp_sdc.cooked == NULL)) { 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.cooked = NULL; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Disable interrupts from HIL only if there is no raw HIL driver. */ 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(hp_sdc.hil == NULL) { 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im |= (HP_SDC_IM_HIL | HP_SDC_IM_RESET); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.hook_lock); 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/************************* Keepalive timer task *********************/ 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 797dc3e8247eb90655c0ff01ce03bdf3aa5868f1cdeAxel Linstatic void hp_sdc_kicker(unsigned long data) 798ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller{ 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_schedule(&hp_sdc.task); 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Re-insert the periodic task. */ 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mod_timer(&hp_sdc.kicker, jiffies + HZ); 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/************************** Module Initialization ***************************/ 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8083acaf540a33199141695f2e2fcfa8829053159bfHelge Dellerstatic const struct parisc_device_id hp_sdc_tbl[] = { 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 810ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller .hw_type = HPHW_FIO, 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .hversion_rev = HVERSION_REV_ANY_ID, 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .hversion = HVERSION_ANY_ID, 813ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller .sversion = 0x73, 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 0, } 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DEVICE_TABLE(parisc, hp_sdc_tbl); 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hp_sdc_init_hppa(struct parisc_device *d); 821aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Dellerstatic struct delayed_work moduleloader_work; 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct parisc_driver hp_sdc_driver = { 824bdad1f836ab1ca2b18a625222f63f630cfd14e41Matthew Wilcox .name = "hp_sdc", 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .id_table = hp_sdc_tbl, 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = hp_sdc_init_hppa, 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif /* __hppa__ */ 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hp_sdc_init(void) 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char *errstr; 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_transaction t_sync; 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t ts_sync[6]; 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct semaphore s_sync; 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 838ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller rwlock_init(&hp_sdc.lock); 839ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller rwlock_init(&hp_sdc.ibf_lock); 840ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller rwlock_init(&hp_sdc.rtq_lock); 841ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller rwlock_init(&hp_sdc.hook_lock); 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.timer = NULL; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.hil = NULL; 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.pup = NULL; 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.cooked = NULL; 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.im = HP_SDC_IM_MASK; /* Mask maskable irqs */ 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.set_im = 1; 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wi = 0xff; 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7[0] = 0xff; 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7[1] = 0xff; 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7[2] = 0xff; 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7[3] = 0xff; 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.ibf = 1; 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 856ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller memset(&hp_sdc.tq, 0, sizeof(hp_sdc.tq)); 857ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.wcurr = -1; 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.rcurr = -1; 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.rqty = 0; 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev_err = -ENODEV; 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr = "IO not found for"; 865ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (!hp_sdc.base_io) 866ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto err0; 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr = "IRQ not found for"; 869ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (!hp_sdc.irq) 870ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto err0; 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev_err = -EBUSY; 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr = "IO not available for"; 876ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (request_region(hp_sdc.data_io, 2, hp_sdc_driver.name)) 877ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto err0; 878ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller#endif 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr = "IRQ not available for"; 8813acaf540a33199141695f2e2fcfa8829053159bfHelge Deller if (request_irq(hp_sdc.irq, &hp_sdc_isr, IRQF_SHARED|IRQF_SAMPLE_RANDOM, 882ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller "HP SDC", &hp_sdc)) 883ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto err1; 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr = "NMI not available for"; 8863acaf540a33199141695f2e2fcfa8829053159bfHelge Deller if (request_irq(hp_sdc.nmi, &hp_sdc_nmisr, IRQF_SHARED, 887ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller "HP SDC NMI", &hp_sdc)) 888ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller goto err2; 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 890ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller printk(KERN_INFO PREFIX "HP SDC at 0x%p, IRQ %d (NMI IRQ %d)\n", 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_status_in8(); 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_data_in8(); 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_init(&hp_sdc.task, hp_sdc_tasklet, 0); 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Sync the output buffer registers, thus scheduling hp_sdc_tasklet. */ 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t_sync.actidx = 0; 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t_sync.idx = 1; 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t_sync.endidx = 6; 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t_sync.seq = ts_sync; 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ts_sync[0] = HP_SDC_ACT_DATAREG | HP_SDC_ACT_SEMAPHORE; 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ts_sync[1] = 0x0f; 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ts_sync[2] = ts_sync[3] = ts_sync[4] = ts_sync[5] = 0; 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds t_sync.act.semaphore = &s_sync; 9074a4a506f81eebe63fb1b8e9e99f4bcd1fd9aac66Thomas Gleixner sema_init(&s_sync, 0); 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_enqueue_transaction(&t_sync); 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&s_sync); /* Wait for t_sync to complete */ 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Create the keepalive task */ 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_timer(&hp_sdc.kicker); 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.kicker.expires = jiffies + HZ; 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.kicker.function = &hp_sdc_kicker; 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_timer(&hp_sdc.kicker); 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev_err = 0; 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err2: 9203acaf540a33199141695f2e2fcfa8829053159bfHelge Deller free_irq(hp_sdc.irq, &hp_sdc); 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err1: 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_region(hp_sdc.data_io, 2); 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err0: 924ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller printk(KERN_WARNING PREFIX ": %s SDC IO=0x%p IRQ=0x%x NMI=0x%x\n", 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds errstr, (void *)hp_sdc.base_io, hp_sdc.irq, hp_sdc.nmi); 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev = NULL; 927ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hp_sdc.dev_err; 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 933aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Dellerstatic void request_module_delayed(struct work_struct *work) 934aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller{ 935aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller request_module("hp_sdc_mlc"); 936aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller} 937aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hp_sdc_init_hppa(struct parisc_device *d) 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 940aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller int ret; 941aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller 942ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (!d) 943ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller return 1; 944ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.dev != NULL) 945ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller return 1; /* We only expect one SDC */ 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev = d; 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.irq = d->irq; 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.nmi = d->aux_irq; 95053f01bba49938f115237fe43a261c31ac13ae5c6Matthew Wilcox hp_sdc.base_io = d->hpa.start; 95153f01bba49938f115237fe43a261c31ac13ae5c6Matthew Wilcox hp_sdc.data_io = d->hpa.start + 0x800; 95253f01bba49938f115237fe43a261c31ac13ae5c6Matthew Wilcox hp_sdc.status_io = d->hpa.start + 0x801; 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 954aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller INIT_DELAYED_WORK(&moduleloader_work, request_module_delayed); 955aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller 956aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller ret = hp_sdc_init(); 95725985edcedea6396277003854657b5f3cb31a628Lucas De Marchi /* after successful initialization give SDC some time to settle 958aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller * and then load the hp_sdc_mlc upper layer driver */ 959aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller if (!ret) 960aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller schedule_delayed_work(&moduleloader_work, 961aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller msecs_to_jiffies(2000)); 962aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller 963aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller return ret; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif /* __hppa__ */ 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void hp_sdc_exit(void) 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 970aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller /* do nothing if we don't have a SDC */ 971aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller if (!hp_sdc.dev) 972aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller return; 973aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_lock_irq(&hp_sdc.lock); 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Turn off all maskable "sub-function" irq's. */ 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_spin_ibf(); 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sdc_writeb(HP_SDC_CMD_SET_IM | HP_SDC_IM_MASK, hp_sdc.status_io); 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Wait until we know this has been processed by the i8042 */ 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_spin_ibf(); 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9833acaf540a33199141695f2e2fcfa8829053159bfHelge Deller free_irq(hp_sdc.nmi, &hp_sdc); 9843acaf540a33199141695f2e2fcfa8829053159bfHelge Deller free_irq(hp_sdc.irq, &hp_sdc); 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_unlock_irq(&hp_sdc.lock); 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&hp_sdc.kicker); 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tasklet_kill(&hp_sdc.task); 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 992aa0b8f3687f06ac0e5a2b24547fdf431e923c475Helge Deller cancel_delayed_work_sync(&moduleloader_work); 993ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (unregister_parisc_driver(&hp_sdc_driver)) 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "Error unregistering HP SDC"); 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init hp_sdc_register(void) 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_transaction tq_init; 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint8_t tq_init_seq[5]; 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct semaphore tq_init_sem; 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__mc68000__) 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mm_segment_t fs; 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char i; 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1007ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller 1008305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller if (hp_sdc_disabled) { 1009305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller printk(KERN_WARNING PREFIX "HP SDC driver disabled by no_hpsdc=1.\n"); 1010305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller return -ENODEV; 1011305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller } 1012305e342bba16730a0821131af6d7d0df43bfff4cHelge Deller 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev = NULL; 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev_err = 0; 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(__hppa__) 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (register_parisc_driver(&hp_sdc_driver)) { 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "Error registering SDC with system bus tree.\n"); 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#elif defined(__mc68000__) 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!MACH_IS_HP300) 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.irq = 1; 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.nmi = 7; 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.base_io = (unsigned long) 0xf0428000; 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.data_io = (unsigned long) hp_sdc.base_io + 1; 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.status_io = (unsigned long) hp_sdc.base_io + 3; 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs = get_fs(); 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_fs(KERNEL_DS); 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!get_user(i, (unsigned char *)hp_sdc.data_io)) 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev = (void *)1; 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_fs(fs); 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.dev_err = hp_sdc_init(); 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.dev == NULL) { 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "No SDC found.\n"); 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return hp_sdc.dev_err; 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10414a4a506f81eebe63fb1b8e9e99f4bcd1fd9aac66Thomas Gleixner sema_init(&tq_init_sem, 0); 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.actidx = 0; 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.idx = 1; 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.endidx = 5; 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.seq = tq_init_seq; 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.act.semaphore = &tq_init_sem; 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1049ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller tq_init_seq[0] = 1050ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN | HP_SDC_ACT_SEMAPHORE; 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[1] = HP_SDC_CMD_READ_KCC; 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[2] = 1; 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[3] = 0; 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[4] = 0; 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_enqueue_transaction(&tq_init); 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&tq_init_sem); 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds up(&tq_init_sem); 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((tq_init_seq[0] & HP_SDC_ACT_DEAD) == HP_SDC_ACT_DEAD) { 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "Error reading config byte.\n"); 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc_exit(); 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r11 = tq_init_seq[4]; 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (hp_sdc.r11 & HP_SDC_CFG_NEW) { 1068ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller const char *str; 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PREFIX "New style SDC\n"); 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[1] = HP_SDC_CMD_READ_XTD; 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.actidx = 0; 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.idx = 1; 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&tq_init_sem); 1074ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc_enqueue_transaction(&tq_init); 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&tq_init_sem); 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds up(&tq_init_sem); 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((tq_init_seq[0] & HP_SDC_ACT_DEAD) == HP_SDC_ACT_DEAD) { 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING PREFIX "Error reading extended config byte.\n"); 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hp_sdc.r7e = tq_init_seq[4]; 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds HP_SDC_XTD_REV_STRINGS(hp_sdc.r7e & HP_SDC_XTD_REV, str) 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PREFIX "Revision: %s\n", str); 1084ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.r7e & HP_SDC_XTD_BEEPER) 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PREFIX "TI SN76494 beeper present\n"); 1086ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller if (hp_sdc.r7e & HP_SDC_XTD_BBRTC) 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PREFIX "OKI MSM-58321 BBRTC present\n"); 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PREFIX "Spunking the self test register to force PUP " 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "on next firmware reset.\n"); 1090ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller tq_init_seq[0] = HP_SDC_ACT_PRECMD | 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds HP_SDC_ACT_DATAOUT | HP_SDC_ACT_SEMAPHORE; 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[1] = HP_SDC_CMD_SET_STR; 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[2] = 1; 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init_seq[3] = 0; 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.actidx = 0; 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.idx = 1; 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tq_init.endidx = 4; 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&tq_init_sem); 1099ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller hp_sdc_enqueue_transaction(&tq_init); 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds down(&tq_init_sem); 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds up(&tq_init_sem); 1102ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller } else 1103ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller printk(KERN_INFO PREFIX "Old style SDC (1820-%s).\n", 11041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (hp_sdc.r11 & HP_SDC_CFG_REV) ? "3300" : "2564/3087"); 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(hp_sdc_register); 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(hp_sdc_exit); 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1112ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller/* Timing notes: These measurements taken on my 64MHz 7100-LC (715/64) 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * cycles cycles-adj time 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * between two consecutive mfctl(16)'s: 4 n/a 63ns 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * hp_sdc_spin_ibf when idle: 119 115 1.7us 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * gsc_writeb status register: 83 79 1.2us 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * IBF to clear after sending SET_IM: 6204 6006 93us 1118ffd51f46cdf856c0b453d2828a74d552cc15f881Helge Deller * IBF to clear after sending LOAD_RT: 4467 4352 68us 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * IBF to clear after sending two LOAD_RTs: 18974 18859 295us 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * READ_T1, read status/data, IRQ, call handler: 35564 n/a 556us 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * cmd to ~IBF READ_T1 2nd time right after: 5158403 n/a 81ms 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * between IRQ received and ~IBF for above: 2578877 n/a 40ms 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Performance stats after a run of this module configuring HIL and 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * receiving a few mouse events: 11261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * status in8 282508 cycles 7128 calls 11281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * status out8 8404 cycles 341 calls 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * data out8 1734 cycles 78 calls 11301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * isr 174324 cycles 617 calls (includes take) 11311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * take 1241 cycles 2 calls 11321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * put 1411504 cycles 6937 calls 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * task 1655209 cycles 6937 calls (includes put) 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1136