path: root/packages/linux/openslug-kernel-2.6.11.2/nslu2-io.c

//=============================================================================
//
// n2-io.c version 0.1.7
// Author: Karen Spearel <kas11 at tampabay.rr.com>
// please report problems/bugs directly to the address above
//
// Boilerplate to be added "real soon now"...it is and has always been GPL'ed per
// MODULE_LICENSE but is offered without warrantee of any sort..use at your own risk
//
// NOTE: THIS IS INCOMPLETE.  INCLUDED ONLY TO KEEP FROM BREAKING THE BUILD,
// IT BEEPS AND SENDS A MESSAGE TO /proc/poweroff.  EVENTUALLY IT
// WILL TALK TO THE n2_pbd DAEMON.  EVENTUALLY THE LED DRIVER
// WILL TALK TO SOME USERLAND APP BUT ***NOT*** SET_LEDS.
// 
//=============================================================================
//	GPIO		Function	State
//	0		Red LED		Status		
//	1		Green LED	Ready = 1
//	2		Disk 2 LED	On = 0
//	3		Disk 1 LED	On = 0
//	4		Buzzer
//	5		Power Button	Pressed = 1
//	8		Power Down	Output = 1 powers down N2
//	12		Reset		Pressed = 0
//=============================================================================
// this driver is N2 specific and is purposely designed to do the minimum 
// necessary to provide the necessary services given the limited memory resources
// of the N2.  As OpenN2 develops, addition features will be added as
// suggested by the community.
//
//=============================================================================

#include <linux/config.h>
#include <linux/version.h>
#include <linux/module.h>
#include <linux/utsname.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/proc_fs.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/miscdevice.h>
#include <linux/device.h>
#include <linux/interrupt.h>
#include <linux/moduleparam.h>
#include <linux/timer.h>
#include <linux/reboot.h>

#include <asm/system.h>
#include <asm/uaccess.h>
#include <asm/hardware.h>
#include <asm-arm/irq.h>
#include <asm-arm/delay.h>
#include <asm-arm/signal.h>

/* Set this to 1 to output lots of debug messages. */
#if NSLU2_IO_DEBUG
#define nslu2_io_debug(args) printk args
#else
#define nslu2_io_debug(args) ((void)0)
#endif

#define VERSION			"0.1.7"

#define N2RB_MAJOR		60		//rbuttons
#define N2PB_MAJOR		61		//pbuttons
#define	N2BZ_MAJOR		62		//buzzer
#define N2LM_MAJOR		126

#define N2PB_IRQ		22		//gpio5
#define	N2RB_IRQ		29		//gpio12

#define N2_BEEP_DUR_LONG	2000
#define N2_BEEP_DUR_MED		400
#define N2_BEEP_DUR_SHORT	100
#define N2_BEEP_PITCH_HIGH	250
#define N2_BEEP_PITCH_MED	500
#define N2_BEEP_PITCH_LOW	1000
#define N2_LONG_DELAY		30000

#define N2_BZ_GPIO		4
#define N2_PB_GPIO		5
#define N2_PO_GPIO		8		//power off
#define N2_RB_GPIO		12

#define GPIO_BZ_BM		0x0010	//b0000 0000 0001 0000
#define GPIO_PB_BM		0x0020	//b0000 0000 0010 0000
#define GPIO_PO_BM		0x0100  //b0000 0001 0000 0000
#define GPIO_RB_BM		0x1000	//b0001 0000 0000 0000

#define NOERR			0

#define RB_DELAY		50
#define PB_DELAY		20

#define PWR_OFF_STR		"poweroff"


// ioctls -- 'M" is used for sound cards...we don't got one so it seems safe

#define N2BZ_BEEP_STOP		_IO('M',0)       //stop multi-beep at end of audible
#define N2BZ_BEEP		_IO('M',1)       //one beep at current defaults
#define N2BZ_BEEPS		_IOW('M',3,long) //param beeps at current defaults
#define N2BZ_TONESET		_IOW('M',4,long) //set tone: range is high=250 to low=2000
#define N2BZ_ONTIME		_IOW('M',5,long) //ontime for multi-beeps in jiffies
#define	N2BZ_SILENTTIME		_IOW('M',6,long) //offtime for multi-beeps in jiffies
#define N2BZ_REPEATCNT		_IOW('M',7,long) //number of repeats for multi-beeps 0 = forever
#define N2BZ_COMBINED		_IOW('M',8,long) //combine all params in a long

