Linux/Unix编程

开发平台：
Unix_Linux

lasi.c：源码内容
							/*
 *	LASI Device Driver
 *
 *	(c) Copyright 1999 Red Hat Software
 *	Portions (c) Copyright 1999 The Puffin Group Inc.
 *	Portions (c) Copyright 1999 Hewlett-Packard
 *
 *	This program is free software; you can redistribute it and/or modify
 *	it under the terms of the GNU General Public License as published by
 *      the Free Software Foundation; either version 2 of the License, or
 *      (at your option) any later version.
 *
 *	by Alan Cox <alan@redhat.com> and 
 * 	   Alex deVries <adevries@thepuffingroup.com> 
 */
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/irq.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/pm.h>
#include <linux/slab.h>
#include <linux/types.h>
#include <asm/gsc.h>
#include <asm/hardware.h>
#include <asm/led.h>
#include "busdevice.h"
#define LASI_VER	0xC008	/* LASI Version */
#define LASI_IO_CONF	0x7FFFE	/* LASI primary configuration register */
#define LASI_IO_CONF2	0x7FFFF	/* LASI secondary configuration register */
static int lasi_choose_irq(struct parisc_device *dev)
{
	int irq;
	/*
	** "irq" bits below are numbered relative to most significant bit.
	*/
	switch (dev->id.sversion) {
		case 0x74:	irq = 24; break; /* Centronics */
		case 0x7B:	irq = 18; break; /* Audio */
		case 0x81:	irq = 17; break; /* Lasi itself */
		case 0x82:	irq = 22; break; /* SCSI */
		case 0x83:	irq = 11; break; /* Floppy */
		case 0x84:	irq =  5; break; /* PS/2 Keyboard */
		case 0x87:	irq = 13; break; /* ISDN */
		case 0x8A:	irq = 23; break; /* LAN */
		case 0x8C:	irq = 26; break; /* RS232 */
		case 0x8D:	irq = (dev->hw_path == 13) ? 15 : 14;
						break; /* Telephone */
		default: 	irq = -1; break; /* unknown */
	}
	return irq;
}
static void __init
lasi_init_irq(struct busdevice *this_lasi)
{
	unsigned long lasi_base = this_lasi->hpa;
	/* Stop LASI barking for a bit */
	gsc_writel(0x00000000, lasi_base+OFFSET_IMR);
	/* clear pending interrupts */
	gsc_readl(lasi_base+OFFSET_IRR);
	/* We're not really convinced we want to reset the onboard
         * devices. Firmware does it for us...
	 */
	/* Resets */
	/* gsc_writel(0xFFFFFFFF, lasi_base+0x2000);*/	/* Parallel */
	gsc_writel(0xFFFFFFFF, lasi_base+0x4004);	/* Audio */
	/* gsc_writel(0xFFFFFFFF, lasi_base+0x5000);*/	/* Serial */ 
	/* gsc_writel(0xFFFFFFFF, lasi_base+0x6000);*/	/* SCSI */
	gsc_writel(0xFFFFFFFF, lasi_base+0x7000);	/* LAN */
	gsc_writel(0xFFFFFFFF, lasi_base+0x8000);	/* Keyboard */
	gsc_writel(0xFFFFFFFF, lasi_base+0xA000);	/* FDC */
	
	/* Ok we hit it on the head with a hammer, our Dog is now
	** comatose and muzzled.  Devices will now unmask LASI
	** interrupts as they are registered as irq's in the LASI range.
	*/
	/* XXX: I thought it was `awks that got `it on the `ead with an
	 * `ammer.  -- willy
	 */
}
/*
   ** lasi_led_init()
   ** 
   ** lasi_led_init() initializes the LED controller on the LASI.
   **
   ** Since Mirage and Electra machines use a different LED
   ** address register, we need to check for these machines 
   ** explicitly.
 */
