* 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
+ * Version lincan-0.3 17 Jun 2004
*/
#include "../include/can.h"
#include "../include/setup.h"
#include "../include/finish.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);
+#ifdef CAN_ENABLE_VME_SUPPORT
+#include "ca91c042.h"
+/* Modified version of ca91c042 driver can be found in
+ * components/comm/contrib directory. */
+#endif
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_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int objnr);
-int init_chipspecops(struct candevice_t *candev, int chipnr);
+int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr);
/**
* can_checked_malloc - memory allocation with registering of requested blocks
return 0;
}
+/**
+ * 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)
+{
+ 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;
+ }
+
+ return 0;
+}
+
/**
* register_obj_struct - registers message object into global array
*
* Return Value: returns negative number in the case of fail
*/
-int register_chip_struct(struct chip_t *chip, int minorbase)
+int register_chip_struct(struct canchip_t *chip, int minorbase)
{
static int next_chip_slot=0;
int i;
for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
int m=minor[*chan_param_idx_p+chipnr];
- struct chip_t *chip=candev->chip[chipnr];
+ struct canchip_t *chip=candev->chip[chipnr];
int objnr;
register_chip_struct(chip, m);
* @baudrate: baudrate in the units of 1Bd
*
* Chip structure is allocated and chip specific operations are filled by
- * call to board specific init_chip_data() function and generic
- * init_chipspecops() function. The message objects are generated 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)
{
- struct chip_t *chip;
+ struct canchip_t *chip;
int objnr;
int ret;
- candev->chip[chipnr]=(struct chip_t *)can_checked_malloc(sizeof(struct chip_t));
+ 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 chip_t));
+ memset(chip, 0, sizeof(struct canchip_t));
chip->write_register=candev->hwspecops->write_register;
chip->read_register=candev->hwspecops->read_register;
chip->baudrate=baudrate;
chip->flags=0x0;
- candev->hwspecops->init_chip_data(candev,chipnr);
-
- if (init_chipspecops(candev,chipnr))
+ if(candev->hwspecops->init_chip_data(candev,chipnr)<0)
return -ENODEV;
for (objnr=0; objnr<chip->max_objects; objnr++) {
*
* Return Value: returns negative number in the case of fail
*/
-int init_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int objnr)
+int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr)
{
struct canque_ends_t *qends;
struct msgobj_t *obj;
}
+#ifndef CAN_WITH_RTL
+
/**
- * init_chipspecops - fills chip specific operations for board for known chip types
- * @candev: pointer to the corresponding CAN device/board
- * @chipnr: index of the chip in the device/board structure
- *
- * The function fills chip specific operations for next known generic chip
- * types "i82527", "sja1000", "sja1000p" (PeliCAN). Other non generic chip types
- * operations has to be initialized in the board specific init_chip_data() function.
- *
- * Return Value: returns negative number in the case of fail
+ * can_default_irq_dispatch - the first level interrupt dispatch handler
+ * @irq: interrupt vector number, this value is system specific
+ * @dev_id: driver private pointer registered at time of request_irq() call.
+ * The CAN driver uses this pointer to store relationship of interrupt
+ * to chip state structure - @struct canchip_t
+ * @regs: system dependent value pointing to registers stored in exception frame
+ *
+ * File: src/setup.c
*/
-int init_chipspecops(struct candevice_t *candev, int chipnr)
+can_irqreturn_t can_default_irq_dispatch(int irq, void *dev_id, struct pt_regs *regs)
{
- 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);
- }
+ int retval;
+ struct canchip_t *chip=(struct canchip_t *)dev_id;
- return 0;
+ retval=chip->chipspecops->irq_handler(irq, chip);
+ return CAN_IRQ_RETVAL(retval);
}
-#ifndef CAN_WITH_RTL
-
/**
* can_chip_setup_irq - attaches chip to the system interrupt processing
* @chip: pointer to CAN chip structure
*
* Return Value: returns negative number in the case of fail
*/
-int can_chip_setup_irq(struct chip_t *chip)
+int can_chip_setup_irq(struct canchip_t *chip)
{
if(chip==NULL)
return -1;
if(!chip->chipspecops->irq_handler)
return 0;
+ if(chip->flags & CHIP_IRQ_CUSTOM)
+ return 1;
- if (request_irq(chip->chip_irq,chip->chipspecops->irq_handler,SA_SHIRQ,DEVICE_NAME,chip))
- return -1;
- else {
- DEBUGMSG("Registered interrupt %d\n",chip->chip_irq);
+ if ((chip->flags & CHIP_IRQ_VME) == 0) {
+ if (request_irq(chip->chip_irq,can_default_irq_dispatch,SA_SHIRQ,DEVICE_NAME,chip))
+ return -1;
+ else {
+ DEBUGMSG("Registered interrupt %d\n",chip->chip_irq);
+ chip->flags |= CHIP_IRQ_SETUP;
+ }
+ } else {
+#ifdef CAN_ENABLE_VME_SUPPORT
+ if (chip->chip_irq < 1 || chip->chip_irq > 255) {
+ CANMSG("Bad irq parameter. (1 <= irq <= 255).\n");
+ return -EINVAL;
+ }
+
+ request_vmeirq(chip->chip_irq, can_default_irq_dispatch, chip);
+ DEBUGMSG("Registered VME interrupt vector %d\n",chip->chip_irq);
chip->flags |= CHIP_IRQ_SETUP;
+#endif
}
return 1;
}
* can_chip_free_irq - unregisters chip interrupt handler from the system
* @chip: pointer to CAN chip structure
*/
-void can_chip_free_irq(struct chip_t *chip)
+void can_chip_free_irq(struct canchip_t *chip)
{
if((chip->flags & CHIP_IRQ_SETUP) && (chip->chip_irq>=0)) {
- free_irq(chip->chip_irq, chip);
- chip->flags &= ~CHIP_IRQ_SETUP;
+ if(chip->flags & CHIP_IRQ_CUSTOM)
+ return;
+
+ if ((chip->flags & CHIP_IRQ_VME) == 0)
+ free_irq(chip->chip_irq, chip);
+ else {
+#ifdef CAN_ENABLE_VME_SUPPORT
+ free_vmeirq(chip->chip_irq);
+#endif
+ }
+ chip->flags &= ~CHIP_IRQ_SETUP;
}
}