X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/99d090e67281ec1e9d61054afced20c9a76124b3..HEAD:/lincan/src/setup.c diff --git a/lincan/src/setup.c b/lincan/src/setup.c index ac83789..32f5048 100644 --- a/lincan/src/setup.c +++ b/lincan/src/setup.c @@ -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 */ +/* Copyright (C) 2002-2009 Pavel Pisa */ +/* Funded by OCERA and FRESCOR IST projects */ +/* Based on CAN driver code by Arnaud Westenberg */ +/* */ +/* 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;inr_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(chipnrnr_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; objnrmax_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);