More canqueue locking changes.

[lincan.git] / lincan / include / can_queue.h

diff --git a/lincan/include/can_queue.h b/lincan/include/can_queue.h
index 107074c8c83e6ab3b1925390eaf4f833e823d49d..5ed1fe41fc31f5ab30a62ef10810e7ee8828e7e7 100644 (file)
--- a/lincan/include/can_queue.h
+++ b/lincan/include/can_queue.h
@@ -1,3 +1,11 @@
+/* can_queue.h - CAN queues and message passing infrastructure 
+ * Linux CAN-bus device driver.
+ * Written by Pavel Pisa - OCERA team member
+ * email:pisa@cmp.felk.cvut.cz
+ * This software is released under the GPL-License.
+ * Version lincan-0.3  17 Jun 2004
+ */
+
 #ifndef _CAN_QUEUE_H
 #define _CAN_QUEUE_H
 
@@ -445,7 +453,8 @@ void canque_notify_bothends(struct canque_edge_t *qedge, int what)
  * @inends: input side of the edge
  *
  * Function call moves output side of the edge from idle onto active edges
- * list.
+ * list. This function has to be called with edge reference count held.
+ * that is same as for most of other edge functions.
  */
 static inline
 void canque_activate_edge(struct canque_ends_t *inends, struct canque_edge_t *qedge)
@@ -454,19 +463,16 @@ void canque_activate_edge(struct canque_ends_t *inends, struct canque_edge_t *qe
        struct canque_ends_t *outends;
        if(qedge->edge_prio>=CANQUEUE_PRIO_NR)
                qedge->edge_prio=CANQUEUE_PRIO_NR-1;
-       can_spin_lock_irqsave(&inends->ends_lock, flags);
        if((outends=qedge->outends)){
-               can_spin_lock(&outends->ends_lock);
+               can_spin_lock_irqsave(&outends->ends_lock, flags);
                can_spin_lock(&qedge->fifo.fifo_lock);
                if(!canque_fifo_test_fl(&qedge->fifo,EMPTY)){
                        list_del(&qedge->activepeers);
                        list_add_tail(&qedge->activepeers,&outends->active[qedge->edge_prio]);
                }
                can_spin_unlock(&qedge->fifo.fifo_lock);
-               can_spin_unlock(&outends->ends_lock);
-
+               can_spin_unlock_irqrestore(&outends->ends_lock, flags);
        }
-       can_spin_unlock_irqrestore(&inends->ends_lock, flags);
 }
 
 /**
@@ -535,8 +541,12 @@ int canqueue_ends_flush_outlist(struct canque_ends_t *qends);
 
 /* edge reference and traversal functions */
 
-void canque_edge_do_dead(struct canque_edge_t *edge, int dead_fl);
+void canque_edge_do_dead(struct canque_edge_t *edge);
 
+/**
+ * canque_edge_incref - increments edge reference count
+ * @qedg: pointer to the edge structure
+ */
 static inline
 void canque_edge_incref(struct canque_edge_t *edge)
 {
@@ -544,28 +554,81 @@ void canque_edge_incref(struct canque_edge_t *edge)
 }
 
 static inline
-void canque_edge_decref(struct canque_edge_t *edge)
+can_spin_irqflags_t canque_edge_lock_both_ends(struct canque_ends_t *inends, struct canque_ends_t *outends)
+{
+       can_spin_irqflags_t  flags;
+       if(inends<outends) {
+               can_spin_lock_irqsave(&inends->ends_lock, flags);
+               can_spin_lock(&outends->ends_lock);
+       }else{
+               can_spin_lock_irqsave(&outends->ends_lock, flags);
+               if(outends!=inends) can_spin_lock(&inends->ends_lock);
+       }
+       return flags;   
+}
+
+static inline
+void canque_edge_unlock_both_ends(struct canque_ends_t *inends, struct canque_ends_t *outends, can_spin_irqflags_t flags)
+{
+       if(outends!=inends) can_spin_unlock(&outends->ends_lock);
+       can_spin_unlock_irqrestore(&inends->ends_lock, flags);
+}
+
+/* Non-inlined version of edge reference decrement */
+void __canque_edge_decref(struct canque_edge_t *edge);
+
+static inline
+void __canque_edge_decref_body(struct canque_edge_t *edge)
 {
        can_spin_irqflags_t flags;
+       int dead_fl=0;
        struct canque_ends_t *inends=edge->inends;
        struct canque_ends_t *outends=edge->outends;
-       int dead_fl;
        
-       can_spin_lock_irqsave(&inends->ends_lock, flags);
-       can_spin_lock(&outends->ends_lock);
+       flags=canque_edge_lock_both_ends(inends, outends);
        if(atomic_dec_and_test(&edge->edge_used)) {
-               dead_fl=canque_fifo_test_and_set_fl(&edge->fifo,DEAD);
+               dead_fl=!canque_fifo_test_and_set_fl(&edge->fifo,DEAD);
                /* Because of former evolution of edge references 
                   management notify of CANQUEUE_NOTIFY_NOUSR could
                   be moved to canque_edge_do_dead :-) */
-               can_spin_unlock(&outends->ends_lock);
-               can_spin_unlock_irqrestore(&inends->ends_lock, flags);
-               canque_edge_do_dead(edge, dead_fl);
-       } else {
-               can_spin_unlock(&outends->ends_lock);
-               can_spin_unlock_irqrestore(&inends->ends_lock, flags);
        }
+       canque_edge_unlock_both_ends(inends, outends, flags);
+       if(dead_fl) canque_edge_do_dead(edge);
+}
+
+#ifndef CAN_HAVE_ARCH_CMPXCHG
+/**
+ * canque_edge_decref - decrements edge reference count
+ * @qedg: pointer to the edge structure
+ *
+ * This function has to be called without lock held for both ends of edge.
+ * If reference count drops to 0, function canque_edge_do_dead()
+ * is called.
+ */
+static inline
+void canque_edge_decref(struct canque_edge_t *edge)
+{
+       __canque_edge_decref_body(edge);
+}
+#else
+static inline
+void canque_edge_decref(struct canque_edge_t *edge)
+{
+       int x, y;
+       
+        x = atomic_read(&edge->edge_used);
+        do{
+               if(x<=1)
+                       return __canque_edge_decref(edge);
+               y=x;
+               /* This code strongly depends on the definition of atomic_t !!!! */
+               /* x=cmpxchg(&edge->edge_used, x, x-1); */
+               /* Next alternative could be more portable */
+               x=__cmpxchg(&edge->edge_used, x, x-1, sizeof(atomic_t));
+               /* If even this does not help, comment out CAN_HAVE_ARCH_CMPXCHG in can_sysdep.h */
+       } while(x!=y);
 }
+#endif
 
 static inline
 struct canque_edge_t *canque_first_inedge(struct canque_ends_t *qends)