X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/258e4a224adc90317b3d11622a3076ba6d61b0d2..446346b22245a238d8d70390797b9749eac03788:/lincan/src/unican.c

diff --git a/lincan/src/unican.c b/lincan/src/unican.c
index 957d5af..df556d6 100644
--- a/lincan/src/unican.c
+++ b/lincan/src/unican.c
@@ -29,26 +29,14 @@ static void unican_delay(long msdelay)
 
 }
 
-
-long unican_bus_latency(struct msgobj_t *obj)
-{
-	long latency;
-	latency=obj->hostchip->baudrate;
-	if(latency){
-		latency=(long)HZ*1000/latency;
-	}
-	return latency;
-}
-
-
 /* * * unican Chip Functionality * * */
 
-int unican_enable_configuration(struct chip_t *chip)
+int unican_enable_configuration(struct canchip_t *chip)
 {
 	return 0;
 }
 
-int unican_disable_configuration(struct chip_t *chip)
+int unican_disable_configuration(struct canchip_t *chip)
 {
 	return 0;
 }
@@ -60,7 +48,7 @@ int unican_disable_configuration(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_chip_config(struct chip_t *chip)
+int unican_chip_config(struct canchip_t *chip)
 {
 	int ret;
 	sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data;
@@ -125,7 +113,7 @@ int unican_chip_config(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_extended_mask(struct chip_t *chip, unsigned long code, unsigned  long mask)
+int unican_extended_mask(struct canchip_t *chip, unsigned long code, unsigned  long mask)
 {
 	return 0;
 }
@@ -142,7 +130,7 @@ int unican_extended_mask(struct chip_t *chip, unsigned long code, unsigned  long
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_baud_rate(struct chip_t *chip, int rate, int clock, int sjw,
+int unican_baud_rate(struct canchip_t *chip, int rate, int clock, int sjw,
 							int sampl_pt, int flags)
 {
 	int ret;
@@ -184,7 +172,7 @@ int unican_baud_rate(struct chip_t *chip, int rate, int clock, int sjw,
  *
  * File: src/unican.c
  */
-void unican_read(struct chip_t *chip, struct msgobj_t *obj) {
+void unican_read(struct canchip_t *chip, struct msgobj_t *obj) {
 	sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data;
 	__u16 *ptr16;
 	__u16 u;
@@ -259,7 +247,7 @@ void unican_read(struct chip_t *chip, struct msgobj_t *obj) {
  *	Positive value indicates immediate reception of message.
  * File: src/unican.c
  */
-int unican_pre_read_config(struct chip_t *chip, struct msgobj_t *obj)
+int unican_pre_read_config(struct canchip_t *chip, struct msgobj_t *obj)
 {
 	return 0;
 }
@@ -274,7 +262,7 @@ int unican_pre_read_config(struct chip_t *chip, struct msgobj_t *obj)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_pre_write_config(struct chip_t *chip, struct msgobj_t *obj, 
+int unican_pre_write_config(struct canchip_t *chip, struct msgobj_t *obj, 
 							struct canmsg_t *msg)
 {
 	return 0;
@@ -291,7 +279,7 @@ int unican_pre_write_config(struct chip_t *chip, struct msgobj_t *obj,
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_send_msg(struct chip_t *chip, struct msgobj_t *obj, 
+int unican_send_msg(struct canchip_t *chip, struct msgobj_t *obj, 
 							struct canmsg_t *msg)
 {
 	return 0;
@@ -306,7 +294,7 @@ int unican_send_msg(struct chip_t *chip, struct msgobj_t *obj,
  *	Zero value indicates finishing of all issued transmission requests.
  * File: src/unican.c
  */
-int unican_check_tx_stat(struct chip_t *chip)
+int unican_check_tx_stat(struct canchip_t *chip)
 {
 	return 0;
 }
@@ -320,7 +308,7 @@ int unican_check_tx_stat(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_set_btregs(struct chip_t *chip, unsigned short btr0, 
+int unican_set_btregs(struct canchip_t *chip, unsigned short btr0, 
 							unsigned short btr1)
 {
 	int ret;
@@ -342,7 +330,7 @@ int unican_set_btregs(struct chip_t *chip, unsigned short btr0,
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_start_chip(struct chip_t *chip)
+int unican_start_chip(struct canchip_t *chip)
 {
 	return 0;
 }
@@ -354,7 +342,7 @@ int unican_start_chip(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_stop_chip(struct chip_t *chip)
+int unican_stop_chip(struct canchip_t *chip)
 {
 	return 0;
 }
@@ -368,7 +356,7 @@ int unican_stop_chip(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_remote_request(struct chip_t *chip, struct msgobj_t *obj)
+int unican_remote_request(struct canchip_t *chip, struct msgobj_t *obj)
 {
 	CANMSG("unican_remote_request not implemented\n");
 	return -ENOSYS;
@@ -383,7 +371,7 @@ int unican_remote_request(struct chip_t *chip, struct msgobj_t *obj)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_standard_mask(struct chip_t *chip, unsigned short code,
+int unican_standard_mask(struct canchip_t *chip, unsigned short code,
 		unsigned short mask)
 {
 	CANMSG("unican_standard_mask not implemented\n");
@@ -397,7 +385,7 @@ int unican_standard_mask(struct chip_t *chip, unsigned short code,
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_clear_objects(struct chip_t *chip)
+int unican_clear_objects(struct canchip_t *chip)
 {
 	CANMSG("unican_clear_objects not implemented\n");
 	return -ENOSYS;
@@ -411,7 +399,7 @@ int unican_clear_objects(struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_config_irqs(struct chip_t *chip, short irqs)
+int unican_config_irqs(struct canchip_t *chip, short irqs)
 {
 
 	CANMSG("unican_config_irqs not implemented\n");
@@ -429,7 +417,7 @@ int unican_config_irqs(struct chip_t *chip, short irqs)
  * unican_irq_write_handler() for transmit events.
  * File: src/unican.c
  */
-void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj)
+void unican_irq_write_handler(struct canchip_t *chip, struct msgobj_t *obj)
 {
 	int cmd;
 	sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data;
@@ -531,7 +519,7 @@ void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj)
 
 }
 
-void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj)
+void unican_irq_sync_activities(struct canchip_t *chip, struct msgobj_t *obj)
 {
 	while(!can_msgobj_test_and_set_fl(obj,TX_LOCK)) {
 
@@ -558,10 +546,7 @@ void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj)
 /**
  * unican_irq_handler: - interrupt service routine
  * @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 chip_t
- * @regs: system dependent value pointing to registers stored in exception frame
+ * @chip: pointer to chip state structure
  * 
  * Interrupt handler is activated when state of CAN controller chip changes,
  * there is message to be read or there is more space for new messages or
@@ -570,7 +555,7 @@ void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj)
  * message queues.
  * File: src/unican.c
  */
-int unican_irq_handler(int irq, struct chip_t *chip)
+int unican_irq_handler(int irq, struct canchip_t *chip)
 {
 	sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data;
 	struct msgobj_t *obj=chip->msgobj[0];
@@ -582,8 +567,13 @@ int unican_irq_handler(int irq, struct chip_t *chip)
 		return CANCHIP_IRQ_NONE;
 	}
 
-	if (cl2_get_status(chipext, &status) == CL2_NO_REQUEST)
+	if (cl2_get_status(chipext, &status) == CL2_NO_REQUEST) {
+		/* Reenable interrupts generation, this has to be even there, 
+		 * because irq_accept disables interrupts
+		 */
+		cl2_gen_interrupt(chipext);
 		return CANCHIP_IRQ_NONE;
+	}
 
 	cl2_clear_interrupt(chipext);
 
@@ -606,12 +596,31 @@ int unican_irq_handler(int irq, struct chip_t *chip)
 		unican_read(chip, obj);
 	}
 
+	/* Reenable interrupts generation */
 	cl2_gen_interrupt(chipext);
 
 	return CANCHIP_IRQ_HANDLED;
 }
 
 
+/**
+ * unican_irq_accept: - fast irq accept routine, blocks further interrupts
+ * @irq: interrupt vector number, this value is system specific
+ * @chip: pointer to chip state structure
+ * 
+ * This routine only accepts interrupt reception and stops further
+ * incoming interrupts, but does not handle situation causing interrupt.
+ * File: src/unican.c
+ */
+int unican_irq_accept(int irq, struct canchip_t *chip)
+{
+	sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data;
+
+	cl2_clear_interrupt(chipext);
+
+	return CANCHIP_IRQ_ACCEPTED;
+}
+
 /*void unican_do_tx_timeout(unsigned long data)
 {
 	struct msgobj_t *obj=(struct msgobj_t *)data;
@@ -626,7 +635,7 @@ int unican_irq_handler(int irq, struct chip_t *chip)
  * Return Value: negative value reports error.
  * File: src/unican.c
  */
-int unican_wakeup_tx(struct chip_t *chip, struct msgobj_t *obj)
+int unican_wakeup_tx(struct canchip_t *chip, struct msgobj_t *obj)
 {
 	can_preempt_disable();
 
@@ -697,7 +706,7 @@ int unican_reset(struct candevice_t *candev)
 {
 	int ret;
 	int i;
-	struct chip_t *chip = candev->chip[0];
+	struct canchip_t *chip = candev->chip[0];
 	sCAN_CARD *chipext;
 	
 
@@ -768,7 +777,7 @@ int unican_init_hw_data(struct candevice_t *candev)
  */
 int unican_init_chip_data(struct candevice_t *candev, int chipnr)
 {
-	struct chip_t *chip = candev->chip[chipnr];
+	struct canchip_t *chip = candev->chip[chipnr];
 	chip->chip_type = "unican";
 	chip->chip_base_addr = 0;
 	chip->clock = 10000000;
@@ -797,6 +806,7 @@ int unican_init_chip_data(struct candevice_t *candev, int chipnr)
 	chip->chipspecops->start_chip=unican_start_chip;
 	chip->chipspecops->stop_chip=unican_stop_chip;
 	chip->chipspecops->irq_handler=unican_irq_handler;
+	chip->chipspecops->irq_accept=unican_irq_accept;
 
 	return 0;
 }
@@ -809,7 +819,7 @@ int unican_init_chip_data(struct candevice_t *candev, int chipnr)
  * Return Value: The function always returns zero
  * File: src/unican.c
  */
-int unican_init_obj_data(struct chip_t *chip, int objnr)
+int unican_init_obj_data(struct canchip_t *chip, int objnr)
 {
 	struct msgobj_t *obj=chip->msgobj[objnr];
 	obj->obj_base_addr=chip->chip_base_addr;