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