X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/b34a548a5dfd2f0b068fd835a4cd51680d851068..2827b727d2910a3b48f9de7d67b3a67f59e256c7:/lincan/src/devcommon.c

diff --git a/lincan/src/devcommon.c b/lincan/src/devcommon.c
index c0b6028..bf6585a 100644
--- a/lincan/src/devcommon.c
+++ b/lincan/src/devcommon.c
@@ -12,6 +12,38 @@
 #include "../include/main.h"
 #include "../include/devcommon.h"
 
+#ifdef CAN_WITH_RTL
+static inline
+void canqueue_wake_chip_worker(struct canque_ends_t *qends, struct chip_t *chip, struct msgobj_t *obj)
+{
+	if(qends->endinfo.chipinfo.worker_thread){
+		can_msgobj_set_fl(obj,WORKER_WAKE);
+		pthread_kill(qends->endinfo.chipinfo.worker_thread,RTL_SIGNAL_WAKEUP);
+		rtl_schedule();
+	} else {
+		set_bit(MSGOBJ_TX_REQUEST_b,&chip->pend_flags);
+		if(chip->worker_thread) {
+			set_bit(MSGOBJ_WORKER_WAKE_b,&chip->pend_flags);
+			pthread_kill(chip->worker_thread,RTL_SIGNAL_WAKEUP);
+			rtl_schedule();
+		}
+	}
+}
+
+#endif /*CAN_WITH_RTL*/
+
+
+/**
+ * canqueue_notify_chip - notification callback handler for CAN chips ends of queues
+ * @qends: pointer to the callback side ends structure
+ * @qedge: edge which invoked notification 
+ * @what: notification type
+ *
+ * This function has to deal with more possible cases. It can be called from
+ * the kernel or interrupt context for Linux only compilation of driver.
+ * The function can be called from kernel context or RT-Linux thread context
+ * for mixed mode Linux/RT-Linux compilation.
+ */
 void canqueue_notify_chip(struct canque_ends_t *qends, struct canque_edge_t *qedge, int what)
 {
 	struct chip_t *chip=qends->endinfo.chipinfo.chip;
@@ -30,19 +62,7 @@ void canqueue_notify_chip(struct canque_ends_t *qends, struct canque_edge_t *qed
 			chip->chipspecops->wakeup_tx(chip, obj);
 		    #else /*CAN_WITH_RTL*/
 			can_msgobj_set_fl(obj,TX_REQUEST);
-			if(qends->endinfo.chipinfo.worker_thread){
-				can_msgobj_set_fl(obj,WORKER_WAKE);
-				pthread_kill(qends->endinfo.chipinfo.worker_thread,RTL_SIGNAL_WAKEUP);
-				rtl_schedule();
-			} else {
-				set_bit(MSGOBJ_TX_REQUEST_b,&chip->pend_flags);
-
-				if(chip->worker_thread) {
-					set_bit(MSGOBJ_WORKER_WAKE_b,&chip->pend_flags);
-					pthread_kill(chip->worker_thread,RTL_SIGNAL_WAKEUP);
-					rtl_schedule();
-				}
-			}
+			canqueue_wake_chip_worker(qends, chip, obj);
 		    #endif /*CAN_WITH_RTL*/
 			break;
 		case CANQUEUE_NOTIFY_DEAD_WANTED:
@@ -51,11 +71,28 @@ void canqueue_notify_chip(struct canque_ends_t *qends, struct canque_edge_t *qed
 				canque_edge_decref(qedge);
 			break;
 		case CANQUEUE_NOTIFY_ATTACH:
+			break;
+		case CANQUEUE_NOTIFY_FILTCH:
+			if(!chip->chipspecops->filtch_rq)
+				break;
+		    #ifndef CAN_WITH_RTL
+			chip->chipspecops->filtch_rq(chip, obj);
+		    #else /*CAN_WITH_RTL*/
+			can_msgobj_set_fl(obj,FILTCH_REQUEST);
+			canqueue_wake_chip_worker(qends, chip, obj);
+		    #endif /*CAN_WITH_RTL*/
+			
 			break;
 	}
 }
 
 
+/**
+ * canqueue_ends_init_chip - CAN chip specific ends initialization
+ * @qends: pointer to the ends structure
+ * @chip: pointer to the corresponding CAN chip structure
+ * @obj: pointer to the corresponding message object structure
+ */
 int canqueue_ends_init_chip(struct canque_ends_t *qends, struct chip_t *chip, struct msgobj_t *obj)
 {
 	int ret;
@@ -75,6 +112,12 @@ int canqueue_ends_init_chip(struct canque_ends_t *qends, struct chip_t *chip, st
 }
 
 
+/**
+ * canqueue_ends_done_chip - finalizing of the ends structure for CAN chips
+ * @qends: pointer to ends structure
+ *
+ * Return Value: Function should be designed such way to not fail.
+ */
 int canqueue_ends_done_chip(struct canque_ends_t *qends)
 {
 	int delayed;