X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/11132ea490f9e860744ee4f851c67e7fb4444231..831ccb1f14f7472962fc2d185f32e18105209bd7:/lincan/src/setup.c diff --git a/lincan/src/setup.c b/lincan/src/setup.c index d234eb9..cb6550d 100644 --- a/lincan/src/setup.c +++ b/lincan/src/setup.c @@ -4,186 +4,150 @@ * 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 - */ - -#define __NO_VERSION__ -#include - -#include - -#include -#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0)) -#include -#else -#include -#endif -#include -#include - -#include ".supported_cards.h" + * Version lincan-0.3 17 Jun 2004 + */ +#include "../include/can.h" +#include "../include/can_sysdep.h" #include "../include/main.h" #include "../include/devcommon.h" #include "../include/setup.h" -#include "../include/pip.h" -#include "../include/pccan.h" -#include "../include/smartcan.h" -#include "../include/pc-i03.h" -#include "../include/pcm3680.h" -#include "../include/m437.h" -#include "../include/template.h" -#include "../include/i82527.h" -#include "../include/aim104.h" -#include "../include/pcccan.h" - -extern int sja1000_register(struct chipspecops_t *chipspecops); -extern int sja1000p_register(struct chipspecops_t *chipspecops); -extern int i82527_register(struct chipspecops_t *chipspecops); -extern int template_register(struct hwspecops_t *hwspecops); -extern int pip5_register(struct hwspecops_t *hwspecops); -extern int pip6_register(struct hwspecops_t *hwspecops); -extern int smartcan_register(struct hwspecops_t *hwspecops); -extern int pccanf_register(struct hwspecops_t *hwspecops); -extern int pccand_register(struct hwspecops_t *hwspecops); -extern int pccanq_register(struct hwspecops_t *hwspecops); -extern int nsi_register(struct hwspecops_t *hwspecops); -extern int cc104_register(struct hwspecops_t *hwspecops); -extern int pci03_register(struct hwspecops_t *hwspecops); -extern int pcm3680_register(struct hwspecops_t *hwspecops); -extern int aim104_register(struct hwspecops_t *hwspecops); -extern int pcccan_register(struct hwspecops_t *hwspecops); -extern int ssv_register(struct hwspecops_t *hwspecops); -extern int bfadcan_register(struct hwspecops_t *hwspecops); -extern int pikronisa_register(struct hwspecops_t *hwspecops); - -int init_device_struct(int card); -int init_hwspecops(struct candevice_t *candev); -int init_chip_struct(struct candevice_t *candev); -int init_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int minorbase); -int init_chipspecops(struct candevice_t *candev, int chipnr); - -int add_mem_to_list(void *address_p) +#include "../include/finish.h" + +int init_hwspecops(struct candevice_t *candev, int *irqnum_p); +int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p); +int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock); +int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr); + +int next_minor=0; + +/** + * can_base_addr_fixup - relocates board physical memory addresses to the CPU accessible ones + * @candev: pointer to the previously filled device/board, chips and message objects structures + * @new_base: @candev new base address + * + * This function adapts base addresses of all structures of one board + * to the new board base address. + * It is required for translation between physical and virtual address mappings. + * This function is prepared to simplify board specific xxx_request_io() function + * for memory mapped devices. + */ +int can_base_addr_fixup(struct candevice_t *candev, can_ioptr_t new_base) { - struct mem_addr *mem_new; - -#ifdef DEBUG_MEM - DEBUGMSG("add_mem_to_list %p, mem_head=%p\n",address_p, mem_head); - return 0; -#endif + long offs; + int i, j; - mem_new=(struct mem_addr *)kmalloc(sizeof(struct mem_addr),GFP_KERNEL); - if (mem_new == NULL) { - CANMSG("Memory list error.\n"); - return -ENOMEM; + offs=new_base-candev->dev_base_addr; + candev->dev_base_addr=new_base; + for(i=0;inr_all_chips;i++){ + candev->chip[i]->chip_base_addr += offs; + for(j=0;jchip[i]->max_objects;j++) + candev->chip[i]->msgobj[j]->obj_base_addr += offs; } - mem_new->next=mem_head; - mem_new->address=address_p; - mem_head=mem_new; - return 0; } -int del_mem_from_list(void *address_p) +/** + * can_check_dev_taken - checks if bus device description is already taken by driver + * @anydev: pointer to bus specific Linux device description + * + * Returns: Returns 1 if device is already used by LinCAN driver, 0 otherwise. + */ +int can_check_dev_taken(void *anydev) { - struct mem_addr *mem_search=NULL; - struct mem_addr *mem_delete=NULL; - -#ifdef DEBUG_MEM - DEBUGMSG("del_mem_from_list %p, mem_head=%p\n", address_p, mem_head); - return 0; -#endif - if(mem_head == NULL) { - CANMSG("del_mem_from_list: mem_head == NULL address_p=%p!\n", - address_p); - return 0; + int board_nr; + struct candevice_t *candev; + void *boarddev; + + for (board_nr=hardware_p->nr_boards; board_nr--; ) { + if((candev=hardware_p->candevice[board_nr])==NULL) + continue; + boarddev=candev->sysdevptr.anydev; + if(boarddev == anydev) + return 1; } - mem_search = mem_head; - - if (mem_head->address == address_p) { - kfree(mem_head->address); - mem_head=mem_head->next; - kfree(mem_search); - } - else { - while (mem_search->next->address != address_p) - mem_search=mem_search->next; - kfree(mem_search->next->address); - mem_delete=mem_search->next; - mem_search->next=mem_search->next->next; - kfree(mem_delete); - } return 0; } -int del_mem_list(void) +/** + * register_obj_struct - registers message object into global array + * @obj: the initialized message object being registered + * @minorbase: wanted minor number, if (-1) automatically selected + * + * Return Value: returns negative number in the case of fail + */ +int register_obj_struct(struct msgobj_t *obj, int minorbase) { - struct mem_addr *mem_old; - -#ifdef DEBUG_MEM - DEBUGMSG("del_mem_list, mem_head=%p\n", mem_head); - return 0; -#endif - if(mem_head == NULL) { - CANMSG("del_mem_list: mem_head == NULL!\n"); - return 0; - } - - while (mem_head->next != NULL) { - mem_old=mem_head; - kfree(mem_old->address); - mem_head=mem_old->next; - kfree(mem_old); - } - - return 0; + int i; + + if(minorbase>=0) + next_minor=minorbase; + if(next_minor>=MAX_TOT_MSGOBJS) + next_minor=0; + i=next_minor; + do{ + if(objects_p[i]==NULL){ + objects_p[i]=obj; + obj->minor=i; + next_minor=i+1; + return 0; + } + if(++i >= MAX_TOT_MSGOBJS) i=0; + }while(i!=next_minor); + obj->minor=-1; + return -1; } -int can_request_io_region(unsigned long start, unsigned long n, const char *name) -{ - #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0)) - if(check_region(start,n)) return 0; - request_region(start,n,name); - return 1; - #else - return (request_region(start,n,name))?1:0; - #endif -} -void can_release_io_region(unsigned long start, unsigned long n) +/** + * register_chip_struct - registers chip into global array + * @chip: the initialized chip structure being registered + * @minorbase: wanted minor number base, if (-1) automatically selected + * + * Return Value: returns negative number in the case of fail + */ +int register_chip_struct(struct canchip_t *chip, int minorbase) { - release_region(start,n); + static int next_chip_slot=0; + int i; + + if(next_chip_slot>=MAX_TOT_CHIPS) + next_chip_slot=0; + i=next_chip_slot; + do{ + if(chips_p[i]==NULL){ + chips_p[i]=chip; + + next_chip_slot=i+1; + return 0; + } + if(++i >= MAX_TOT_CHIPS) i=0; + }while(i!=next_chip_slot); + return -1; } -/* This function shifts all base address structures acording to address - translation between physical and virtual address mappings */ -int can_base_addr_fixup(struct candevice_t *candev, unsigned long new_base) -{ - unsigned long offs; - int i, j; - - offs=new_base-candev->dev_base_addr; - candev->dev_base_addr=new_base; - for(i=0;inr_all_chips;i++){ - candev->chip[i]->chip_base_addr += offs; - for(j=0;jchip[i]->max_objects;j++) - candev->chip[i]->msgobj[j]->obj_base_addr += offs; - } - return 0; -} -/* The function init_hw_struct is used to initialize the hardware structure. */ + +/** + * init_hw_struct - initializes driver hardware description structures + * + * The function init_hw_struct() is used to initialize the hardware structure. + * + * Return Value: returns negative number in the case of fail + */ int init_hw_struct(void) { int i=0; + int irq_param_idx=0; + int chan_param_idx=0; hardware_p->nr_boards=0; while ( (hw[i] != NULL) & (i < MAX_HW_CARDS) ) { hardware_p->nr_boards++; - if (init_device_struct(i)) { + if (init_device_struct(i, &chan_param_idx, &irq_param_idx)) { CANMSG("Error initializing candevice_t structures.\n"); return -ENODEV; } @@ -193,19 +157,66 @@ int init_hw_struct(void) return 0; } -/* The function init_device_struct is used to initialize a single device - * structure. +/** + * init_new_hw_struct - initializes driver description structures for new hardware + * + * The function init_new_hw_struct() is used to initialize the hardware structure. + * + * Return Value: returns negative number in the case of fail */ -int init_device_struct(int card) +int init_new_hw_struct(int devnr) +{ + int irq_param_idx=0; + int chan_param_idx=0; + + if ( (hw[devnr] != NULL) & (devnr < MAX_HW_CARDS) ) { + hardware_p->nr_boards++; + + if (init_device_struct(devnr, &chan_param_idx, &irq_param_idx)) { + CANMSG("Error initializing candevice_t structures.\n"); + return -ENODEV; + } + } + + return 0; +} + +/** + * init_device_struct - initializes single CAN device/board + * @card: index into @hardware_p HW description + * @chan_param_idx_p: pointer to the index into arrays of the CAN channel parameters + * @irq_param_idx_p: pointer to the index into arrays of the per CAN channel IRQ parameters + * + * The function builds representation of the one board from parameters provided + * in the module parameters arrays: + * @hw[card] .. hardware type, + * @io[card] .. base IO address, + * @baudrate[chan_param_idx] .. per channel baudrate, + * @minor[chan_param_idx] .. optional specification of requested channel minor base, + * @irq[irq_param_idx] .. one or more board/chips IRQ parameters. + * The indexes are advanced after consumed parameters if the registration is successful. + * + * The hardware specific operations of the device/board are initialized by call to + * init_hwspecops() function. Then board data are initialized by board specific + * init_hw_data() function. Then chips and objects representation is build by + * init_chip_struct() function. If all above steps are successful, chips and + * message objects are registered into global arrays. + * + * Return Value: returns negative number in the case of fail + */ +int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p) { struct candevice_t *candev; - - candev=(struct candevice_t *)kmalloc(sizeof(struct candevice_t),GFP_KERNEL); + int ret; + int irqnum; + int chipnr; + long bd; + int irqsig=-1; + long clock; + + candev=(struct candevice_t *)can_checked_malloc(sizeof(struct candevice_t)); if (candev==NULL) return -ENOMEM; - else - if ( add_mem_to_list(candev) ) - return -ENOMEM; memset(candev, 0, sizeof(struct candevice_t)); @@ -217,223 +228,197 @@ int init_device_struct(int card) candev->hwname=hw[card]; candev->io_addr=io[card]; candev->dev_base_addr=io[card]; + clock=clockfreq[card]; - candev->hwspecops=(struct hwspecops_t *)kmalloc(sizeof(struct hwspecops_t),GFP_KERNEL); + candev->hwspecops=(struct hwspecops_t *)can_checked_malloc(sizeof(struct hwspecops_t)); if (candev->hwspecops==NULL) - return -ENOMEM; - else - if ( add_mem_to_list(candev->hwspecops) ) - return -ENOMEM; + goto error_nomem; - if (init_hwspecops(candev)) - return -ENODEV; + memset(candev->hwspecops, 0, sizeof(struct hwspecops_t)); + + if (init_hwspecops(candev, &irqnum)) + goto error_nodev; if (candev->hwspecops->init_hw_data(candev)) - return -ENODEV; + goto error_nodev; + + /* Alocate and initialize the chip structures */ + for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) { + + if(chipnrnr_all_chips; chipnr++) { + int m=minor[*chan_param_idx_p+chipnr]; + struct canchip_t *chip=candev->chip[chipnr]; + int objnr; + + register_chip_struct(chip, m); + + for (objnr=0; objnrmax_objects; objnr++) { + register_obj_struct(chip->msgobj[objnr], m); + if(m>=0) m++; + } + } + + *irq_param_idx_p += irqnum; + *chan_param_idx_p += candev->nr_all_chips; return 0; + + error_nodev: + ret=-ENODEV; + error_chip: + candevice_done(candev); + goto error_both; + + error_nomem: + ret=-ENOMEM; + + error_both: + hardware_p->candevice[card]=NULL; + can_checked_free(candev); + return ret; + } -/* The function init_chip_struct is used to initialize all chip_t structures - * on one hardware board. +/** + * init_chip_struct - initializes one CAN chip structure + * @candev: pointer to the corresponding CAN device/board + * @chipnr: index of the chip in the corresponding device/board structure + * @irq: chip IRQ number or (-1) if not appropriate + * @baudrate: baudrate in the units of 1Bd + * @clock: optional chip base clock frequency in 1Hz step + * + * Chip structure is allocated and chip specific operations are filled by + * call to board specific init_chip_data() which calls chip specific + * fill_chipspecops(). The message objects are generated by + * calls to init_obj_struct() function. + * + * Return Value: returns negative number in the case of fail */ -int init_chip_struct(struct candevice_t *candev) +int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock) { - static int irq_count=0; - int i=0; + struct canchip_t *chip; + int objnr; + int ret; - /* Alocate and initialize the chip structures */ - for (i=0; i < candev->nr_all_chips; i++) { - candev->chip[i]=(struct chip_t *)kmalloc(sizeof(struct chip_t),GFP_KERNEL); - if (candev->chip[i]==NULL) - return -ENOMEM; - else - if ( add_mem_to_list(candev->chip[i]) ) - return -ENOMEM; - - memset(candev->chip[i], 0, sizeof(struct chip_t)); - - candev->chip[i]->write_register=candev->hwspecops->write_register; - candev->chip[i]->read_register=candev->hwspecops->read_register; - - candev->chip[i]->chipspecops=(struct chipspecops_t *)kmalloc(sizeof(struct chipspecops_t),GFP_KERNEL); - if (candev->chip[i]->chipspecops==NULL) - return -ENOMEM; - else - if ( add_mem_to_list(candev->chip[i]->chipspecops) ) - return -ENOMEM; - - chips_p[irq_count]=candev->chip[i]; - candev->chip[i]->chip_idx=i; - candev->chip[i]->hostdevice=candev; - candev->chip[i]->chip_irq=irq[irq_count]; - candev->chip[i]->flags=0x0; - - candev->hwspecops->init_chip_data(candev,i); - - if (init_chipspecops(candev,i)) - return -ENODEV; + candev->chip[chipnr]=(struct canchip_t *)can_checked_malloc(sizeof(struct canchip_t)); + if ((chip=candev->chip[chipnr])==NULL) + return -ENOMEM; + + memset(chip, 0, sizeof(struct canchip_t)); - init_obj_struct(candev, candev->chip[i], minor[irq_count]); + chip->write_register=candev->hwspecops->write_register; + chip->read_register=candev->hwspecops->read_register; - irq_count++; - } + chip->chipspecops=can_checked_malloc(sizeof(struct chipspecops_t)); + if (chip->chipspecops==NULL) + return -ENOMEM; + memset(chip->chipspecops,0,sizeof(struct chipspecops_t)); + + chip->chip_idx=chipnr; + chip->hostdevice=candev; + chip->chip_irq=irq; + chip->baudrate=baudrate; + chip->clock=clock; + chip->flags=0x0; + + if(candev->hwspecops->init_chip_data(candev,chipnr)<0) + return -ENODEV; + + for (objnr=0; objnrmax_objects; objnr++) { + ret=init_obj_struct(candev, chip, objnr); + if(ret<0) return ret; + } return 0; } -int init_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int minorbase) + +/** + * init_obj_struct - initializes one CAN message object structure + * @candev: pointer to the corresponding CAN device/board + * @hostchip: pointer to the chip containing this object + * @objnr: index of the builded object in the chip structure + * + * The function initializes message object structure and allocates and initializes + * CAN queue chip ends structure. + * + * Return Value: returns negative number in the case of fail + */ +int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr) { struct canque_ends_t *qends; - static int obj_count=0; - int i,max_objects; struct msgobj_t *obj; + int ret; - max_objects=hostchip->max_objects; - for (i=0; imsgobj[i]=obj; - if (obj == NULL) - return -ENOMEM; - else - if ( add_mem_to_list(obj) ) - return -ENOMEM; - - memset(obj, 0, sizeof(struct msgobj_t)); - - atomic_set(&obj->obj_used,0); - INIT_LIST_HEAD(&obj->obj_users); - qends = (struct canque_ends_t *)kmalloc(sizeof(struct canque_ends_t), GFP_KERNEL); - if(qends == NULL) return -ENOMEM; - if(add_mem_to_list(qends)) return -ENOMEM; - memset(qends, 0, sizeof(struct canque_ends_t)); - obj->hostchip=hostchip; - obj->object=i+1; - obj->qends=qends; - obj->tx_qedge=NULL; - obj->tx_slot=NULL; - obj->flags = 0x0; - - canqueue_ends_init_chip(qends, hostchip, obj); - - if (minorbase == -1) minorbase=obj_count; - if ((minorbase >= 0) && (minorbase+iminor=minorbase+i; - } else obj->minor=-1; - - candev->hwspecops->init_obj_data(hostchip,i); - - obj_count++; - } - return 0; -} + obj=(struct msgobj_t *)can_checked_malloc(sizeof(struct msgobj_t)); + hostchip->msgobj[objnr]=obj; + if (obj == NULL) + return -ENOMEM; + memset(obj, 0, sizeof(struct msgobj_t)); + obj->minor=-1; + + atomic_set(&obj->obj_used,0); + INIT_LIST_HEAD(&obj->obj_users); + init_timer(&obj->tx_timeout); + + qends = (struct canque_ends_t *)can_checked_malloc(sizeof(struct canque_ends_t)); + if(qends == NULL) return -ENOMEM; + memset(qends, 0, sizeof(struct canque_ends_t)); + obj->hostchip=hostchip; + obj->object=objnr+1; + obj->qends=qends; + obj->tx_qedge=NULL; + obj->tx_slot=NULL; + obj->obj_flags = 0x0; + + ret=canqueue_ends_init_chip(qends, hostchip, obj); + if(ret<0) return ret; + + ret=candev->hwspecops->init_obj_data(hostchip,objnr); + if(ret<0) return ret; -int init_hwspecops(struct candevice_t *candev) -{ - #ifdef ENABLE_CARD_template - if (!strcmp(candev->hwname,"template")) { - template_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pip - if (!strcmp(candev->hwname,"pip5")) { - pip5_register(candev->hwspecops); - } - else if (!strcmp(candev->hwname,"pip6")) { - pip6_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_smartcan - if (!strcmp(candev->hwname,"smartcan")) { - smartcan_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_nsi - if (!strcmp(candev->hwname,"nsican")) { - nsi_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_cc_can104 - if (!strcmp(candev->hwname,"cc104")) { - cc104_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_aim104 - if (!strcmp(candev->hwname,"aim104")) { - aim104_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pc_i03 - if (!strcmp(candev->hwname,"pc-i03")) { - pci03_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pcm3680 - if (!strcmp(candev->hwname,"pcm3680")) { - pcm3680_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pccan - if (!strcmp(candev->hwname,"pccan-f") | - !strcmp(candev->hwname,"pccan-s") ) { - pccanf_register(candev->hwspecops); - } - if (!strcmp(candev->hwname,"pccan-d")) { - pccand_register(candev->hwspecops); - } - if (!strcmp(candev->hwname,"pccan-q")) { - pccanq_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_m437 - if (!strcmp(candev->hwname,"m437")) { - m437_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pcccan - if (!strcmp(candev->hwname,"pcccan")) { - pcccan_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_ssv - if (!strcmp(candev->hwname,"ssv")) { - ssv_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_bfadcan - if (!strcmp(candev->hwname,"bfadcan")) { - bfadcan_register(candev->hwspecops); - } - #endif - #ifdef ENABLE_CARD_pikronisa - if (!strcmp(candev->hwname,"pikronisa")) { - pikronisa_register(candev->hwspecops); - } - #endif return 0; } -int init_chipspecops(struct candevice_t *candev, int chipnr) + +/** + * init_hwspecops - finds and initializes board/device specific operations + * @candev: pointer to the corresponding CAN device/board + * @irqnum_p: optional pointer to the number of interrupts required by board + * + * The function searches board @hwname in the list of supported boards types. + * The board type specific board_register() function is used to initialize + * @hwspecops operations. + * + * Return Value: returns negative number in the case of fail + */ +int init_hwspecops(struct candevice_t *candev, int *irqnum_p) { - candev->chip[chipnr]->max_objects=0; - - if (!strcmp(candev->chip[chipnr]->chip_type,"i82527")) { - candev->chip[chipnr]->max_objects=15; - i82527_register(candev->chip[chipnr]->chipspecops); - } - if (!strcmp(candev->chip[chipnr]->chip_type,"sja1000")) { - candev->chip[chipnr]->max_objects=1; - sja1000_register(candev->chip[chipnr]->chipspecops); - } - if (!strcmp(candev->chip[chipnr]->chip_type,"sja1000p")) { - candev->chip[chipnr]->max_objects=1; - sja1000p_register(candev->chip[chipnr]->chipspecops); + const struct boardtype_t *brp; + + brp = boardtype_find(candev->hwname); + + if(!brp) { + CANMSG("Sorry, hardware \"%s\" is currently not supported.\n",candev->hwname); + return -EINVAL; } + if(irqnum_p) + *irqnum_p=brp->irqnum; + brp->board_register(candev->hwspecops); + return 0; }