#define N2LM_OFF		_IOW('M',32,long)
#define N2LM_ON			_IOW('M',33,long)
#define N2LM_BLINK		_IOW('M',34,long)
#define N2LM_ALT		_IOW('M',35,long)
#define N2LM_ALL_ON		_IO('M',36)
#define N2LM_ALL_OFF		_IO('M',37)

#define PHYS_LEDS		4
#define BLINK_DELAY		25

//  OR Masks to turn these LEDs ON

#define	RS_RED_ON	0x00000001	//0b0000 0000 0000 0010
#define	RS_GRN_ON	0x00000002	//0b0000 0000 0000 0001
#define RS_YEL_ON	0x00000003	//0b0000 0000 0000 0011

// AND Masks to turn these LEDs OFF

#define	RS_RED_OFF	0xfffffffe	//0b1111 1111 1111 1101
#define	RS_GRN_OFF	0xfffffffd	//0b1111 1111 1111 1110
#define RS_YEL_OFF	0xfffffffc	//0b1111 1111 1111 1100

// AND Masks to turn these LEDs ON

#define DISK1_ON	0xfffffff7	//0b1111 1111 1111 0111
#define	DISK2_ON	0xfffffffb	//0b1111 1111 1111 1011

// Or Masks to turn these LEDs OFF

#define DISK1_OFF	0x00000008	//0b0000 0000 0000 1000
#define	DISK2_OFF	0x00000004	//0b0000 0000 0000 0100	

// EOR masks for toggling LEDs on/off

#define RS_RG_ALT	0x00000003	//eor mask to toggle rs rg bits
#define RS_GRN_TGL	0x00000002
#define RS_RED_TGL	0x00000001
#define DISK1_TGL	0x00000008
#define DISK2_TGL	0x00000004

// The LED names for switches

#define LED_RS_RED	0
#define LED_RS_GRN	1
#define	LED_DISK1	2
#define LED_DISK2	3
#define LED_ALL		4

static unsigned long init_jiffy = 0;			//jiffies at init time
static unsigned long rb_presses = 0;			//number of reset button presses
static unsigned long ontime = 50;
static unsigned long offtime = 450;
static unsigned long bz_repeatcnt = 10;
static unsigned long tone = 1000;

DECLARE_WAIT_QUEUE_HEAD(n2rb_waitq);
DECLARE_WAIT_QUEUE_HEAD(n2pb_waitq);

static struct timer_list n2lm_rsg_timer;	//rs green 
static struct timer_list n2lm_rsr_timer;	//rs red
static struct timer_list n2lm_d1_timer;		//drive 1
static struct timer_list n2lm_d2_timer;		//drive 2
static struct timer_list n2rb_timer;
static struct timer_list n2pb_timer;
static struct timer_list n2bz_timer;		//beeper

// sysfs class
static struct class_simple *n2lm_class;

//==================================================================================================
//
// Blinking is handled entirely by the 4 timer handlers.  On timeout, the bit in the
// GPIO output register is xor'd with a mask corresponding to the selected led which simply
// flips that bit.  No record of what any of the other leds is doing is needed.
//
//==================================================================================================
// this blinks rs green or green/yellow if rs red is on
static void n2lm_rsg_handler(unsigned long data)
{
	*IXP4XX_GPIO_GPOUTR ^= RS_GRN_TGL;			//flip the led
	n2lm_rsg_timer.expires = jiffies + BLINK_DELAY;		//next timeout
	add_timer(&n2lm_rsg_timer);				//reinit timer
	return;
}

