lincan/src/main.c

   1 /* main.c
   2  * Linux CAN-bus device driver.
   3  * Written by Arnaud Westenberg email:arnaud@wanadoo.nl
   4  * Rewritten for new CAN queues by Pavel Pisa - OCERA team member
   5  * email:pisa@cmp.felk.cvut.cz
   6  * This software is released under the GPL-License.
   7  * Version lincan-0.3  17 Jun 2004
   8  */
   9
  10 #ifndef EXPORT_SYMTAB
  11 #define EXPORT_SYMTAB
  12 #endif
  13
  14 #include <linux/autoconf.h>
  15
  16 #include <linux/module.h>
  17
  18 #include <linux/kernel.h>
  19 #include <linux/fs.h>
  20 #include <linux/sched.h>
  21 #include <linux/poll.h>
  22 #include <linux/version.h>
  23 #include <linux/autoconf.h>
  24 #include <linux/interrupt.h>
  25
  26 #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
  27  #include <linux/wrapper.h>
  28 #else
  29  #include <linux/device.h>
  30  #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,13)
  31   static struct class *can_class;
  32  #elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
  33   static struct class_simple *can_class;
  34   #define class_create class_simple_create
  35   #define class_device_create class_simple_device_add
  36   #define class_device_destroy(a,b) class_simple_device_remove(b)
  37   #define class_destroy class_simple_destroy
  38  #endif
  39 #endif
  40
  41 #if !defined (__GENKSYMS__)
  42 #if (defined (MODVERSIONS) && !defined(NOVER))
  43 #include <linux/modversions.h>
  44 /*#include "../include/main.ver"*/
  45 #endif
  46 #endif
  47
  48 /*#undef CONFIG_DEVFS_FS*/
  49
  50 #ifdef CONFIG_DEVFS_FS
  51 #include <linux/devfs_fs_kernel.h>
  52 #include <linux/miscdevice.h>
  53 #endif
  54
  55 #include "../include/can.h"
  56 #include "../include/can_sysdep.h"
  57 #include "../include/main.h"
  58 #include "../include/modparms.h"
  59 #include "../include/devcommon.h"
  60 #include "../include/setup.h"
  61 #include "../include/proc.h"
  62 #include "../include/open.h"
  63 #include "../include/close.h"
  64 #include "../include/read.h"
  65 #include "../include/select.h"
  66 #include "../include/irq.h"
  67 #include "../include/ioctl.h"
  68 #include "../include/write.h"
  69 #include "../include/finish.h"
  70 #include "../include/fasync.h"
  71
  72 #ifdef CAN_WITH_RTL
  73 #include <rtl_posixio.h>
  74 #include "../include/can_iortl.h"
  75 #endif /*CAN_WITH_RTL*/
  76
  77 #if defined(CONFIG_OC_LINCAN_CARD_usbcan)
  78         #include "../include/usbcan.h"
  79 #endif
  80
  81 can_spinlock_t canuser_manipulation_lock;
  82
  83 int major=CAN_MAJOR;
  84 int minor[MAX_TOT_CHIPS]={-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};
  85 int extended=0;
  86 int pelican=0;
  87 int baudrate[MAX_TOT_CHIPS];
  88 char *hw[MAX_HW_CARDS]={NULL,};
  89 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};
  90 unsigned long io[MAX_HW_CARDS]={-1,-1,-1,-1,-1,-1,-1,-1};
  91 int stdmask=0;
  92 int extmask=0;
  93 int mo15mask=0;
  94 int processlocal=0;
  95
  96 unsigned int minor_specified;
  97 unsigned int baudrate_specified;
  98 unsigned int hw_specified;
  99 unsigned int irq_specified;
 100 unsigned int io_specified;
 101
 102 #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0))
 103 /* Module parameters, some must be supplied at module loading time */
 104 MODULE_PARM(major,"1i");
 105 /*MODULE_PARM(minor, "1-" __MODULE_STRING(MAX_TOT_CHIPS)"i");*/
 106 MODULE_PARM(minor, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
 107 MODULE_PARM(extended,"1i");
 108 MODULE_PARM(pelican,"1i");
 109 MODULE_PARM(baudrate, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
 110 MODULE_PARM(hw, "1-" __MODULE_STRING(MAX_HW_CARDS)"s");
 111 MODULE_PARM(irq, "1-" __MODULE_STRING(MAX_IRQ)"i");
 112 MODULE_PARM(io, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
 113 MODULE_PARM(stdmask, "1i");
 114 MODULE_PARM(extmask, "1i");
 115 MODULE_PARM(mo15mask, "1i");
 116 MODULE_PARM(processlocal, "1i");
 117
 118 #else /* LINUX_VERSION_CODE >= 2,6,0 */
 119 module_param(major, int, 0);
 120 module_param_array(minor, int, &minor_specified, 0);
 121 module_param(extended, int, 0);
 122 module_param(pelican, int, 0);
 123 module_param_array(baudrate, int, &baudrate_specified, 0);
 124 module_param_array(hw, charp, &hw_specified, 0);
 125 module_param_array(irq, int, &irq_specified, 0);
 126 module_param_array(io, int, &io_specified, 0);
 127 module_param(stdmask, int, 0);
 128 module_param(extmask, int, 0);
 129 module_param(mo15mask, int, 0);
 130 module_param(processlocal, int, 0);
 131 #endif /* LINUX_VERSION_CODE >= 2,6,0 */
 132
 133 MODULE_PARM_DESC(major,"can be used to change default major [" __MODULE_STRING(CAN_MAJOR) "]");
 134 MODULE_PARM_DESC(minor,"can be used to change default starting minor for each channel");
 135 MODULE_PARM_DESC(extended,"enables automatic switching to extended format if ID>2047,"
 136                         " selects extended frames reception for i82527");
 137 MODULE_PARM_DESC(pelican,"unused parameter, PeliCAN used by default for sja1000p chips");
 138 MODULE_PARM_DESC(baudrate,"baudrate for each channel in step of 1kHz");
 139 MODULE_PARM_DESC(hw,"list of boards types to initialize - virtual,pip5,...");
 140 MODULE_PARM_DESC(irq,"list of iterrupt signal numbers, most ISA has one per chip, no value for PCI or virtual");
 141 MODULE_PARM_DESC(io,"IO address for each board, use 0 for PCI or virtual");
 142 MODULE_PARM_DESC(stdmask,"default standard mask for i82527 chips");
 143 MODULE_PARM_DESC(extmask,"default extended mask for i82527 chips");
 144 MODULE_PARM_DESC(mo15mask,"mask for communication object 15 of i82527 chips");
 145 MODULE_PARM_DESC(processlocal,"select postprocessing/loopback of transmitted messages - "
 146                 "0 .. disabled, 1 .. can be enabled by FIFO filter, 2 .. enabled by default");
 147
 148 #ifdef CAN_WITH_RTL
 149 int can_rtl_priority=-1;
 150 MODULE_PARM(can_rtl_priority, "1i");
 151 MODULE_PARM_DESC(can_rtl_priority,"select priority of chip worker thread");
 152 #endif /*CAN_WITH_RTL*/
 153
 154 /* Other module attributes */
 155 #ifdef MODULE_SUPPORTED_DEVICE
 156 MODULE_SUPPORTED_DEVICE("can");
 157 #endif
 158 #ifdef MODULE_LICENSE
 159 MODULE_LICENSE("GPL");
 160 #endif
 161 #ifdef MODULE_DESCRIPTION
 162 MODULE_DESCRIPTION("Universal Linux CAN-bus device driver");
 163 #endif
 164 #ifdef MODULE_AUTHOR
 165 MODULE_AUTHOR("Pavel Pisa <pisa@cmp.felk.cvut.cz>, Arnaud Westenberg");
 166 #endif
 167
 168 /* Global structures, used to describe the installed hardware. */
 169 struct canhardware_t canhardware;
 170 struct canhardware_t *hardware_p=&canhardware;
 171 struct canchip_t *chips_p[MAX_TOT_CHIPS];
 172 struct msgobj_t *objects_p[MAX_TOT_MSGOBJS];
 173 #ifdef CONFIG_DEVFS_FS
 174 #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 175 devfs_handle_t  devfs_handles[MAX_TOT_MSGOBJS];
 176 #endif
 177 #endif
 178
 179 /* Pointers to dynamically allocated memory are maintained in a linked list
 180  * to ease memory deallocation.
 181  */
 182 struct mem_addr *mem_head=NULL;
 183
 184 struct file_operations can_fops=
 185 {
 186  #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,0))
 187         owner:          THIS_MODULE,
 188  #endif
 189         read:           can_read,
 190         write:          can_write,
 191         poll:           can_poll,
 192         ioctl:          can_ioctl,
 193         open:           can_open,
 194         release:        can_close,
 195   #ifdef CAN_ENABLE_KERN_FASYNC
 196         fasync:         can_fasync
 197   #endif /*CAN_ENABLE_KERN_FASYNC*/
 198 };
 199
 200 EXPORT_SYMBOL(can_fops);
 201
 202
 203 #ifdef CAN_WITH_RTL
 204 struct rtl_file_operations can_fops_rtl = {
 205         llseek:         NULL,
 206         read:           can_read_rtl_posix,
 207         write:          can_write_rtl_posix,
 208         ioctl:          can_ioctl_rtl_posix,
 209         mmap:           NULL,
 210         open:           can_open_rtl_posix,
 211         release:        can_release_rtl_posix
 212 };
 213 #endif /*CAN_WITH_RTL*/
 214
 215
 216 /*
 217  2.6 kernel attributes for sysfs
 218
 219 static ssize_t show_xxx(struct class_device *cdev, char *buf)
 220 {
 221         return sprintf(buf, "xxxx\n");
 222 }
 223
 224 static ssize_t store_xxx(struct class_device *cdev, const char * buf, size_t count)
 225 {
 226 }
 227
 228 static CLASS_DEVICE_ATTR(xxx, S_IRUGO, show_xxx, store_xxx/NULL);
 229
 230 ret = class_device_create_file(class_dev, class_device_attr_xxx);
 231 if (ret)
 232         goto err_unregister;
 233
 234 */
 235
 236 int init_module(void)
 237 {
 238         int res=0,i=0, j;
 239         struct candevice_t *candev;
 240         struct canchip_t *chip;
 241
 242         if (parse_mod_parms())
 243                 return -EINVAL;
 244
 245         can_spin_lock_init(&canuser_manipulation_lock);
 246         canqueue_kern_initialize();
 247
 248         if (init_hw_struct())
 249                 return -ENODEV;
 250
 251         #ifdef CAN_DEBUG
 252                 list_hw();
 253         #endif
 254
 255         res=register_chrdev(major,DEVICE_NAME, &can_fops);
 256         if (res<0) {
 257                 CANMSG("Error registering driver.\n");
 258                 goto register_error;
 259         }
 260
 261         #ifdef CAN_WITH_RTL
 262         can_spin_lock_init(&can_irq_manipulation_lock);
 263         canqueue_rtl_initialize();
 264         res=rtl_register_rtldev(major,DEVICE_NAME,&can_fops_rtl);
 265         if (res<0) {
 266                 CANMSG("Error registering RT-Linux major number.\n");
 267                 goto rtldev_error;
 268         }
 269         #endif /*CAN_WITH_RTL*/
 270
 271         for (i=0; i<hardware_p->nr_boards; i++) {
 272                 candev=hardware_p->candevice[i];
 273                 if (candev->hwspecops->request_io(candev))
 274                         goto request_io_error;
 275                 candev->flags|=CANDEV_IO_RESERVED;
 276         }
 277
 278         for (i=0; i<hardware_p->nr_boards; i++) {
 279                 candev=hardware_p->candevice[i];
 280                 if (candev->hwspecops->reset(candev))
 281                         goto reset_error;
 282         }
 283
 284         can_spin_lock_init(&hardware_p->rtr_lock);
 285         hardware_p->rtr_queue=NULL;
 286
 287         for (i=0; i<hardware_p->nr_boards; i++) {
 288                 candev=hardware_p->candevice[i];
 289                 for(j=0; j<candev->nr_all_chips; j++) {
 290                         if((chip=candev->chip[j])==NULL)
 291                                 continue;
 292
 293                         if(chip->chipspecops->attach_to_chip(chip)<0) {
 294                                 CANMSG("Initial attach to the chip HW failed\n");
 295                                 goto interrupt_error;
 296                         }
 297
 298                         chip->flags |= CHIP_ATTACHED;
 299
 300                         if(can_chip_setup_irq(chip)<0) {
 301                                 CANMSG("Error to setup chip IRQ\n");
 302                                 goto interrupt_error;
 303                         }
 304                 }
 305
 306                 if (candev->flags & CANDEV_PROGRAMMABLE_IRQ)
 307                         if (candev->hwspecops->program_irq(candev)){
 308                                 CANMSG("Error to program board interrupt\n");
 309                                 goto interrupt_error;
 310                         }
 311         }
 312
 313 #ifdef CONFIG_PROC_FS
 314         if (can_init_procdir())
 315                 goto proc_error;
 316 #endif
 317
 318 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 319         can_class=class_create(THIS_MODULE, "can");
 320 #endif
 321
 322 #if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 323         {
 324             #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 325                 char dev_name[32];
 326             #else
 327                 struct class_device *this_dev;
 328             #endif
 329                 int dev_minor;
 330                 for(i=0;i<MAX_TOT_MSGOBJS;i++) {
 331                         if(!objects_p[i]) continue;
 332                         dev_minor=objects_p[i]->minor;
 333                     #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 334                         sprintf (dev_name, "can%d", dev_minor);
 335                         devfs_handles[i]=devfs_register(NULL, dev_name,
 336                                 DEVFS_FL_DEFAULT, major, dev_minor,
 337                                 S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP,
 338                                 &can_fops, (void*)objects_p[i]);
 339                     #else
 340                       #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,14))
 341                         this_dev=class_device_create(can_class, MKDEV(major, dev_minor), NULL,  "can%d", dev_minor);
 342                       #else /* >= 2.6.15 */
 343                         this_dev=class_device_create(can_class, NULL, MKDEV(major, dev_minor), NULL,  "can%d", dev_minor);
 344                       #endif /* >= 2.6.15 */
 345                         if(IS_ERR(this_dev)){
 346                                 CANMSG("problem to create device \"can%d\" in the class \"can\"\n", dev_minor);
 347                         }else{
 348                                 /*this_dev->class_data=objects_p[i];*/
 349                                 class_set_devdata(this_dev,objects_p[i]);
 350                         }
 351                       #ifdef CONFIG_DEVFS_FS
 352                         devfs_mk_cdev(MKDEV(major, dev_minor), S_IFCHR | S_IRUGO | S_IWUGO, "can%d", dev_minor);
 353                       #endif
 354                     #endif
 355                 }
 356         }
 357 #endif
 358
 359 #if defined(CONFIG_OC_LINCAN_CARD_usbcan)
 360         res = usbcan_init();
 361         if (res){
 362                 CANMSG("usb_register for usbcan failed. Error number %d.\n", res);
 363                 return -ENODEV;
 364         }
 365 #endif
 366
 367         return 0;
 368
 369 #ifdef CONFIG_PROC_FS
 370         proc_error: ;
 371                 CANMSG("Error registering /proc entry.\n");
 372                 goto memory_error;
 373 #endif
 374
 375         interrupt_error: ;
 376                 goto memory_error;
 377
 378         reset_error: ;
 379                 CANMSG("Error resetting device.\n");
 380                 goto memory_error;
 381
 382         request_io_error: ;
 383                 CANMSG("Error to request IO resources for device.\n");
 384                 goto memory_error;
 385
 386         memory_error: ;
 387                 canhardware_done(hardware_p);
 388
 389                 #ifdef CAN_WITH_RTL
 390                 rtl_unregister_rtldev(major,DEVICE_NAME);
 391         rtldev_error:
 392                 canqueue_rtl_done();
 393                 #endif /*CAN_WITH_RTL*/
 394
 395                 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0))
 396                 unregister_chrdev(major,DEVICE_NAME);
 397                 #else /*LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0)*/
 398                 res=unregister_chrdev(major,DEVICE_NAME);
 399                 if (res<0)
 400                         CANMSG("Error unloading CAN driver, error: %d\n",res);
 401                 else
 402                         CANMSG("No CAN devices or driver setup error.\n");
 403                 #endif /*LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0)*/
 404
 405         register_error:
 406                 if ( can_del_mem_list() )
 407                         CANMSG("Error deallocating memory\n");
 408
 409                 return -ENODEV;
 410 }
 411
 412
 413
 414
 415
 416 struct candevice_t* register_usbdev(const char *hwname,void *anydev){
 417         int i=0, j, board;
 418         struct candevice_t *candev;
 419         struct canchip_t *chip;
 420         struct boardtype_t *brp;
 421
 422         while ( (hw[board] != NULL) && (board < MAX_HW_CARDS) )
 423                 board++;
 424         brp = boardtype_find(hwname);
 425         if(!brp) {
 426                 CANMSG("Sorry, hardware \"%s\" is currently not supported.\n",hw[board]);
 427                 return NULL;
 428         }
 429         if (board==MAX_HW_CARDS){
 430                         CANMSG("Device \"%s\" could not be registered due to internal limits.\n",hw[board]);
 431                         return NULL;
 432         }
 433         hw[board]=brp->boardtype;
 434
 435         if (init_new_hw_struct(board))
 436                 return NULL;
 437
 438         #ifdef CAN_DEBUG
 439                 list_hw();
 440         #endif
 441
 442         candev=hardware_p->candevice[board];
 443
 444         /* Adding link to usb device structure into can device */
 445         candev->sysdevptr.anydev=anydev;
 446
 447         if (candev->hwspecops->request_io(candev))
 448                 goto request_io_error;
 449         candev->flags|=CANDEV_IO_RESERVED;
 450
 451         if (candev->hwspecops->reset(candev))
 452                 goto reset_error;
 453
 454         for(j=0; j<candev->nr_all_chips; j++) {
 455                 if((chip=candev->chip[j])==NULL)
 456                         continue;
 457
 458                 if(chip->chipspecops->attach_to_chip(chip)<0) {
 459                         CANMSG("Initial attach to the chip HW failed\n");
 460                         goto interrupt_error;
 461                 }
 462
 463                 chip->flags |= CHIP_ATTACHED;
 464
 465                 if(can_chip_setup_irq(chip)<0) {
 466                         CANMSG("Error to setup chip IRQ\n");
 467                         goto interrupt_error;
 468                 }
 469         }
 470
 471         if (candev->flags & CANDEV_PROGRAMMABLE_IRQ)
 472                 if (candev->hwspecops->program_irq(candev)){
 473                         CANMSG("Error to program board interrupt\n");
 474                         goto interrupt_error;
 475                 }
 476
 477 #ifdef CONFIG_PROC_FS
 478         if (can_init_procentry(board))
 479                 goto proc_error;
 480 #endif
 481
 482 #if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 483         {
 484                 #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 485                 char dev_name[32];
 486                 #else
 487                 struct class_device *this_dev;
 488                 #endif
 489                 int dev_minor;
 490                 for(i=0;i<MAX_TOT_MSGOBJS;i++) {
 491                         if(!objects_p[i]) continue;
 492                         if(objects_p[i]->hostchip->hostdevice != candev) continue;
 493
 494                         dev_minor=objects_p[i]->minor;
 495                         #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 496                         sprintf (dev_name, "can%d", dev_minor);
 497                         devfs_handles[i]=devfs_register(NULL, dev_name,
 498                         DEVFS_FL_DEFAULT, major, dev_minor,
 499                         S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP,
 500                         &can_fops, (void*)objects_p[i]);
 501                         #else
 502                         #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,14))
 503                         this_dev=class_device_create(can_class, MKDEV(major, dev_minor), NULL,  "can%d", dev_minor);
 504                         #else /* >= 2.6.15 */
 505                         this_dev=class_device_create(can_class, NULL, MKDEV(major, dev_minor), NULL,  "can%d", dev_minor);
 506                         #endif /* >= 2.6.15 */
 507                         if(IS_ERR(this_dev)){
 508                                 CANMSG("problem to create device \"can%d\" in the class \"can\"\n", dev_minor);
 509                         }else{
 510                                 /*this_dev->class_data=objects_p[i];*/
 511                                 class_set_devdata(this_dev,objects_p[i]);
 512                         }
 513                         #ifdef CONFIG_DEVFS_FS
 514                         devfs_mk_cdev(MKDEV(major, dev_minor), S_IFCHR | S_IRUGO | S_IWUGO, "can%d", dev_minor);
 515                         #endif
 516                         #endif
 517                 }
 518         }
 519 #endif
 520         return candev;
 521
 522 #ifdef CONFIG_PROC_FS
 523         proc_error: ;
 524                 CANMSG("Error registering /proc entry.\n");
 525                 goto memory_error;
 526 #endif
 527
 528         interrupt_error: ;
 529                 goto memory_error;
 530
 531         reset_error: ;
 532                 CANMSG("Error resetting device.\n");
 533                 goto memory_error;
 534
 535         request_io_error: ;
 536                 CANMSG("Error to request IO resources for device.\n");
 537                 goto memory_error;
 538
 539         memory_error: ;
 540
 541                 #ifdef CAN_WITH_RTL
 542         rtldev_error:
 543                 #endif /*CAN_WITH_RTL*/
 544
 545 //      register_error:
 546                 if ( can_del_mem_list() )
 547                         CANMSG("Error deallocating memory\n");
 548
 549                 return NULL;
 550 }
 551
 552
 553
 554
 555
 556
 557
 558 void cleanup_usbdev(struct candevice_t *dev)
 559 {
 560         int i=0;
 561         int dev_minor;
 562
 563         if (!dev)
 564                 return;
 565
 566 #ifdef CONFIG_PROC_FS
 567         if (can_delete_procentry(dev))
 568                 CANMSG("Error unregistering /proc/can entry.\n");
 569 #endif
 570
 571 #if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 572         for(i=0;i<MAX_TOT_MSGOBJS;i++) {
 573                 if(!objects_p[i]) continue;
 574                 if(objects_p[i]->hostchip->hostdevice != dev) continue;
 575                 #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 576                 if(devfs_handles[i])
 577                         devfs_unregister(devfs_handles[i]);
 578                 #else
 579                 dev_minor=objects_p[i]->minor;
 580                 if(dev_minor>=0){
 581                         #ifdef CONFIG_DEVFS_FS
 582                         devfs_remove("can%d", dev_minor);
 583                         #endif
 584                         class_device_destroy(can_class, MKDEV(major, dev_minor));
 585                 }
 586                 #endif
 587         }
 588 #endif
 589
 590         for(i=0;i<MAX_TOT_MSGOBJS;i++) {
 591                 if(!objects_p[i]) continue;
 592                 if(objects_p[i]->hostchip->hostdevice != dev) continue;
 593                 //canqueue_ends_done_chip(objects_p[i]->qends);
 594                 //can_checked_free(objects_p[i]->qends);
 595                 //can_checked_free(objects_p[i]);
 596                 objects_p[i]=NULL;
 597         }
 598
 599         for(i=0;i<MAX_TOT_CHIPS;i++){
 600                 if(!chips_p[i]) continue;
 601                 if(chips_p[i]->hostdevice != dev) continue;
 602                 //can_checked_free(chips_p[i]->chipspecops);
 603                 //can_checked_free(chips_p[i]);
 604                 chips_p[i]=NULL;
 605         }
 606
 607         hardware_p->candevice[dev->candev_idx]=NULL;
 608         hardware_p->nr_boards--;
 609         //kfree(hw[dev->candev_idx]);
 610         hw[dev->candev_idx]=NULL;
 611         //can_checked_free(dev->hwspecops);
 612         //can_checked_free(dev);
 613
 614         candevice_done(dev);
 615         can_checked_free(dev);
 616 }
 617
 618
 619
 620
 621 void cleanup_module(void)
 622 {
 623         int res=0,i=0;
 624
 625 #if defined(CONFIG_OC_LINCAN_CARD_usbcan)
 626         usbcan_exit();
 627 #endif
 628
 629 #ifdef CONFIG_PROC_FS
 630         if (can_delete_procdir())
 631                 CANMSG("Error unregistering /proc/can entry.\n");
 632 #endif
 633
 634 #if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 635         for(i=0;i<MAX_TOT_MSGOBJS;i++) {
 636             #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
 637                 if(devfs_handles[i])
 638                         devfs_unregister(devfs_handles[i]);
 639             #else
 640                 int dev_minor;
 641                 if(!objects_p[i]) continue;
 642                 dev_minor=objects_p[i]->minor;
 643                 if(minor>=0){
 644                     #ifdef CONFIG_DEVFS_FS
 645                         devfs_remove("can%d", dev_minor);
 646                     #endif
 647                         class_device_destroy(can_class, MKDEV(major, dev_minor));
 648                 }
 649             #endif
 650         }
 651 #endif
 652
 653 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
 654         class_destroy(can_class);
 655 #endif
 656
 657         canhardware_done(hardware_p);
 658
 659         #ifdef CAN_WITH_RTL
 660         rtl_unregister_rtldev(major,DEVICE_NAME);
 661         canqueue_rtl_done();
 662         #endif /*CAN_WITH_RTL*/
 663
 664         if ( can_del_mem_list() )
 665                 CANMSG("Error deallocating memory\n");
 666
 667         #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0))
 668         unregister_chrdev(major,DEVICE_NAME);
 669         #else /*LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0)*/
 670         res=unregister_chrdev(major,DEVICE_NAME);
 671         if (res<0)
 672                 CANMSG("Error unregistering CAN driver, error: %d\n",res);
 673         #endif /*LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0)*/
 674 }