]> rtime.felk.cvut.cz Git - lincan.git/blobdiff - lincan/src/setup.c
Actual driver code for directly mapped SJA1000 into PCI mem region 0.
[lincan.git] / lincan / src / setup.c
index ac8378922880c0b9af287be4693ef4fa04accc1c..32f504814843310903894586799589abe9233252 100644 (file)
@@ -1,11 +1,36 @@
-/* setup.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.3  17 Jun 2004
- */ 
+/**************************************************************************/
+/* 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"
@@ -16,7 +41,7 @@
 
 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);
+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);
 
 /**
@@ -30,11 +55,11 @@ int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int
  * 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, unsigned long new_base)
+int can_base_addr_fixup(struct candevice_t *candev, can_ioptr_t new_base)
 {
-       unsigned long offs;
+       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++){
@@ -47,7 +72,7 @@ int can_base_addr_fixup(struct candevice_t *candev, unsigned long new_base)
 
 /**
  * can_check_dev_taken - checks if bus device description is already taken by driver
- * @anydev:    pointer to bus specific Linux device description 
+ * @anydev:    pointer to bus specific Linux device description
  *
  * Returns: Returns 1 if device is already used by LinCAN driver, 0 otherwise.
  */
@@ -64,7 +89,7 @@ int can_check_dev_taken(void *anydev)
                if(boarddev == anydev)
                        return 1;
        }
-       
+
        return 0;
 }
 
@@ -80,7 +105,7 @@ int register_obj_struct(struct msgobj_t *obj, int minorbase)
 {
        static int next_minor=0;
        int i;
-       
+
        if(minorbase>=0)
                next_minor=minorbase;
        if(next_minor>=MAX_TOT_MSGOBJS)
@@ -111,7 +136,7 @@ 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;
@@ -163,7 +188,7 @@ int init_hw_struct(void)
  * @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: 
+ * in the module parameters arrays:
  *     @hw[card] .. hardware type,
  *     @io[card] .. base IO address,
  *     @baudrate[chan_param_idx] .. per channel baudrate,
@@ -172,10 +197,10 @@ int init_hw_struct(void)
  * 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_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. 
+ * message objects are registered into global arrays.
  *
  * Return Value: returns negative number in the case of fail
  */
@@ -187,7 +212,8 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
        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;
@@ -202,6 +228,7 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
        candev->hwname=hw[card];
        candev->io_addr=io[card];
        candev->dev_base_addr=io[card];
+       clock=clockfreq[card];
 
        candev->hwspecops=(struct hwspecops_t *)can_checked_malloc(sizeof(struct hwspecops_t));
        if (candev->hwspecops==NULL)
@@ -220,14 +247,14 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
 
                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)))
+
+               if ((ret=init_chip_struct(candev, chipnr, irqsig, bd*1000, clock*1000)))
                        goto error_chip;
        }
-       
+
 
 
        for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
@@ -236,7 +263,7 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
                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++;
@@ -261,7 +288,7 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
        hardware_p->candevice[card]=NULL;
        can_checked_free(candev);
        return ret;
-       
+
 }
 
 /**
@@ -270,15 +297,16 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
  * @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 
+ * 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 
+ * 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)
+int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock)
 {
        struct canchip_t *chip;
        int objnr;
@@ -302,6 +330,7 @@ int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudr
        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)
@@ -335,7 +364,7 @@ int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int
 
        obj=(struct msgobj_t *)can_checked_malloc(sizeof(struct msgobj_t));
        hostchip->msgobj[objnr]=obj;
-       if (obj == NULL) 
+       if (obj == NULL)
                return -ENOMEM;
 
         memset(obj, 0, sizeof(struct msgobj_t));
@@ -360,7 +389,7 @@ int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int
 
        ret=candev->hwspecops->init_obj_data(hostchip,objnr);
        if(ret<0) return ret;
-       
+
        return 0;
 }
 
@@ -379,14 +408,14 @@ int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int
 int init_hwspecops(struct candevice_t *candev, int *irqnum_p)
 {
        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);