]> rtime.felk.cvut.cz Git - lincan.git/blobdiff - lincan/src/main.c
Merge branch 'master' into can-usb1
[lincan.git] / lincan / src / main.c
index 92d7966055f650c4cbb1f2249ba85ee94d784b3a..b8edf46f5c37a3b7f59f1f91f36f5862bf1a645b 100644 (file)
@@ -38,7 +38,7 @@
  #endif
 #endif
 
-#if !defined (__GENKSYMS__) 
+#if !defined (__GENKSYMS__)
 #if (defined (MODVERSIONS) && !defined(NOVER))
 #include <linux/modversions.h>
 /*#include "../include/main.ver"*/
 #include "../include/can_iortl.h"
 #endif /*CAN_WITH_RTL*/
 
+#if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+       #include "../include/usbcan.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");
-MODULE_PARM_DESC(major,"can be used to change default major [" __MODULE_STRING(CAN_MAJOR) "]");
 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");
-MODULE_PARM_DESC(minor,"can be used to change default starting minor for each channel");
-int extended=0;
 MODULE_PARM(extended,"1i");
+MODULE_PARM(pelican,"1i");
+MODULE_PARM(baudrate, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
+MODULE_PARM(hw, "1-" __MODULE_STRING(MAX_HW_CARDS)"s");
+MODULE_PARM(irq, "1-" __MODULE_STRING(MAX_IRQ)"i");
+MODULE_PARM(io, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
+MODULE_PARM(clockfreq, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
+MODULE_PARM(stdmask, "1i");
+MODULE_PARM(extmask, "1i");
+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");
-int pelican=0;
-MODULE_PARM(pelican,"1i");
 MODULE_PARM_DESC(pelican,"unused parameter, PeliCAN used by default for sja1000p chips");
-int baudrate[MAX_TOT_CHIPS];
-MODULE_PARM(baudrate, "1-" __MODULE_STRING(MAX_TOT_CHIPS_STR)"i");
 MODULE_PARM_DESC(baudrate,"baudrate for each channel in step of 1kHz");
-char *hw[MAX_HW_CARDS]={NULL,};
-MODULE_PARM(hw, "1-" __MODULE_STRING(MAX_HW_CARDS)"s");
 MODULE_PARM_DESC(hw,"list of boards types to initialize - virtual,pip5,...");
-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");
 MODULE_PARM_DESC(irq,"list of iterrupt signal numbers, most ISA has one per chip, no value for PCI or virtual");
-unsigned long io[MAX_HW_CARDS]={-1,-1,-1,-1,-1,-1,-1,-1};
-MODULE_PARM(io, "1-" __MODULE_STRING(MAX_HW_CARDS)"i");
 MODULE_PARM_DESC(io,"IO address for each board, use 0 for PCI or virtual");
-int stdmask=0;
-MODULE_PARM(stdmask, "1i");
+MODULE_PARM_DESC(clockfreq,"base board clock source frequency in step of 1kHz");
 MODULE_PARM_DESC(stdmask,"default standard mask for i82527 chips");
-int extmask=0;
-MODULE_PARM(extmask, "1i");
 MODULE_PARM_DESC(extmask,"default extended mask for i82527 chips");
-int mo15mask=0;
-MODULE_PARM(mo15mask, "1i");
 MODULE_PARM_DESC(mo15mask,"mask for communication object 15 of i82527 chips");
-int processlocal=0;
-MODULE_PARM(processlocal, "1i");
 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");
@@ -155,7 +189,7 @@ struct mem_addr *mem_head=NULL;
 struct file_operations can_fops=
 {
  #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,0))
-       owner:          THIS_MODULE,    
+       owner:          THIS_MODULE,
  #endif
        read:           can_read,
        write:          can_write,
@@ -186,7 +220,7 @@ struct rtl_file_operations can_fops_rtl = {
 
 /*
  2.6 kernel attributes for sysfs
+
 static ssize_t show_xxx(struct class_device *cdev, char *buf)
 {
         return sprintf(buf, "xxxx\n");
@@ -241,14 +275,14 @@ int init_module(void)
 
        for (i=0; i<hardware_p->nr_boards; i++) {
                candev=hardware_p->candevice[i];
-               if (candev->hwspecops->request_io(candev)) 
+               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;
        }
 
@@ -267,7 +301,7 @@ int init_module(void)
                        }
 
                        chip->flags |= CHIP_ATTACHED;
-       
+
                        if(can_chip_setup_irq(chip)<0) {
                                CANMSG("Error to setup chip IRQ\n");
                                goto interrupt_error;
@@ -294,8 +328,10 @@ int init_module(void)
         {
            #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,0))
                char dev_name[32];
-           #else
+           #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++) {
@@ -310,14 +346,18 @@ int init_module(void)
                    #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);
-                     #else /* >= 2.6.15 */
+                     #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);
-                     #endif /* >= 2.6.15 */
+                     #else /* >= 2.6.26 */
+                       this_dev=device_create_drvdata(can_class, NULL, MKDEV(major, dev_minor), objects_p[i],  "can%d", dev_minor);
+                     #endif /* >= 2.6.26 */
                        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);
@@ -326,12 +366,21 @@ int init_module(void)
                }
         }
 #endif
+
+#if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+       res = usbcan_init();
+       if (res){
+               CANMSG("usb_register for usbcan failed. Error number %d.\n", res);
+               return -ENODEV;
+       }
+#endif
+
        return 0;
 
 #ifdef CONFIG_PROC_FS
        proc_error: ;
                CANMSG("Error registering /proc entry.\n");
-               goto memory_error; 
+               goto memory_error;
 #endif
 
        interrupt_error: ;
@@ -354,26 +403,238 @@ int init_module(void)
                canqueue_rtl_done();
                #endif /*CAN_WITH_RTL*/
 
-               res=unregister_chrdev(major,DEVICE_NAME);
-               if (res<0)
-                       CANMSG("Error unloading CAN driver, error: %d\n",res);
-               else
-                       CANMSG("No CAN devices or driver setup error.\n");
+               unregister_chrdev(major,DEVICE_NAME);
+               CANMSG("No CAN devices or driver setup error.\n");
 
        register_error:
-               if ( can_del_mem_list() ) 
+               if ( can_del_mem_list() )
                        CANMSG("Error deallocating memory\n");
 
                return -ENODEV;
 }
 
+
+
+
+
+struct candevice_t* register_usbdev(const char *hwname,void *devdata,void (*chipdataregfnc)(struct canchip_t *ch,void *data)){
+       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",hw[board]);
+               return NULL;
+       }
+       if (board==MAX_HW_CARDS){
+                       CANMSG("Device \"%s\" could not be registered due to internal limits.\n",hw[board]);
+                       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;
+
+               chipdataregfnc(chip,devdata);
+
+               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);
+                       #else /* >= 2.6.26 */
+                       this_dev=device_create_drvdata(can_class, NULL, MKDEV(major, dev_minor), objects_p[i],  "can%d", dev_minor);
+                       #endif /* >= 2.6.26 */
+                       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_usbdev(struct candevice_t *dev)
+{
+       int i=0;
+       int dev_minor;
+
+       if (!dev)
+               return;
+
+#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;
+#if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
+       int i=0;
+#endif
+
+#if defined(CONFIG_OC_LINCAN_CARD_usbcan)
+       usbcan_exit();
+#endif
 
 #ifdef CONFIG_PROC_FS
        if (can_delete_procdir())
-               CANMSG("Error unregistering /proc/can entry.\n"); 
+               CANMSG("Error unregistering /proc/can entry.\n");
 #endif
 
 #if defined(CONFIG_DEVFS_FS) || (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
@@ -389,7 +650,11 @@ void cleanup_module(void)
                    #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
                }
@@ -406,10 +671,8 @@ void cleanup_module(void)
        canqueue_rtl_done();
        #endif /*CAN_WITH_RTL*/
 
-       if ( can_del_mem_list() ) 
+       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);
 }