-/* setup.c
- * Linux CAN-bus device driver.
- * Written by Arnaud Westenberg email:arnaud@wanadoo.nl
- * This software is released under the GPL-License.
- * Version 0.7 6 Aug 2001
- */
-
-#define __NO_VERSION__
-#include <linux/module.h>
-
-#include <linux/autoconf.h>
-#if defined (CONFIG_MODVERSIONS) && !defined (MODVERSIONS)
-#define MODVERSIONS
-#endif
-
-#if defined (MODVERSIONS)
-#include <linux/modversions.h>
-#endif
-
-#include <linux/version.h>
-#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
-#include <linux/malloc.h>
-#else
-#include <linux/slab.h>
-#endif
-#include <linux/fs.h>
-
-#include ".supported_cards.h"
-
+/**************************************************************************/
+/* File: setup.c - CAN driver and chips setup code */
+/* */
+/* 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. */
+/**************************************************************************/
+
+#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(int card);
-int init_chip_struct(int card);
-int init_obj_struct(int card, int chip);
-int init_chipspecops(int card, 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
-
- mem_new=(struct mem_addr *)kmalloc(sizeof(struct mem_addr),GFP_KERNEL);
- if (mem_new == NULL) {
- CANMSG("Memory list error.\n");
- return -ENOMEM;
+ long offs;
+ int i, j;
+
+ offs=new_base-candev->dev_base_addr;
+ candev->dev_base_addr=new_base;
+ for(i=0;i<candev->nr_all_chips;i++){
+ candev->chip[i]->chip_base_addr += offs;
+ for(j=0;j<candev->chip[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;
+ 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;
+}
-#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;
+/**
+ * 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)
+{
+ 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;
}
-/* 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;
}
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)
{
- hardware_p->candevice[card]=(struct candevice_t *)kmalloc(sizeof(struct candevice_t),GFP_KERNEL);
- if (hardware_p->candevice[card]==NULL)
- return -ENOMEM;
- else
- if ( add_mem_to_list(hardware_p->candevice[card]) )
- return -ENOMEM;
+ int irq_param_idx=0;
+ int chan_param_idx=0;
- candevices_p[card]=hardware_p->candevice[card];
+ if ( (hw[devnr] != NULL) & (devnr < MAX_HW_CARDS) ) {
+ hardware_p->nr_boards++;
- hardware_p->candevice[card]->hwname=hw[card];
- hardware_p->candevice[card]->io_addr=io[card];
+ if (init_device_struct(devnr, &chan_param_idx, &irq_param_idx)) {
+ CANMSG("Error initializing candevice_t structures.\n");
+ return -ENODEV;
+ }
+ }
- hardware_p->candevice[card]->hwspecops=(struct hwspecops_t *)kmalloc(sizeof(struct hwspecops_t),GFP_KERNEL);
- if (hardware_p->candevice[card]->hwspecops==NULL)
+ 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;
+ 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(hardware_p->candevice[card]->hwspecops) )
- return -ENOMEM;
- if (init_hwspecops(card))
- return -ENODEV;
+ memset(candev, 0, sizeof(struct candevice_t));
- if (candevices_p[card]->hwspecops->init_hw_data(card))
- return -ENODEV;
+ hardware_p->candevice[card]=candev;
+ candev->candev_idx=card;
- if (init_chip_struct(card))
- return -ENODEV;
+ candev=candev;
- return 0;
-}
+ candev->hwname=hw[card];
+ candev->io_addr=io[card];
+ candev->dev_base_addr=io[card];
+ clock=clockfreq[card];
-/* The function init_chip_struct is used to initialize all chip_t structures
- * on one hardware board.
- */
-int init_chip_struct(int card)
-{
- static int irq_count=0;
- int i=0;
+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,10))
+ kref_init(&candev->refcount);
+#endif
+
+ candev->hwspecops=(struct hwspecops_t *)can_checked_malloc(sizeof(struct hwspecops_t));
+ if (candev->hwspecops==NULL)
+ goto error_nomem;
+
+ memset(candev->hwspecops, 0, sizeof(struct hwspecops_t));
+
+ if (init_hwspecops(candev, &irqnum))
+ goto error_nodev;
+
+ if (candev->hwspecops->init_hw_data(candev))
+ goto error_nodev;
/* Alocate and initialize the chip structures */
- for (i=0; i < candevices_p[card]->nr_82527_chips+candevices_p[card]->nr_sja1000_chips; i++) {
- candevices_p[card]->chip[i]=(struct chip_t *)kmalloc(sizeof(struct chip_t),GFP_KERNEL);
- if (candevices_p[card]->chip[i]==NULL)
- return -ENOMEM;
- else
- if ( add_mem_to_list(candevices_p[card]->chip[i]) )
- return -ENOMEM;
-
- candevices_p[card]->chip[i]->chipspecops=(struct chipspecops_t *)kmalloc(sizeof(struct chipspecops_t),GFP_KERNEL);
- if (candevices_p[card]->chip[i]->chipspecops==NULL)
- return -ENOMEM;
- else
- if ( add_mem_to_list(candevices_p[card]->chip[i]->chipspecops) )
- return -ENOMEM;
-
- chips_p[irq_count]=candevices_p[card]->chip[i];
- candevices_p[card]->chip[i]->hostdevice=candevices_p[card];
- candevices_p[card]->chip[i]->chip_irq=irq[irq_count];
- candevices_p[card]->chip[i]->flags=0x0;
-
- candevices_p[card]->hwspecops->init_chip_data(card,i);
-
- if (init_chipspecops(card,i))
- return -ENODEV;
+ for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
+
+ if(chipnr<irqnum)
+ irqsig=irq[*irq_param_idx_p+chipnr];
+
+ bd=baudrate[*chan_param_idx_p+chipnr];
+ if(!bd) bd=baudrate[0];
+
+ if ((ret=init_chip_struct(candev, chipnr, irqsig, bd*1000, clock*1000)))
+ goto error_chip;
+ }
+
- init_obj_struct(card, irq_count);
- irq_count++;
- }
+ for (chipnr=0; chipnr < candev->nr_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; objnr<chip->max_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;
+
}
-int init_obj_struct(int card, int chip)
+/**
+ * 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 chipnr, int irq, long baudrate, long clock)
{
- static int obj_count=0;
- int i=0,max_objects=0;
-
- if (!strcmp(chips_p[chip]->chip_type,"i82527"))
- max_objects=15;
- else
- max_objects=1;
- for (i=0; i<max_objects; i++) {
- chips_p[chip]->msgobj[i]=(struct msgobj_t *)kmalloc(sizeof(struct msgobj_t),GFP_KERNEL);
- if (chips_p[chip]->msgobj[i] == NULL)
- return -ENOMEM;
- else
- if ( add_mem_to_list(chips_p[chip]->msgobj[i]) )
- return -ENOMEM;
-
- chips_p[chip]->msgobj[i]->fifo=(struct canfifo_t *)kmalloc(sizeof(struct canfifo_t),GFP_KERNEL);
- if (chips_p[chip]->msgobj[i]->fifo == NULL)
- return -ENOMEM;
- else
- if ( add_mem_to_list(chips_p[chip]->msgobj[i]->fifo) )
- return -ENOMEM;
-
- if (minor[0] == -1) {
- objects_p[obj_count]=chips_p[chip]->msgobj[i];
- objects_p[obj_count]->hostchip=chips_p[chip];
- objects_p[obj_count]->object=i+1;
- objects_p[obj_count]->minor=obj_count;
- }
- else {
- objects_p[minor[chip]+i]=chips_p[chip]->msgobj[i];
- objects_p[minor[chip]+i]->hostchip=chips_p[chip];
- objects_p[minor[chip]+i]->object=i+1;
- objects_p[minor[chip]+i]->minor=minor[chip]+i;
- }
+ struct canchip_t *chip;
+ int objnr;
+ int ret;
+
+ 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));
- chips_p[chip]->msgobj[i]->flags = 0x0;
-
- candevices_p[card]->hwspecops->init_obj_data(chip,i);
+ chip->write_register=candev->hwspecops->write_register;
+ chip->read_register=candev->hwspecops->read_register;
+
+ chip->chipspecops=can_checked_malloc(sizeof(struct chipspecops_t));
+ if (chip->chipspecops==NULL)
+ return -ENOMEM;
+ memset(chip->chipspecops,0,sizeof(struct chipspecops_t));
- obj_count++;
+ 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; objnr<chip->max_objects; objnr++) {
+ ret=init_obj_struct(candev, chip, objnr);
+ if(ret<0) return ret;
}
+
return 0;
}
-int init_hwspecops(int card)
+/**
+ * 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)
{
- #ifdef ENABLE_CARD_template
- if (!strcmp(candevices_p[card]->hwname,"template")) {
- template_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pip
- if (!strcmp(candevices_p[card]->hwname,"pip5")) {
- pip5_register(candevices_p[card]->hwspecops);
- }
- else if (!strcmp(candevices_p[card]->hwname,"pip6")) {
- pip6_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_smartcan
- if (!strcmp(candevices_p[card]->hwname,"smartcan")) {
- smartcan_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_nsi
- if (!strcmp(candevices_p[card]->hwname,"nsican")) {
- nsi_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_cc_can104
- if (!strcmp(candevices_p[card]->hwname,"cc104")) {
- cc104_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_aim104
- if (!strcmp(candevices_p[card]->hwname,"aim104")) {
- aim104_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pc_i03
- if (!strcmp(candevices_p[card]->hwname,"pc-i03")) {
- pci03_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pcm3680
- if (!strcmp(candevices_p[card]->hwname,"pcm3680")) {
- pcm3680_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pccan
- if (!strcmp(candevices_p[card]->hwname,"pccan-f") |
- !strcmp(candevices_p[card]->hwname,"pccan-s") ) {
- pccanf_register(candevices_p[card]->hwspecops);
- }
- if (!strcmp(candevices_p[card]->hwname,"pccan-d")) {
- pccand_register(candevices_p[card]->hwspecops);
- }
- if (!strcmp(candevices_p[card]->hwname,"pccan-q")) {
- pccanq_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_m437
- if (!strcmp(candevices_p[card]->hwname,"m437")) {
- m437_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pcccan
- if (!strcmp(candevices_p[card]->hwname,"pcccan")) {
- pcccan_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_ssv
- if (!strcmp(candevices_p[card]->hwname,"ssv")) {
- ssv_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_bfadcan
- if (!strcmp(candevices_p[card]->hwname,"bfadcan")) {
- bfadcan_register(candevices_p[card]->hwspecops);
- }
- #endif
- #ifdef ENABLE_CARD_pikronisa
- if (!strcmp(candevices_p[card]->hwname,"pikronisa")) {
- pikronisa_register(candevices_p[card]->hwspecops);
- }
- #endif
+ struct canque_ends_t *qends;
+ struct msgobj_t *obj;
+ int ret;
+
+ 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;
+
return 0;
}
-int init_chipspecops(int card, 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)
{
- if (!strcmp(candevices_p[card]->chip[chipnr]->chip_type,"i82527")) {
- i82527_register(candevices_p[card]->chip[chipnr]->chipspecops);
- }
- if (!strcmp(candevices_p[card]->chip[chipnr]->chip_type,"sja1000")) {
- sja1000_register(candevices_p[card]->chip[chipnr]->chipspecops);
- }
- if (!strcmp(candevices_p[card]->chip[chipnr]->chip_type,"sja1000p")) {
- sja1000p_register(candevices_p[card]->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;
}