X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/a7089a3bc04cfa7e263670d51f5af9abb0791ea8..3cec91e940ca501534d28d6893bb80996ecd3206:/lincan/src/main.c

diff --git a/lincan/src/main.c b/lincan/src/main.c
index 197f37f..34661f1 100644
--- a/lincan/src/main.c
+++ b/lincan/src/main.c
@@ -100,6 +100,10 @@
 #if defined(CONFIG_OC_LINCAN_CARD_usbcan)
 	#include "../include/usbcan.h"
 #endif
+#if defined(CONFIG_OC_LINCAN_CARD_omap2_spican)
+	#include <linux/spi/spi.h>
+	#include "../include/omap2_spican.h"
+#endif
 
 can_spinlock_t canuser_manipulation_lock;
 
@@ -396,9 +400,20 @@ int init_module(void)
 	res = usbcan_init();
 	if (res){
 		CANMSG("usb_register for usbcan failed. Error number %d.\n", res);
-		return -ENODEV;
+		goto memory_error;
 	}
 #endif
+#if defined(CONFIG_OC_LINCAN_CARD_omap2_spican)
+	#if  LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,23)
+	res = omap2_spican_init();
+	if (res){
+		CANMSG("omap2_spican_register for omap2_spican failed. Error number %d.\n", res);
+		goto memory_error;
+	}
+	#else
+		#error There's no support for OMAP2 SPI subsystem in kernel versions before 2.6.23
+	#endif
+#endif
 
 	return 0;
 
@@ -442,7 +457,7 @@ int init_module(void)
 
 
 
-struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chipdataregfnc)(struct canchip_t *ch,void *data)){
+struct candevice_t* register_hotplug_dev(const char *hwname,int (*chipdataregfnc)(struct canchip_t *ch,void *data),void *devdata){
 	int i=0, j, board=0;
 	struct candevice_t *candev;
 	struct canchip_t *chip;
@@ -456,17 +471,19 @@ struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chip
 	}
 	brp = boardtype_find(hwname);
 	if(!brp) {
-		CANMSG("Sorry, hardware \"%s\" is currently not supported.\n",hw[board]);
+		CANMSG("Sorry, hardware \"%s\" is currently not supported.\n",hwname);
 		return NULL;
 	}
 	if (board==MAX_HW_CARDS){
-			CANMSG("Device \"%s\" could not be registered due to internal limits.\n",hw[board]);
+			CANMSG("Device \"%s\" could not be registered due to internal limits.\n",hwname);
 			return NULL;
 	}
 	hw[board]=brp->boardtype;
 
-	if (init_new_hw_struct(board))
+	if (init_new_hw_struct(board)){
+		CANMSG("HW struct creation failed.\n");
 		return NULL;
+	}
 
 	#ifdef CAN_DEBUG
 		list_hw();
@@ -488,7 +505,10 @@ struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chip
 		if((chip=candev->chip[j])==NULL)
 			continue;
 
-		chipdataregfnc(chip,devdata);
+		if (chipdataregfnc && devdata){
+			if (chipdataregfnc(chip,devdata))
+				goto interrupt_error;
+		}
 
 		if(chip->chipspecops->attach_to_chip(chip)<0) {
 			CANMSG("Initial attach to the chip HW failed\n");
@@ -508,7 +528,7 @@ struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chip
 			CANMSG("Error to program board interrupt\n");
 			goto interrupt_error;
 		}
-
+	CANMSG("Registering /proc entry\n");
 #ifdef CONFIG_PROC_FS
 	if (can_init_procentry(board))
 		goto proc_error;
@@ -584,25 +604,20 @@ struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chip
 		#endif /*CAN_WITH_RTL*/
 
 //	register_error:
-		if ( can_del_mem_list() )
-			CANMSG("Error deallocating memory\n");
+// 		if ( can_del_mem_list() )
+// 			CANMSG("Error deallocating memory\n");
 
 		return NULL;
 }
 
-
-
-
-
-
-
-void cleanup_usbdev(struct candevice_t *dev)
+void deregister_hotplug_dev(struct candevice_t *dev)
 {
 	int i=0;
 	int dev_minor;
 
 	if (!dev)
 		return;
+	DEBUGMSG("Deregistering hotplug device.\n");
 
 #ifdef CONFIG_PROC_FS
 	if (can_delete_procentry(dev))
@@ -632,6 +647,18 @@ void cleanup_usbdev(struct candevice_t *dev)
 	}
 #endif
 
+}
+
+
+void cleanup_hotplug_dev(struct candevice_t *dev)
+{
+	int i=0;
+	int dev_minor;
+
+	if (!dev)
+		return;
+	DEBUGMSG("Cleaning up hotplug device.\n");
+
 	for(i=0;i<MAX_TOT_CHIPS;i++){
 		if(!chips_p[i]) continue;
 		if(chips_p[i]->hostdevice != dev) continue;
@@ -656,9 +683,16 @@ void cleanup_module(void)
 #endif
 
 #if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+	DEBUGMSG("Unregistering usbcan.\n");
 	usbcan_exit();
 #endif
-
+#if defined(CONFIG_OC_LINCAN_CARD_omap2_spican)
+	#if  LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,23)
+	DEBUGMSG("Unregistering omap2_spican.\n");
+	omap2_spican_exit();
+	#endif
+#endif
+	DEBUGMSG("Continuing with coldplug cleanup.\n");
 #ifdef CONFIG_PROC_FS
 	if (can_delete_procdir())
 		CANMSG("Error unregistering /proc/can entry.\n");
@@ -698,6 +732,8 @@ void cleanup_module(void)
 	canqueue_rtl_done();
 	#endif /*CAN_WITH_RTL*/
 
+	DEBUGMSG("Can hardware cleanup done, freeing memory.\n");
+	
 	if ( can_del_mem_list() )
 		CANMSG("Error deallocating memory\n");