// this blinks or alternates rs red green... inited wit green on/red off
static void n2lm_rsr_handler(unsigned long data)
{
	*IXP4XX_GPIO_GPOUTR ^= n2lm_rsr_timer.data;
	n2lm_rsr_timer.expires = jiffies + BLINK_DELAY;
	add_timer(&n2lm_rsr_timer);
	return;	
}
// blinks disk 1
static void n2lm_d1_handler(unsigned long data)
{
	*IXP4XX_GPIO_GPOUTR ^= DISK1_TGL;
	n2lm_d1_timer.expires = jiffies + BLINK_DELAY;
	add_timer(&n2lm_d1_timer);
	return;
}
// blinks disk 2
static void n2lm_d2_handler(unsigned long data)
{
	*IXP4XX_GPIO_GPOUTR ^= DISK2_TGL;
	n2lm_d2_timer.expires = jiffies + BLINK_DELAY;
	add_timer(&n2lm_d2_timer);
	return;
}

//==================================================================================================

static void n2lm_timer_start(unsigned long led)
{

	nslu2_io_debug((KERN_DEBUG "timer: %ld\n",led));

	switch(led) {
		case LED_RS_RED:
			n2lm_rsr_timer.expires = jiffies + BLINK_DELAY;
			add_timer(&n2lm_rsr_timer);
			break;

		case LED_RS_GRN:
			n2lm_rsg_timer.expires = jiffies + BLINK_DELAY;
			add_timer(&n2lm_rsg_timer);
			break;

		case LED_DISK1:
			n2lm_d1_timer.expires = jiffies + BLINK_DELAY;
			add_timer(&n2lm_d1_timer);
 			break;

		case LED_DISK2:
			n2lm_d2_timer.expires = jiffies + BLINK_DELAY; 
			add_timer(&n2lm_d2_timer);
			break;

		default:
			break;
	}
	return;
}

//==================================================================================================

static void n2lm_timer_stop(unsigned long led)
{
	switch (led) {
		case LED_RS_RED:
			del_timer(&n2lm_rsr_timer);
			break;
		case LED_RS_GRN:
			del_timer(&n2lm_rsg_timer);
			break;
		case LED_DISK1:
			del_timer(&n2lm_d1_timer);
 			break;
		case LED_DISK2: 
			del_timer(&n2lm_d2_timer);
			break;
		default:
			break;
	}
	return;
}

//--------------------------------------------------------------------------------------------------

static void n2lm_timer_stop_all(void)
{
	del_timer(&n2lm_rsg_timer);
	del_timer(&n2lm_rsr_timer);
	del_timer(&n2lm_d1_timer); 
	del_timer(&n2lm_d2_timer);
	return;
}
//--------------------------------------------------------------------------------------------------

static void n2lm_ledon(unsigned long led)
{

	nslu2_io_debug((KERN_DEBUG "ledon: %ld\n", led));

	switch (led) {
		case LED_RS_RED:	
			*IXP4XX_GPIO_GPOUTR |= RS_RED_ON;	//1
			return;
		case LED_RS_GRN:
			*IXP4XX_GPIO_GPOUTR |= RS_GRN_ON;	//2
			return;
		case LED_DISK1:
			*IXP4XX_GPIO_GPOUTR &= DISK1_ON;	//0xfffffff7
			return;
		case LED_DISK2:	
			*IXP4XX_GPIO_GPOUTR &= DISK2_ON;	//0xfffffffb
			return;
		case LED_ALL:					//all green
			*IXP4XX_GPIO_GPOUTR |= RS_GRN_ON;
			*IXP4XX_GPIO_GPOUTR &= (DISK1_ON & DISK2_ON);
			return;	
	}
}

//--------------------------------------------------------------------------------------------------

static void n2lm_ledoff(unsigned long led)
{

	switch (led) {
		case LED_RS_RED:	
			*IXP4XX_GPIO_GPOUTR &= RS_RED_OFF;	//0xffffffffe
			return;
		case LED_RS_GRN:
			*IXP4XX_GPIO_GPOUTR &= RS_GRN_OFF;	//0xfffffffd
			return;
		case LED_DISK1:
			*IXP4XX_GPIO_GPOUTR |= DISK1_OFF;	//0x00000008
			return;
		case LED_DISK2:	
			*IXP4XX_GPIO_GPOUTR |= DISK2_OFF;	//0x00000004
			return;
		case LED_ALL:
			*IXP4XX_GPIO_GPOUTR &= (RS_GRN_OFF & RS_RED_OFF);
			*IXP4XX_GPIO_GPOUTR |= (DISK1_OFF | DISK2_OFF);
	}
}

