-/* 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.2 9 Jul 2003
- */
-
+/**************************************************************************/
+/* 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 <http://dce.felk.cvut.cz> */
+/* Copyright (C) 2002-2009 Pavel Pisa <pisa@cmp.felk.cvut.cz> */
+/* Funded by OCERA and FRESCOR IST projects */
+/* Based on CAN driver code by Arnaud Westenberg <arnaud@wanadoo.nl> */
+/* */
+/* 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
-
-#include <linux/autoconf.h>
+#endif
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/poll.h>
#include <linux/version.h>
-#include <linux/autoconf.h>
#include <linux/interrupt.h>
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,50))
-#include <linux/wrapper.h>
-#endif
-
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,3,0))
-#include <asm/spinlock.h>
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
+ #include <linux/autoconf.h>
+ #include <linux/wrapper.h>
#else
-#include <linux/spinlock.h>
+ #include <linux/device.h>
+ #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,13)
+ static struct class *can_class;
+ #elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
+ static struct class_simple *can_class;
+ #define class_create class_simple_create
+ #define class_device_create class_simple_device_add
+ #define class_device_destroy(a,b) class_simple_device_remove(b)
+ #define class_destroy class_simple_destroy
+ #endif
#endif
-#if !defined (__GENKSYMS__)
+#if !defined (__GENKSYMS__)
#if (defined (MODVERSIONS) && !defined(NOVER))
#include <linux/modversions.h>
/*#include "../include/main.ver"*/
#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"
#include "../include/irq.h"
#include "../include/ioctl.h"
#include "../include/write.h"
+#include "../include/finish.h"
+#include "../include/fasync.h"
-#define EXPORT_SYMTAB
+#ifdef CAN_WITH_RTL
+#include <rtl_posixio.h>
+#include "../include/can_iortl.h"
+#endif /*CAN_WITH_RTL*/
+
+#if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+ #include "../include/usbcan.h"
+#endif
+#if defined(CONFIG_OC_LINCAN_CARD_omap2_spican)
+ #include "../include/omap2_spican.h"
+#endif
+
+can_spinlock_t canuser_manipulation_lock;
-/* Module parameters, some must be supplied at module loading time */
int major=CAN_MAJOR;
-MODULE_PARM(major,"1i");
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};
+int extended=0;
+int pelican=0;
+int baudrate[MAX_TOT_CHIPS];
+char *hw[MAX_HW_CARDS]={NULL,};
+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};
+unsigned long io[MAX_HW_CARDS]={-1,-1,-1,-1,-1,-1,-1,-1};
+long clockfreq[MAX_HW_CARDS];
+int stdmask=0;
+int extmask=0;
+int mo15mask=0;
+int processlocal=0;
+
+unsigned int minor_specified;
+unsigned int baudrate_specified;
+unsigned int hw_specified;
+unsigned int irq_specified;
+unsigned int io_specified;
+unsigned int clockfreq_specified;
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,12))
+/* Module parameters, some must be supplied at module loading time */
+MODULE_PARM(major,"1i");
/*MODULE_PARM(minor, "1-" __MODULE_STRING(MAX_TOT_CHIPS)"i");*/
MODULE_PARM(minor, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
-int extended=0;
MODULE_PARM(extended,"1i");
-int pelican=0;
MODULE_PARM(pelican,"1i");
-int baudrate=0;
-MODULE_PARM(baudrate,"1i");
-char *hw[MAX_HW_CARDS]={NULL,};
+MODULE_PARM(baudrate, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
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};
MODULE_PARM(irq, "1-" __MODULE_STRING(MAX_IRQ)"i");
-unsigned long io[MAX_HW_CARDS]={-1,-1,-1,-1,-1,-1,-1,-1};
MODULE_PARM(io, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
-int stdmask=0;
+MODULE_PARM(clockfreq, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
MODULE_PARM(stdmask, "1i");
-int extmask=0;
MODULE_PARM(extmask, "1i");
-int mo15mask=0;
MODULE_PARM(mo15mask, "1i");
+MODULE_PARM(processlocal, "1i");
+
+#else /* LINUX_VERSION_CODE >= 2,6,12 */
+module_param(major, int, 0);
+module_param_array(minor, int, &minor_specified, 0);
+module_param(extended, int, 0);
+module_param(pelican, int, 0);
+module_param_array(baudrate, int, &baudrate_specified, 0);
+module_param_array(hw, charp, &hw_specified, 0);
+module_param_array(irq, int, &irq_specified, 0);
+module_param_array(io, ulong, &io_specified, 0);
+module_param_array(clockfreq, long, &clockfreq_specified, 0);
+module_param(stdmask, int, 0);
+module_param(extmask, int, 0);
+module_param(mo15mask, int, 0);
+module_param(processlocal, int, 0);
+#endif /* LINUX_VERSION_CODE >= 2,6,12 */
+
+MODULE_PARM_DESC(major,"can be used to change default major [" __MODULE_STRING(CAN_MAJOR) "]");
+MODULE_PARM_DESC(minor,"can be used to change default starting minor for each channel");
+MODULE_PARM_DESC(extended,"enables automatic switching to extended format if ID>2047,"
+ " selects extended frames reception for i82527");
+MODULE_PARM_DESC(pelican,"unused parameter, PeliCAN used by default for sja1000p chips");
+MODULE_PARM_DESC(baudrate,"baudrate for each channel in step of 1kHz");
+MODULE_PARM_DESC(hw,"list of boards types to initialize - virtual,pip5,...");
+MODULE_PARM_DESC(irq,"list of iterrupt signal numbers, most ISA has one per chip, no value for PCI or virtual");
+MODULE_PARM_DESC(io,"IO address for each board, use 0 for PCI or virtual");
+MODULE_PARM_DESC(clockfreq,"base board clock source frequency in step of 1kHz");
+MODULE_PARM_DESC(stdmask,"default standard mask for i82527 chips");
+MODULE_PARM_DESC(extmask,"default extended mask for i82527 chips");
+MODULE_PARM_DESC(mo15mask,"mask for communication object 15 of i82527 chips");
+MODULE_PARM_DESC(processlocal,"select postprocessing/loopback of transmitted messages - "
+ "0 .. disabled, 1 .. can be enabled by FIFO filter, 2 .. enabled by default");
+
+#ifdef CAN_WITH_RTL
+int can_rtl_priority=-1;
+MODULE_PARM(can_rtl_priority, "1i");
+MODULE_PARM_DESC(can_rtl_priority,"select priority of chip worker thread");
+#endif /*CAN_WITH_RTL*/
/* Other module attributes */
#ifdef MODULE_SUPPORTED_DEVICE
#ifdef MODULE_DESCRIPTION
MODULE_DESCRIPTION("Universal Linux CAN-bus device driver");
#endif
+#ifdef MODULE_AUTHOR
+MODULE_AUTHOR("Pavel Pisa <pisa@cmp.felk.cvut.cz>, Arnaud Westenberg");
+#endif
/* Global structures, used to describe the installed hardware. */
struct canhardware_t canhardware;
struct canhardware_t *hardware_p=&canhardware;
-struct chip_t *chips_p[MAX_TOT_CHIPS];
+struct canchip_t *chips_p[MAX_TOT_CHIPS];
struct msgobj_t *objects_p[MAX_TOT_MSGOBJS];
#ifdef CONFIG_DEVFS_FS
-#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,60))
+#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
devfs_handle_t devfs_handles[MAX_TOT_MSGOBJS];
#endif
#endif
*/
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=
{
- owner: THIS_MODULE,
+ #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);
+
+#ifdef CAN_WITH_RTL
+struct rtl_file_operations can_fops_rtl = {
+ llseek: NULL,
+ read: can_read_rtl_posix,
+ write: can_write_rtl_posix,
+ ioctl: can_ioctl_rtl_posix,
+ mmap: NULL,
+ open: can_open_rtl_posix,
+ release: can_release_rtl_posix
+};
+#endif /*CAN_WITH_RTL*/
+
+
+/*
+ 2.6 kernel attributes for sysfs
+
+static ssize_t show_xxx(struct class_device *cdev, char *buf)
+{
+ return sprintf(buf, "xxxx\n");
+}
+
+static ssize_t store_xxx(struct class_device *cdev, const char * buf, size_t count)
+{
+}
+
+static CLASS_DEVICE_ATTR(xxx, S_IRUGO, show_xxx, store_xxx/NULL);
+
+ret = class_device_create_file(class_dev, class_device_attr_xxx);
+if (ret)
+ goto err_unregister;
+
+*/
+
int init_module(void)
{
- int res=0,i=0;
+ int res=0,i=0, j;
struct candevice_t *candev;
+ struct canchip_t *chip;
if (parse_mod_parms())
return -EINVAL;
+ can_spin_lock_init(&canuser_manipulation_lock);
+ canqueue_kern_initialize();
+
if (init_hw_struct())
return -ENODEV;
res=register_chrdev(major,DEVICE_NAME, &can_fops);
if (res<0) {
CANMSG("Error registering driver.\n");
- return -ENODEV;
+ goto register_error;
}
+ #ifdef CAN_WITH_RTL
+ can_spin_lock_init(&can_irq_manipulation_lock);
+ canqueue_rtl_initialize();
+ res=rtl_register_rtldev(major,DEVICE_NAME,&can_fops_rtl);
+ if (res<0) {
+ CANMSG("Error registering RT-Linux major number.\n");
+ goto rtldev_error;
+ }
+ #endif /*CAN_WITH_RTL*/
+
for (i=0; i<hardware_p->nr_boards; i++) {
candev=hardware_p->candevice[i];
- if (candev->hwspecops->request_io(candev))
- goto memory_error;
+ if (candev->hwspecops->request_io(candev))
+ goto request_io_error;
+ candev->flags|=CANDEV_IO_RESERVED;
}
for (i=0; i<hardware_p->nr_boards; i++) {
candev=hardware_p->candevice[i];
- if (candev->hwspecops->reset(candev))
+ if (candev->hwspecops->reset(candev))
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]))
+ for (i=0; i<hardware_p->nr_boards; i++) {
+ candev=hardware_p->candevice[i];
+ for(j=0; j<candev->nr_all_chips; j++) {
+ if((chip=candev->chip[j])==NULL)
+ continue;
+
+ if(chip->chipspecops->attach_to_chip(chip)<0) {
+ CANMSG("Initial attach to the chip HW failed\n");
goto interrupt_error;
- else
- DEBUGMSG("Registered interrupt %d\n",chips_p[i]->chip_irq);
+ }
+
+ chip->flags |= CHIP_ATTACHED;
+
+ if(can_chip_setup_irq(chip)<0) {
+ CANMSG("Error to setup chip IRQ\n");
+ goto interrupt_error;
+ }
}
- i++;
- }
- for (i=0; i<hardware_p->nr_boards; i++) {
- candev=hardware_p->candevice[i];
- if (candev->flags & PROGRAMMABLE_IRQ)
- if (candev->hwspecops->program_irq(candev))
+ if (candev->flags & CANDEV_PROGRAMMABLE_IRQ)
+ if (candev->hwspecops->program_irq(candev)){
+ CANMSG("Error to program board interrupt\n");
goto interrupt_error;
+ }
}
#ifdef CONFIG_PROC_FS
goto proc_error;
#endif
-#ifdef CONFIG_DEVFS_FS
+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+ can_class=class_create(THIS_MODULE, "can");
+#endif
+
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
{
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
char dev_name[32];
+ #elif LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25) /* >= 2.6.15 */
+ struct class_device *this_dev;
+ #else
+ struct device *this_dev;
+ #endif
int dev_minor;
for(i=0;i<MAX_TOT_MSGOBJS;i++) {
if(!objects_p[i]) continue;
dev_minor=objects_p[i]->minor;
- #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,50))
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
sprintf (dev_name, "can%d", dev_minor);
devfs_handles[i]=devfs_register(NULL, dev_name,
DEVFS_FL_DEFAULT, major, dev_minor,
S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP,
&can_fops, (void*)objects_p[i]);
#else
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,14))
+ 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);
+ #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);
+ #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)
+ }else{
+ /*this_dev->class_data=objects_p[i];*/
+ class_set_devdata(this_dev,objects_p[i]);
+ #endif /* <= 2.6.25 */
+ }
+ #ifdef CONFIG_DEVFS_FS
devfs_mk_cdev(MKDEV(major, dev_minor), S_IFCHR | S_IRUGO | S_IWUGO, "can%d", dev_minor);
+ #endif
#endif
}
}
#endif
+
+#if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+ res = usbcan_init();
+ if (res){
+ CANMSG("usb_register for usbcan failed. Error number %d.\n", res);
+ 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;
#ifdef CONFIG_PROC_FS
proc_error: ;
CANMSG("Error registering /proc entry.\n");
- goto memory_error;
+ goto memory_error;
#endif
interrupt_error: ;
- CANMSG("Error registering interrupt line.\n");
goto memory_error;
reset_error: ;
+ CANMSG("Error resetting device.\n");
+ goto memory_error;
+
+ request_io_error: ;
+ CANMSG("Error to request IO resources for device.\n");
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);
+
+ #ifdef CAN_WITH_RTL
+ rtl_unregister_rtldev(major,DEVICE_NAME);
+ rtldev_error:
+ canqueue_rtl_done();
+ #endif /*CAN_WITH_RTL*/
+
+ unregister_chrdev(major,DEVICE_NAME);
+ CANMSG("No CAN devices or driver setup error.\n");
+
+ register_error:
+ if ( can_del_mem_list() )
+ CANMSG("Error deallocating memory\n");
- 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");
return -ENODEV;
+}
+
+
+
+
+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;
+ struct boardtype_t *brp;
+
+ while ( (hw[board] != NULL) && (board < MAX_HW_CARDS) )
+ board++;
+ if (board>=MAX_HW_CARDS){
+ CANMSG("Maximum number of devices has been reached, no space for new device");
+ return NULL;
+ }
+ brp = boardtype_find(hwname);
+ if(!brp) {
+ 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",hwname);
+ return NULL;
+ }
+ hw[board]=brp->boardtype;
+
+ if (init_new_hw_struct(board))
+ return NULL;
+
+ #ifdef CAN_DEBUG
+ list_hw();
+ #endif
+
+ candev=hardware_p->candevice[board];
+
+ /* Adding link to usb device structure into can device */
+ candev->sysdevptr.anydev=devdata;
+
+ if (candev->hwspecops->request_io(candev))
+ goto request_io_error;
+ candev->flags|=CANDEV_IO_RESERVED;
+
+ if (candev->hwspecops->reset(candev))
+ goto reset_error;
+
+ for(j=0; j<candev->nr_all_chips; j++) {
+ if((chip=candev->chip[j])==NULL)
+ continue;
+
+ 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");
+ goto interrupt_error;
+ }
+
+ chip->flags |= CHIP_ATTACHED;
+
+ if(can_chip_setup_irq(chip)<0) {
+ CANMSG("Error to setup chip IRQ\n");
+ goto interrupt_error;
+ }
+ }
+
+ if (candev->flags & CANDEV_PROGRAMMABLE_IRQ)
+ if (candev->hwspecops->program_irq(candev)){
+ CANMSG("Error to program board interrupt\n");
+ goto interrupt_error;
+ }
+
+#ifdef CONFIG_PROC_FS
+ if (can_init_procentry(board))
+ goto proc_error;
+#endif
+
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+ {
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
+ char dev_name[32];
+ #else
+ struct class_device *this_dev;
+ #endif
+ int dev_minor;
+ for(i=0;i<MAX_TOT_MSGOBJS;i++) {
+ if(!objects_p[i]) continue;
+ if(objects_p[i]->hostchip->hostdevice != candev) continue;
+
+ dev_minor=objects_p[i]->minor;
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
+ sprintf (dev_name, "can%d", dev_minor);
+ devfs_handles[i]=devfs_register(NULL, dev_name,
+ DEVFS_FL_DEFAULT, major, dev_minor,
+ S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP,
+ &can_fops, (void*)objects_p[i]);
+ #else
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,14))
+ 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);
+ #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);
+ #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)
+ }else{
+ /*this_dev->class_data=objects_p[i];*/
+ class_set_devdata(this_dev,objects_p[i]);
+ #endif /* <= 2.6.25 */
+ }
+ #ifdef CONFIG_DEVFS_FS
+ devfs_mk_cdev(MKDEV(major, dev_minor), S_IFCHR | S_IRUGO | S_IWUGO, "can%d", dev_minor);
+ #endif
+ #endif
+ }
+ }
+#endif
+ return candev;
+
+#ifdef CONFIG_PROC_FS
+ proc_error: ;
+ CANMSG("Error registering /proc entry.\n");
+ goto memory_error;
+#endif
+
+ interrupt_error: ;
+ goto memory_error;
+
+ reset_error: ;
+ CANMSG("Error resetting device.\n");
+ goto memory_error;
+
+ request_io_error: ;
+ CANMSG("Error to request IO resources for device.\n");
+ goto memory_error;
+
+ memory_error: ;
+
+ #ifdef CAN_WITH_RTL
+ rtldev_error:
+ #endif /*CAN_WITH_RTL*/
+
+// register_error:
+// if ( can_del_mem_list() )
+// CANMSG("Error deallocating memory\n");
+
+ return NULL;
}
+void cleanup_hotplug_dev(struct candevice_t *dev)
+{
+ int i=0;
+ int dev_minor;
+
+ if (!dev)
+ return;
+ DEBUGMSG("Cleaning up hotplug device.\n");
+
+#ifdef CONFIG_PROC_FS
+ if (can_delete_procentry(dev))
+ CANMSG("Error unregistering /proc/can entry.\n");
+#endif
+
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+ for(i=0;i<MAX_TOT_MSGOBJS;i++) {
+ if(!objects_p[i]) continue;
+ if(objects_p[i]->hostchip->hostdevice != dev) continue;
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
+ if(devfs_handles[i])
+ devfs_unregister(devfs_handles[i]);
+ #else
+ dev_minor=objects_p[i]->minor;
+ if(dev_minor>=0){
+ #ifdef CONFIG_DEVFS_FS
+ devfs_remove("can%d", dev_minor);
+ #endif
+ #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25)
+ class_device_destroy(can_class, MKDEV(major, dev_minor));
+ #else /* >= 2.6.26 */
+ device_destroy(can_class, MKDEV(major, dev_minor));
+ #endif /* >= 2.6.26 */
+ }
+ #endif
+ }
+#endif
+
+ for(i=0;i<MAX_TOT_CHIPS;i++){
+ if(!chips_p[i]) continue;
+ if(chips_p[i]->hostdevice != dev) continue;
+ chips_p[i]=NULL;
+ }
+
+ hardware_p->candevice[dev->candev_idx]=NULL;
+ hardware_p->nr_boards--;
+ hw[dev->candev_idx]=NULL;
+
+ candevice_done(dev);
+ can_checked_free(dev);
+}
+
+
+
+
void cleanup_module(void)
{
- int res=0,i=0;
- struct candevice_t *candev;
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+ int i=0;
+#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");
+ CANMSG("Error unregistering /proc/can entry.\n");
#endif
-#ifdef CONFIG_DEVFS_FS
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
for(i=0;i<MAX_TOT_MSGOBJS;i++) {
- #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,5,50))
+ #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
if(devfs_handles[i])
devfs_unregister(devfs_handles[i]);
#else
int dev_minor;
if(!objects_p[i]) continue;
dev_minor=objects_p[i]->minor;
- if(minor>=0)
+ if(minor>=0){
+ #ifdef CONFIG_DEVFS_FS
devfs_remove("can%d", dev_minor);
+ #endif
+ #if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,25)
+ class_device_destroy(can_class, MKDEV(major, dev_minor));
+ #else /* >= 2.6.26 */
+ device_destroy(can_class, MKDEV(major, dev_minor));
+ #endif /* >= 2.6.26 */
+ }
#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);
- }
+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+ class_destroy(can_class);
+#endif
+
+ canhardware_done(hardware_p);
+
+ #ifdef CAN_WITH_RTL
+ rtl_unregister_rtldev(major,DEVICE_NAME);
+ canqueue_rtl_done();
+ #endif /*CAN_WITH_RTL*/
- if ( del_mem_list() )
+ DEBUGMSG("Can hardware cleanup done, freeing memory.\n");
+
+ if ( can_del_mem_list() )
CANMSG("Error deallocating memory\n");
- res=unregister_chrdev(major,DEVICE_NAME);
- if (res<0)
- CANMSG("Error unregistering CAN driver, error: %d\n",res);
+ unregister_chrdev(major,DEVICE_NAME);
}