* email:pisa@cmp.felk.cvut.cz
* This software is released under the GPL-License.
* Version lincan-0.3 17 Jun 2004
- */
+ */
#include "../include/can.h"
#include "../include/can_sysdep.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);
+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
* 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++){
/**
* 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.
*/
if(boarddev == anydev)
return 1;
}
-
+
return 0;
}
*/
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)
{
static int next_chip_slot=0;
int i;
-
+
if(next_chip_slot>=MAX_TOT_CHIPS)
next_chip_slot=0;
i=next_chip_slot;
return 0;
}
+/**
+ * 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_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
* @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,
* 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
*/
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;
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)
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++) {
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++;
hardware_p->candevice[card]=NULL;
can_checked_free(candev);
return ret;
-
+
}
/**
* @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;
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)
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));
ret=candev->hwspecops->init_obj_data(hostchip,objnr);
if(ret<0) return ret;
-
+
return 0;
}
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);