//==================================================================================================

static int n2lm_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long led)
{

	nslu2_io_debug((KERN_DEBUG "cmd=%d, led=%ld\n", cmd, led));
	
	if (led < 0 || led >= PHYS_LEDS)
		return -EINVAL;

	switch (cmd ) {
		case N2LM_ON:
			n2lm_timer_stop(led);
			n2lm_ledon(led);
			break;
			
		case N2LM_OFF:
			n2lm_timer_stop(led);
			n2lm_ledoff(led);
			break;
			
		case N2LM_BLINK:
			n2lm_ledon(led);
			if (led == LED_RS_RED)
				n2lm_rsr_timer.data = RS_RED_TGL;
			n2lm_timer_start(led);
			break;

		case N2LM_ALT:
			if (led == LED_RS_RED)
			{
				n2lm_ledon(LED_RS_GRN);
				n2lm_ledoff(LED_RS_RED);
				n2lm_rsr_timer.data = RS_RG_ALT;
				n2lm_timer_start(LED_RS_RED);
				break;
			} else
				return -EINVAL;
		
		case N2LM_ALL_ON:
			n2lm_timer_stop_all();
			n2lm_ledon(LED_ALL);
			break;
		
		case N2LM_ALL_OFF:
			n2lm_timer_stop_all();
			n2lm_ledoff(LED_ALL);
			break;
		
		default:
			return -EINVAL;
	}

	return NOERR;
}

static struct file_operations n2lm_fops = {
	.owner		= THIS_MODULE,
	.ioctl		= n2lm_ioctl,
};
//==================================================================================================
// We can't do anything fancy here since the system tick rate is far below that required to
// generate a desirable tone.  Therefore we haven't much choice but to use a busy loop until
// I get up to speed on the timers.  The saving grace is that for the normal uses, nothing 
// important should be haprepening. 
//==================================================================================================

static void n2_buzz(int tone_delay, int duration)
{
	int i;

	*IXP4XX_GPIO_GPOER &= ~GPIO_BZ_BM;
		
	for (i = 1; i < duration; i++) {
		*IXP4XX_GPIO_GPOUTR &= ~GPIO_BZ_BM;
		udelay(tone_delay);
		*IXP4XX_GPIO_GPOUTR |= GPIO_BZ_BM;
		udelay(tone_delay);
	}
	*IXP4XX_GPIO_GPOER |= GPIO_BZ_BM;

	return;
}
//=================================================================================================

// this handles the buzzer duty cycle
static void n2bz_handler(unsigned long data)
{
	if (--bz_repeatcnt > 0) {			//if just one beep left to do
		n2bz_timer.expires = jiffies + ontime + offtime;	//next timeout
		add_timer(&n2bz_timer);					//reinit timer
	}
	n2_buzz(tone/2, ontime);
	nslu2_io_debug((KERN_DEBUG "Count = %d\tOntime = %d\n", bz_repeatcnt, ontime));
	return;
}

//==================================================================================================

static int n2bz_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long param)
{
	switch (cmd) {
		case N2BZ_BEEP:
			n2_buzz(tone/2, ontime);
			break;
	
		case N2BZ_BEEP_STOP:
			del_timer(&n2bz_timer);
			break;

		case N2BZ_BEEPS:
			if (param == 0)
				bz_repeatcnt = 0xffffffff;
			else
				bz_repeatcnt = param;
			n2bz_handler(0);
			break;
	
		case N2BZ_TONESET:
			if (param >= 250 && param <= 2000)
				tone = param;
			break;

		case N2BZ_ONTIME:
			if (param > 4 && param < 201)
				ontime = param;
			break;

		case N2BZ_SILENTTIME:
			if (param > ontime)			//enforce a reasonable duty cycle
				offtime = param;
			else
				offtime = ontime;
			break;

		case N2BZ_REPEATCNT:
			if (param == 0)
				bz_repeatcnt = 0xffffffff;
			else
				bz_repeatcnt = param;
			break;

		case N2BZ_COMBINED:
			bz_repeatcnt =  (param & 0xF0000000) >> 28;	//repeat 1 - 16
			ontime =        (param & 0x0FF00000) >> 20; 	//ontime 1 - 256 jiffies
			offtime =       (param & 0x000FFF00) >> 8;	//offtime 1 - 4095 jiffies
			tone =          (param & 0x000000FF) << 4;	//tone (1 - 255) * 16
			break;

		default:
			break;
	}
	return NOERR;
}

