lincan/src/main.c

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