#ifndef CONFIG_CHASSIS_LCD_LED
#define lasi_led_init(x)	/* nothing */
#else
void __init lasi_led_init(unsigned long lasi_hpa)
{
	unsigned long datareg;
	switch (CPU_HVERSION) {
	/* Gecko machines have only one single LED, which can be permanently 
	   turned on by writing a zero into the power control register. */ 
	case 0x600:		/* Gecko (712/60) */
	case 0x601:		/* Gecko (712/80) */
	case 0x602:		/* Gecko (712/100) */
	case 0x603:		/* Anole 64 (743/64) */
	case 0x604:		/* Anole 100 (743/100) */
	case 0x605:		/* Gecko (712/120) */
		datareg = lasi_hpa + 0x0000C000;
		gsc_writeb(0, datareg);
		return; /* no need to register the LED interrupt-function */  
	/* Mirage and Electra machines need special offsets */
	case 0x60A:		/* Mirage Jr (715/64) */
	case 0x60B:		/* Mirage 100 */
	case 0x60C:		/* Mirage 100+ */
	case 0x60D:		/* Electra 100 */
	case 0x60E:		/* Electra 120 */
		datareg = lasi_hpa - 0x00020000;
		break;
	default:
		datareg = lasi_hpa + 0x0000C000;
		break;
	} /* switch() */
	register_led_driver(DISPLAY_MODEL_LASI, LED_CMD_REG_NONE, (char *)datareg);
}
#endif
/*
 * lasi_power_off
 *
 * Function for lasi to turn off the power.  This is accomplished by setting a
 * 1 to PWR_ON_L in the Power Control Register
 * 
 */
static unsigned long lasi_power_off_hpa;
static void lasi_power_off(void)
{
	unsigned long datareg;
	/* calculate addr of the Power Control Register */
	datareg = lasi_power_off_hpa + 0x0000C000;
	/* Power down the machine */
	gsc_writel(0x02, datareg);
}
int __init
lasi_init_chip(struct parisc_device *dev)
{
	struct busdevice *lasi;
	struct gsc_irq gsc_irq;
	int irq, ret;
	lasi = kmalloc(sizeof(struct busdevice), GFP_KERNEL);
	if (!lasi)
		return -ENOMEM;
	lasi->name = "Lasi";
	lasi->hpa = dev->hpa;
	/* Check the 4-bit (yes, only 4) version register */
	lasi->version = gsc_readl(lasi->hpa + LASI_VER) & 0xf;
	printk(KERN_INFO "%s version %d at 0x%lx found.n",
		lasi->name, lasi->version, lasi->hpa);
	/* initialize the chassis LEDs really early */ 
	lasi_led_init(lasi->hpa);
	/* Stop LASI barking for a bit */
	lasi_init_irq(lasi);
	/* the IRQ lasi should use */
	irq = gsc_alloc_irq(&gsc_irq);
	if (irq < 0) {
		printk(KERN_ERR "%s(): cannot get GSC irqn",
				__FUNCTION__);
		kfree(lasi);
		return -EBUSY;
	}
	ret = request_irq(gsc_irq.irq, busdev_barked, 0, "lasi", lasi);
	if (ret < 0) {
		kfree(lasi);
		return ret;
	}
	/* Save this for debugging later */
	lasi->parent_irq = gsc_irq.irq;
	lasi->eim = ((u32) gsc_irq.txn_addr) | gsc_irq.txn_data;
	/* enable IRQ's for devices below LASI */
	gsc_writel(lasi->eim, lasi->hpa + OFFSET_IAR);
	/* Done init'ing, register this driver */
	ret = gsc_common_irqsetup(dev, lasi);
	if (ret) {
		kfree(lasi);
		return ret;
	}    
	fixup_child_irqs(dev, lasi->busdev_region->data.irqbase,
			lasi_choose_irq);
	/* initialize the power off function */
	/* FIXME: Record the LASI HPA for the power off function.  This should
	 * ensure that only the first LASI (the one controlling the power off)
	 * should set the HPA here */
	lasi_power_off_hpa = lasi->hpa;
	pm_power_off = lasi_power_off;
	
	return ret;
}
static struct parisc_device_id lasi_tbl[] = {
	{ HPHW_BA, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x00081 },
	{ 0, }
};
struct parisc_driver lasi_driver = {
	name:		"Lasi",
	id_table:	lasi_tbl,
	probe:		lasi_init_chip,
};

						