static struct file_operations n2bz_fops = {
	.owner		= THIS_MODULE,
	.ioctl		= n2bz_ioctl,
};

//==================================================================================================
		
static irqreturn_t n2pb_handler (int irq, void *dev_id, struct pt_regs *regs)
{
	void *ret;
	
	wake_up(&n2pb_waitq);	
	remove_proc_entry(PWR_OFF_STR, NULL);		//no parent	
	n2_buzz(N2_BEEP_PITCH_MED, N2_BEEP_DUR_MED);
	ret = create_proc_entry(PWR_OFF_STR, 0, NULL);
	nslu2_io_debug((KERN_DEBUG "cpe ret = %p\n", ret));

// WARNING: This is RUDE...it unconditionally pulls the power plug.
// Your data will be at risk...since this is just a test system
// I am leaving it enabled...eventually userland needs to get the
// message, do an orderly shutdown and use an ioctl or something in
// /proc/powerdowm to actually have us pull the plug.

	machine_power_off();

	return IRQ_HANDLED;
}

//==================================================================================================
//
//static void do_rb_timeout(unsigned long data)
//{
//	int i;
//
//	for (i = 0; i < rb_presses; i++)
//		n2_buzz(N2_BEEP_PITCH_MED,N2_BEEP_DUR_SHORT);
//	return;
//}
//
//==================================================================================================
// does nothing -- waiting for userland to define
// This thing is sorta braindead...edge triggered IRQs aren't available in the drivers yet...so
// we hang in a loop until the button is no longer pressed

struct testr {
	int	ctl;
	long	param;
};

static irqreturn_t n2rb_handler (int irq, void *dev_id, struct pt_regs *regs)
{

	static struct testr test[] = {
				 { N2LM_ALL_OFF,0 },
				 { N2LM_ON,0 },
				 { N2LM_OFF,0 },
				 { N2LM_ON,1 },
				 { N2LM_ALL_OFF,1 },
				 { N2LM_ON,2 },
				 { N2LM_OFF,2 },
				 { N2LM_ON,3 },
				 { N2LM_OFF,3 },
				 { N2LM_BLINK,0 },
				 { N2LM_OFF,0 },
				 { N2LM_BLINK,1 },
				 { N2LM_OFF,1 },
				 { N2LM_BLINK,2 },
				 { N2LM_OFF,2 },
				 { N2LM_BLINK,3 },
				 { N2LM_OFF,3 },
				 { N2LM_ALL_OFF,0 },
				 { N2LM_ALT,1 },
				 { N2LM_OFF,1 },
				 { N2LM_ALL_ON,0 }
	};

	nslu2_io_debug(("Reset Entry IRQ =%d Presses = %d Jiffies = %08lx\tIO = %x\tIOW = %x\n", irq, rb_presses, jiffies, (int)_IO('M',rb_presses), (int)_IOW('M',rb_presses,long)));

	wake_up(&n2rb_waitq);	
  	while ((*IXP4XX_GPIO_GPINR & GPIO_RB_BM) == 0)
		;					//wait for button release

	if (rb_presses > 20) 
		rb_presses = 0;
	tone = (rb_presses * 50) + 200;
	ontime = (rb_presses*10) + 100;
	offtime = 500 - (rb_presses*20);
	nslu2_io_debug(("Ontime = %d\tOfftime = %d\tTone = %d\n",ontime,offtime,tone));
 	rb_presses++;

	n2bz_ioctl(NULL,NULL, N2BZ_BEEPS, rb_presses);	
	n2lm_ioctl(NULL,NULL, test[rb_presses].ctl, test[rb_presses].param);
//	if (rb_presses == 0) {
//		init_jiffy = jiffies;
//		init_timer (&n2rb_timer);
//		n2rb_timer.function = do_rb_timeout;
//	};
//
//	if (rb_presses == 8)
//		rb_presses = 0;
//	if (rb_presses & 1)
//		n2lm_ledon(test[rb_presses]);
//	else
//		n2lm_ledoff(test[rb_presses]);
//	
//	n2rb_timer.expires = (jiffies + RB_DELAY);
//	add_timer (&n2rb_timer);
//	if (rb_presses < 5) {
//		if (rb_presses > 0)
//			n2lm_ledoff(rb_presses);
//		n2lm_ledon(++rb_presses);
//		n2lm_timer_start(rb_presses);
//	};

	nslu2_io_debug((KERN_DEBUG "Reset Exit IRQ=%d Presses= %d Jiffies= %08lx\n", irq, rb_presses, jiffies));
	return IRQ_HANDLED;

}

