X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/8c0ae37c63dd4bc42fcb84da2eeb4a4978a2ebc0..91dfab84182937b62ef64cb12d8e4f89e6d5c3ec:/lincan/src/main.c

diff --git a/lincan/src/main.c b/lincan/src/main.c
index d52cabf..918c2f7 100644
--- a/lincan/src/main.c
+++ b/lincan/src/main.c
@@ -25,12 +25,6 @@
 #include <linux/wrapper.h>
 #endif
 
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,3,0))
-#include <asm/spinlock.h>
-#else
-#include <linux/spinlock.h>
-#endif
-
 #if !defined (__GENKSYMS__) 
 #if (defined (MODVERSIONS) && !defined(NOVER))
 #include <linux/modversions.h>
@@ -45,6 +39,8 @@
 #include <linux/miscdevice.h>
 #endif
 
+#include "../include/can.h"
+#include "../include/can_sysdep.h"
 #include "../include/main.h"
 #include "../include/modparms.h"
 #include "../include/devcommon.h"
@@ -57,6 +53,8 @@
 #include "../include/irq.h"
 #include "../include/ioctl.h"
 #include "../include/write.h"
+#include "../include/finish.h"
+#include "../include/fasync.h"
 
 #define EXPORT_SYMTAB
 
@@ -70,8 +68,8 @@ int extended=0;
 MODULE_PARM(extended,"1i");
 int pelican=0;
 MODULE_PARM(pelican,"1i");
-int baudrate=0;
-MODULE_PARM(baudrate,"1i");
+int baudrate[MAX_TOT_CHIPS];
+MODULE_PARM(baudrate, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
 char *hw[MAX_HW_CARDS]={NULL,};
 MODULE_PARM(hw, "1-" __MODULE_STRING(MAX_HW_CARDS)"s");
 int irq[MAX_IRQ]={-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1};
@@ -84,6 +82,8 @@ int extmask=0;
 MODULE_PARM(extmask, "1i");
 int mo15mask=0;
 MODULE_PARM(mo15mask, "1i");
+int processlocal=0;
+MODULE_PARM(processlocal, "1i");
 
 /* Other module attributes */
 #ifdef MODULE_SUPPORTED_DEVICE
@@ -112,44 +112,35 @@ devfs_handle_t  devfs_handles[MAX_TOT_MSGOBJS];
  */
 struct mem_addr *mem_head=NULL;
 
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,3,0))
-struct file_operations can_fops=
-{
-	NULL,				/* llseek */
-	read:		can_read,
-	write:		can_write,
-	NULL,				/* readdir */
-	poll:		can_poll,
-	ioctl:		can_ioctl,
-	NULL,				/* mmap */
-	open:		can_open,
-	NULL,				/* flush */
-	release:	can_close,
-	NULL,				/* fsync */
-}; 
-#else 
 struct file_operations can_fops=
 {
+ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,0))
 	owner:		THIS_MODULE,	
+ #endif
 	read:		can_read,
 	write:		can_write,
 	poll:		can_poll,
 	ioctl:		can_ioctl,
 	open:		can_open,
 	release:	can_close,
+  #ifdef CAN_ENABLE_KERN_FASYNC
+	fasync:		can_fasync
+  #endif /*CAN_ENABLE_KERN_FASYNC*/
 };
-#endif
 
 EXPORT_SYMBOL(can_fops);
 
 int init_module(void)
 {
-	int res=0,i=0;
+	int res=0,i=0, j;
 	struct candevice_t *candev;
+	struct chip_t *chip;
 
 	if (parse_mod_parms())
 		return -EINVAL;
 
+	canqueue_kern_initialize();
+
 	if (init_hw_struct())
 		return -ENODEV;
 
@@ -167,6 +158,7 @@ int init_module(void)
 		candev=hardware_p->candevice[i];
 		if (candev->hwspecops->request_io(candev)) 
 			goto memory_error;
+		candev->flags|=CANDEV_IO_RESERVED;
 	}
 
 	for (i=0; i<hardware_p->nr_boards; i++) {
@@ -175,23 +167,26 @@ int init_module(void)
 			goto reset_error;
 	}
 
-	spin_lock_init(&hardware_p->rtr_lock);
+	can_spin_lock_init(&hardware_p->rtr_lock);
 	hardware_p->rtr_queue=NULL;
 
-	i=0;
-	while ( (chips_p[i] != NULL) && (i < MAX_TOT_CHIPS) ) {
-		if (chips_p[i]->chipspecops->irq_handler) {
-			if (request_irq(chips_p[i]->chip_irq,chips_p[i]->chipspecops->irq_handler,SA_SHIRQ,DEVICE_NAME,chips_p[i]))
-				goto interrupt_error;
-			else
-				DEBUGMSG("Registered interrupt %d\n",chips_p[i]->chip_irq);
-		}
-		i++;
-	}
-
 	for (i=0; i<hardware_p->nr_boards; i++) {
 		candev=hardware_p->candevice[i];
-		if (candev->flags & PROGRAMMABLE_IRQ)
+		for(j=0; j<candev->nr_all_chips; j++) {
+			if((chip=candev->chip[j])==NULL)
+				continue;
+			if(!chip->chipspecops->irq_handler)
+				continue;
+			
+			if (request_irq(chip->chip_irq,chip->chipspecops->irq_handler,SA_SHIRQ,DEVICE_NAME,chip))
+				goto interrupt_error;
+			else {
+				DEBUGMSG("Registered interrupt %d\n",chip->chip_irq);
+				chip->flags |= CHIP_IRQ_SETUP;
+			}
+		}
+		
+		if (candev->flags & CANDEV_PROGRAMMABLE_IRQ)
 			if (candev->hwspecops->program_irq(candev))
 				goto interrupt_error;
 	}
@@ -236,18 +231,13 @@ int init_module(void)
 		goto memory_error;
 
 	memory_error: ;
-		for (i=0; i<hardware_p->nr_boards; i++) {
-			candev=hardware_p->candevice[i];
-			candev->hwspecops->release_io(candev);
-		}
-		goto register_error;
+		canhardware_done(hardware_p);
 
-	register_error: ;
 		res=unregister_chrdev(major,DEVICE_NAME);
 		if (res<0)
 			CANMSG("Error unloading CAN driver, error: %d\n",res);
 		else
-			CANMSG("Successfully unloaded CAN driver.\n");
+			CANMSG("No CAN devices or driver setup error.\n");
 		return -ENODEV;
 
 }
@@ -255,7 +245,6 @@ int init_module(void)
 void cleanup_module(void)
 {
 	int res=0,i=0;
-	struct candevice_t *candev;
 
 #ifdef CONFIG_PROC_FS
 	if (can_delete_procdir())
@@ -276,18 +265,10 @@ void cleanup_module(void)
 	    #endif
        	}
 #endif
-        i=0;
-	while ( (chips_p[i] != NULL) & (i < MAX_TOT_CHIPS) ) {
-		free_irq(chips_p[i]->chip_irq, chips_p[i]);
-		i++;
-	}
 
-	for (i=0; i<hardware_p->nr_boards; i++){ 
-		candev=hardware_p->candevice[i];
-		candev->hwspecops->release_io(candev);
-	}
+	canhardware_done(hardware_p);
 
-	if ( del_mem_list() ) 
+	if ( can_del_mem_list() ) 
 		CANMSG("Error deallocating memory\n");
 
 	res=unregister_chrdev(major,DEVICE_NAME);