X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/b34a548a5dfd2f0b068fd835a4cd51680d851068..2f13c6dc170fc5a887dcea791e73e1a695e9055d:/lincan/src/can_devrtl.c

diff --git a/lincan/src/can_devrtl.c b/lincan/src/can_devrtl.c
index 182eb42..c570f1b 100644
--- a/lincan/src/can_devrtl.c
+++ b/lincan/src/can_devrtl.c
@@ -3,7 +3,7 @@
  * 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
  */
 
 #ifdef CAN_WITH_RTL
@@ -16,12 +16,21 @@
 
 #include <rtl_malloc.h>
 
+#ifdef CAN_ENABLE_VME_SUPPORT
+#include "ca91c042.h"
+/* Modified version of ca91c042 driver can be found in
+ * components/comm/contrib directory. */
+#endif
+
+can_spinlock_t can_irq_manipulation_lock;
+
 unsigned int can_rtl_isr( unsigned int irq_num, struct pt_regs *r )
 {
 	struct chip_t *chip;
 	struct candevice_t *candev;
 	int board_nr;
 	int chip_nr;
+	int irq2linux=0;
 	pthread_t thread=NULL;
 
 	DEBUGMSG("can_rtl_isr invoked for irq %d\n",irq_num);
@@ -37,14 +46,16 @@ unsigned int can_rtl_isr( unsigned int irq_num, struct pt_regs *r )
 
 			set_bit(MSGOBJ_IRQ_REQUEST_b,&chip->pend_flags);
 			set_bit(MSGOBJ_WORKER_WAKE_b,&chip->pend_flags);
-			
+			if(chip->flags & CHIP_IRQ_PCI)
+				irq2linux=1;
 			if(!chip->worker_thread) continue;
 			thread=chip->worker_thread;
 			pthread_kill(thread,RTL_SIGNAL_WAKEUP);
 		}
 	}
 
-	/*rtl_global_pend_irq(irq_num);*/
+	if(irq2linux)
+		rtl_global_pend_irq(irq_num);
 
 	/*if(thread) rtl_reschedule_thread(thread);*/
 
@@ -97,7 +108,7 @@ void * can_chip_worker_thread(void *arg)
 			DEBUGMSG("IRQ_REQUEST processing ...\n");
 			loop_cnt = 100;
 			if(chip->chipspecops->irq_handler) do{
-				ret=chip->chipspecops->irq_handler(chip->chip_irq,chip,NULL);
+				ret=chip->chipspecops->irq_handler(chip->chip_irq,chip);
 			}while(ret && --loop_cnt);
 			continue;
 		}
@@ -106,18 +117,27 @@ void * can_chip_worker_thread(void *arg)
 			for(i=0;i<chip->max_objects;i++){
 				if((obj=chip->msgobj[i])==NULL)
 					continue;
-				if(!can_msgobj_test_and_clear_fl(obj,TX_REQUEST))
-					continue;
-				DEBUGMSG("Calling wakeup_tx\n");
-				chip->chipspecops->wakeup_tx(chip, obj);
+				if(can_msgobj_test_fl(obj,TX_REQUEST)) {
+					DEBUGMSG("Calling wakeup_tx\n");
+					chip->chipspecops->wakeup_tx(chip, obj);
+				}
+				if(can_msgobj_test_fl(obj,FILTCH_REQUEST)) {
+					DEBUGMSG("Calling filtch_rq\n");
+					if(chip->chipspecops->filtch_rq)
+						chip->chipspecops->filtch_rq(chip, obj);
+				}
 			}
 			continue;
 		}
 
 		/*re-enable chip IRQ, I am not sure, if this is required,
 		  but it seems to not work without that */
-		if(chip->chip_irq>=0)
-			can_enable_irq(chip->chip_irq);
+		if(chip->chip_irq>=0) {
+			if ((chip->flags & CHIP_IRQ_VME) == 0) can_enable_irq(chip->chip_irq);
+			else tundra_rtl_enable_pci_irq(); 
+			/* FIXME: Bad practice. Doesn't work with more
+			 * than one card. */
+		}
 
 		RTL_MARK_SUSPENDED(pthread_self());
 		if(test_and_clear_bit(MSGOBJ_WORKER_WAKE_b,&chip->pend_flags)){
@@ -134,18 +154,38 @@ void * can_chip_worker_thread(void *arg)
 int can_chip_setup_irq(struct chip_t *chip)
 {
 	int ret;
+        struct sched_param sched_param;
+        pthread_attr_t attrib;
+	pthread_attr_t *attrib_p=NULL;
 	
 	if(chip==NULL)
 		return -1;
+	
+	if(can_rtl_priority>=0){
+		pthread_attr_init(&attrib);
+		sched_param.sched_priority = can_rtl_priority;
+		pthread_attr_setschedparam(&attrib, &sched_param);
+		/* pthread_attr_setschedpolicy(&attrib, SCHED_FIFO); */
+		attrib_p=&attrib;
+	}
+	
 	if(chip->chipspecops->irq_handler){
-		if (rtl_request_irq(chip->chip_irq,can_rtl_isr))
+		int (*my_request_irq)(unsigned int vector, unsigned int (*rtl_handler)(unsigned int irq, struct pt_regs *regs));
+#ifdef CAN_ENABLE_VME_SUPPORT
+		if ((chip->flags & CHIP_IRQ_VME) != 0)
+			my_request_irq = rtl_request_vmeirq;
+		else
+#endif
+			my_request_irq = rtl_request_irq;
+
+		if (my_request_irq(chip->chip_irq,can_rtl_isr))
 			return -1;
 		else {
 			DEBUGMSG("Registered interrupt %d\n",chip->chip_irq);
 			chip->flags |= CHIP_IRQ_SETUP;
 		}
 	}
-        ret=pthread_create(&chip->worker_thread, NULL, can_chip_worker_thread, chip);
+        ret=pthread_create(&chip->worker_thread, attrib_p, can_chip_worker_thread, chip);
 	if(ret<0) chip->worker_thread=NULL;
 	
 	return ret;
@@ -157,7 +197,14 @@ void can_chip_free_irq(struct chip_t *chip)
 	if(chip->worker_thread)
 		pthread_delete_np(chip->worker_thread);
 	if((chip->flags & CHIP_IRQ_SETUP) && (chip->chip_irq>=0)) {
-		rtl_free_irq(chip->chip_irq);
+		int (*my_free_irq)(unsigned int vector);
+#ifdef CAN_ENABLE_VME_SUPPORT
+		if ((chip->flags & CHIP_IRQ_VME) != 0)
+			my_free_irq = rtl_free_vmeirq;
+		else
+#endif
+			my_free_irq = rtl_free_irq;
+		my_free_irq(chip->chip_irq);
 		chip->flags &= ~CHIP_IRQ_SETUP;
 	}
 }