X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/dd8f5100e766813dca62a82c6b99ebf3648f2448..a682f9de48bcce43fba6141fbdb4d451914e0bb4:/lincan/src/setup.c

diff --git a/lincan/src/setup.c b/lincan/src/setup.c
index 75ca0ef..9c4af76 100644
--- a/lincan/src/setup.c
+++ b/lincan/src/setup.c
@@ -4,7 +4,7 @@
  * 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"
@@ -14,15 +14,16 @@
 #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
@@ -215,6 +216,29 @@ int can_base_addr_fixup(struct candevice_t *candev, unsigned long new_base)
 	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
@@ -254,7 +278,7 @@ int register_obj_struct(struct msgobj_t *obj, int minorbase)
  *
  * 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;
@@ -379,7 +403,7 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
 
 	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);
@@ -419,23 +443,23 @@ int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
  * @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;
@@ -443,6 +467,7 @@ int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudr
 	chip->chipspecops=can_checked_malloc(sizeof(struct chipspecops_t));
 	if (chip->chipspecops==NULL)
 		return -ENOMEM;
+	memset(chip->chipspecops,0,sizeof(struct chipspecops_t));
 
 	chip->chip_idx=chipnr;
 	chip->hostdevice=candev;
@@ -450,9 +475,7 @@ int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudr
 	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++) {
@@ -475,7 +498,7 @@ int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudr
  *
  * 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;
@@ -543,55 +566,50 @@ int init_hwspecops(struct candevice_t *candev, int *irqnum_p)
 }
 
 
-/**
- * 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
- */
-int init_chipspecops(struct candevice_t *candev, int chipnr)
+#ifndef CAN_WITH_RTL
+
+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;
 }
@@ -601,11 +619,20 @@ int can_chip_setup_irq(struct chip_t *chip)
  * 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;
 	}
 }