X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/a35b5224bbdfbd7147e1cf715c2931a2d740f592..fdf877c54ec2598864f6193e8e1fbaedb5c05efb:/lincan/src/main.c diff --git a/lincan/src/main.c b/lincan/src/main.c index b8edf46..367c98d 100644 --- a/lincan/src/main.c +++ b/lincan/src/main.c @@ -1,18 +1,41 @@ -/* main.c - * Linux CAN-bus device driver. - * Written by Arnaud Westenberg email:arnaud@wanadoo.nl - * Rewritten for new CAN queues by Pavel Pisa - OCERA team member - * email:pisa@cmp.felk.cvut.cz - * This software is released under the GPL-License. - * Version lincan-0.3 17 Jun 2004 - */ +/**************************************************************************/ +/* File: main.c - the CAN driver top level glue code (needs rewrite) */ +/* */ +/* LinCAN - (Not only) Linux CAN bus driver */ +/* Copyright (C) 2002-2009 DCE FEE CTU Prague */ +/* Copyright (C) 2002-2009 Pavel Pisa */ +/* Funded by OCERA and FRESCOR IST projects */ +/* Based on CAN driver code by Arnaud Westenberg */ +/* */ +/* LinCAN is free software; you can redistribute it and/or modify it */ +/* under terms of the GNU General Public License as published by the */ +/* Free Software Foundation; either version 2, or (at your option) any */ +/* later version. LinCAN is distributed in the hope that it will be */ +/* useful, but WITHOUT ANY WARRANTY; without even the implied warranty */ +/* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU */ +/* General Public License for more details. You should have received a */ +/* copy of the GNU General Public License along with LinCAN; see file */ +/* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave, */ +/* Cambridge, MA 02139, USA. */ +/* */ +/* To allow use of LinCAN in the compact embedded systems firmware */ +/* and RT-executives (RTEMS for example), main authors agree with next */ +/* special exception: */ +/* */ +/* Including LinCAN header files in a file, instantiating LinCAN generics */ +/* or templates, or linking other files with LinCAN objects to produce */ +/* an application image/executable, does not by itself cause the */ +/* resulting application image/executable to be covered by */ +/* the GNU General Public License. */ +/* This exception does not however invalidate any other reasons */ +/* why the executable file might be covered by the GNU Public License. */ +/* Publication of enhanced or derived LinCAN files is required although. */ +/**************************************************************************/ #ifndef EXPORT_SYMTAB #define EXPORT_SYMTAB #endif -#include - #include #include @@ -20,10 +43,10 @@ #include #include #include -#include #include #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0)) + #include #include #else #include @@ -348,9 +371,11 @@ int init_module(void) this_dev=class_device_create(can_class, MKDEV(major, dev_minor), NULL, "can%d", dev_minor); #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25) /* >= 2.6.15 */ this_dev=class_device_create(can_class, NULL, MKDEV(major, dev_minor), NULL, "can%d", dev_minor); - #else /* >= 2.6.26 */ + #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,27) this_dev=device_create_drvdata(can_class, NULL, MKDEV(major, dev_minor), objects_p[i], "can%d", dev_minor); - #endif /* >= 2.6.26 */ + #else /* >= 2.6.28 */ + this_dev=device_create(can_class, NULL, MKDEV(major, dev_minor), objects_p[i], "can%d", dev_minor); + #endif /* >= 2.6.28 */ if(IS_ERR(this_dev)){ CANMSG("problem to create device \"can%d\" in the class \"can\"\n", dev_minor); #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25) @@ -371,7 +396,7 @@ 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 @@ -416,8 +441,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; @@ -431,17 +455,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(); @@ -463,7 +489,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"); @@ -483,7 +512,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; @@ -513,9 +542,11 @@ struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chip this_dev=class_device_create(can_class, MKDEV(major, dev_minor), NULL, "can%d", dev_minor); #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25) /* >= 2.6.15 */ this_dev=class_device_create(can_class, NULL, MKDEV(major, dev_minor), NULL, "can%d", dev_minor); - #else /* >= 2.6.26 */ + #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,27) this_dev=device_create_drvdata(can_class, NULL, MKDEV(major, dev_minor), objects_p[i], "can%d", dev_minor); - #endif /* >= 2.6.26 */ + #else /* >= 2.6.28 */ + this_dev=device_create(can_class, NULL, MKDEV(major, dev_minor), objects_p[i], "can%d", dev_minor); + #endif /* >= 2.6.28 */ if(IS_ERR(this_dev)){ CANMSG("problem to create device \"can%d\" in the class \"can\"\n", dev_minor); #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25) @@ -557,25 +588,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)) @@ -605,6 +631,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;ihostdevice != dev) continue; @@ -629,9 +667,11 @@ void cleanup_module(void) #endif #if defined(CONFIG_OC_LINCAN_CARD_usbcan) + DEBUGMSG("Unregistering usbcan.\n"); usbcan_exit(); #endif + DEBUGMSG("Continuing with coldplug cleanup.\n"); #ifdef CONFIG_PROC_FS if (can_delete_procdir()) CANMSG("Error unregistering /proc/can entry.\n"); @@ -671,6 +711,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");