//==================================================================================================
//  What to do here is majorly undetermined...

static int n2rb_read (struct file *filp, char __user *buffer, size_t count, loff_t *ppos)
{
	printk(KERN_DEBUG "Reset Button Wait\n");
	interruptible_sleep_on(&n2rb_waitq);
	return copy_to_user(buffer, "reset", 5) ? -EFAULT : 5;

}

//==================================================================================================
//  What to do here is majorly undetermined...

static int n2pb_read (struct file *filp, char __user *buffer, size_t count, loff_t *ppos)
{
	printk(KERN_DEBUG "Power Button Wait\n");
	interruptible_sleep_on(&n2pb_waitq);
	return copy_to_user(buffer, "poweroff", 8) ? -EFAULT : 8;

}

//--------------------------------------------------------------------------------------------------

static struct file_operations n2rb_fops = {
	.owner		= THIS_MODULE,
	.read		= n2rb_read,
};

//--------------------------------------------------------------------------------------------------

static struct file_operations n2pb_fops = {
	.owner		= THIS_MODULE,
	.read		= n2pb_read,
};

//==================================================================================================

static void n2iom_initarch(void)
{
	printk(KERN_DEBUG "setup_interrupts - jiffies=%ld init_jiffy=%ld\n", jiffies, init_jiffy);

	*IXP4XX_GPIO_GPISR = 0x20400000;	// read the 2 irqs to clr
	gpio_line_config(N2_RB_GPIO, IXP4XX_GPIO_IN | IXP4XX_GPIO_ACTIVE_LOW);
	gpio_line_isr_clear(N2_RB_GPIO);
	gpio_line_config(N2_PB_GPIO, IXP4XX_GPIO_IN | IXP4XX_GPIO_ACTIVE_HIGH);
	gpio_line_isr_clear(N2_PB_GPIO);

	init_timer(&n2lm_rsg_timer);
	init_timer(&n2lm_rsr_timer);
	init_timer(&n2lm_d1_timer);
	init_timer(&n2lm_d2_timer);
//	init_timer(&n2rb_timer);
//	init_timer(&n2pb_timer);
	init_timer(&n2bz_timer);
	n2lm_rsr_timer.function = n2lm_rsr_handler;
	n2lm_rsg_timer.function = n2lm_rsg_handler;
	n2lm_d2_timer.function = n2lm_d2_handler;
	n2lm_d1_timer.function = n2lm_d1_handler;
	n2bz_timer.function = n2bz_handler;
	n2lm_rsr_timer.data = n2lm_rsg_timer.data = n2lm_d1_timer.data = n2lm_d2_timer.data = n2bz_timer.data = 0;

	*IXP4XX_GPIO_GPOER &= 0xfffffff0;	//enable gpio 0-3
	*IXP4XX_GPIO_GPOUTR |= 0x00000003;	//turn off the leds
	*IXP4XX_GPIO_GPOUTR &= 0xfffffffc;
	n2lm_ledon(LED_ALL);
	n2_buzz(N2_BEEP_PITCH_MED, N2_BEEP_DUR_SHORT);
	n2lm_ledoff(LED_ALL);
// Default the Ready/Status to Red during kernel boot, Turn Green at the end of sysvinit
	n2lm_ledon(LED_RS_RED);

	return;
}

//==================================================================================================

static int __init n2iom_init(void)
{
	printk(KERN_INFO "OpenN2 Misc I/O Driver Version %s\n", VERSION);
  	
	init_jiffy = jiffies;
	printk(KERN_DEBUG "init_jiffy=%ld\n",init_jiffy);
	n2iom_initarch();

	n2lm_class = class_simple_create(THIS_MODULE, "nslu2");

	if (register_chrdev(N2RB_MAJOR, "n2_rbm", &n2pb_fops) < NOERR) {
		printk(KERN_DEBUG "Reset Button Major %d not available\n", N2RB_MAJOR);
		return -EBUSY;
	}
	else {
		class_simple_device_add(n2lm_class, MKDEV(N2RB_MAJOR, 0), NULL, "rbuttons");
	}
	if (register_chrdev(N2PB_MAJOR, "n2_pbm", &n2rb_fops) < NOERR) {
		printk(KERN_DEBUG "Power Button Major %d not available\n", N2PB_MAJOR);
		return -EBUSY;
	}
	else {
		class_simple_device_add(n2lm_class, MKDEV(N2PB_MAJOR, 0), NULL, "pbuttons");
	}
	if (register_chrdev(N2LM_MAJOR, "n2_ledm", &n2lm_fops) < NOERR) {
		printk(KERN_DEBUG "Led Manager Major %d not available\n", N2LM_MAJOR);
		return -EBUSY;
	}
	else {
		class_simple_device_add(n2lm_class, MKDEV(N2LM_MAJOR, 0), NULL, "leds");
	}
	if (register_chrdev(N2BZ_MAJOR, "n2_bzm", &n2bz_fops) < NOERR) {
		printk(KERN_DEBUG "Buzzer Major %d not available\n", N2BZ_MAJOR);
		return -EBUSY;
	}
	else {
		class_simple_device_add(n2lm_class, MKDEV(N2BZ_MAJOR, 0), NULL, "buzzer");
	}

	if (request_irq(N2RB_IRQ, &n2rb_handler, SA_INTERRUPT, "n2_rb", NULL) < NOERR) {
		printk(KERN_DEBUG "Reset Button IRQ %d not available\n", N2RB_IRQ);
		return -EIO;
	}
	if (request_irq(N2PB_IRQ, &n2pb_handler, SA_INTERRUPT, "n2_pb", NULL) < NOERR) {
		printk(KERN_DEBUG "Power Button IRQ %d not available\n", N2PB_IRQ);
		return -EIO;	
	}
	
	enable_irq(N2PB_IRQ);
	enable_irq(N2RB_IRQ);
	return (NOERR);
}

//==================================================================================================

static void __exit n2iom_exit(void)
{
	remove_proc_entry(PWR_OFF_STR, NULL);
	del_timer(&n2rb_timer);
	free_irq(N2RB_IRQ,NULL);
	unregister_chrdev(N2PB_MAJOR, "n2pb");
	class_simple_device_remove(MKDEV(N2PB_MAJOR, 0));
	del_timer(&n2pb_timer);	
	free_irq(N2PB_IRQ, NULL);
	unregister_chrdev(N2RB_MAJOR, "n2rb" );
	class_simple_device_remove(MKDEV(N2RB_MAJOR, 0));
	del_timer(&n2lm_rsg_timer);
	del_timer(&n2lm_rsr_timer);
	del_timer(&n2lm_d1_timer);
	del_timer(&n2lm_d2_timer);	
	unregister_chrdev(N2LM_MAJOR, "n2lm" );
	class_simple_device_remove(MKDEV(N2LM_MAJOR, 0));
	unregister_chrdev(N2BZ_MAJOR, "n2bz");
	class_simple_device_remove(MKDEV(N2BZ_MAJOR, 0));
	class_simple_destroy(n2lm_class);
}

module_init (n2iom_init);
module_exit (n2iom_exit);

MODULE_AUTHOR("Karen Spearel <kas11@tampabay.rr.com>");
MODULE_DESCRIPTION("OpenN2 Buttons/LEDs IO Driver");
MODULE_LICENSE("GPL");
static int debug = 7;
module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "Debugging enabled = 8");