#include "../include/can_sysdep.h"
#include "../include/can_queue.h"
-/*
- * Modifies Tx message processing
+/*
+ * Modifies Tx message processing
* 0 .. local message processing disabled
* 1 .. local messages disabled by default but can be enabled by canque_set_filt
* 2 .. local messages enabled by default, can be disabled by canque_set_filt
{
int ret=-2;
struct canque_edge_t *edge;
-
+
edge=canque_first_inedge(qends);
if(edge){
if(!canque_fifo_test_fl(&edge->fifo,BLOCK)){
{
int ret=-2;
struct canque_edge_t *edge, *bestedge=NULL;
-
+
canque_for_each_inedge(qends, edge){
if(canque_fifo_test_fl(&edge->fifo,BLOCK))
continue;
unsigned long msgid;
struct canque_edge_t *edge;
struct canque_slot_t *slot;
-
+
DEBUGQUE("canque_filter_msg2edges for msg ID 0x%08lx and flags 0x%02x\n",
msg->id, msg->flags);
msgid = canque_filtid2internal(msg->id, msg->flags);
int prio;
struct canque_edge_t *edge;
int ret;
-
+
can_spin_lock_irqsave(&qends->ends_lock, flags);
for(prio=CANQUEUE_PRIO_NR;--prio>=0;){
while(!list_empty(&qends->active[prio])){
can_spin_irqflags_t flags;
can_spin_lock_irqsave(&qedge->fifo.fifo_lock,flags);
-
+
if(!(filtflags&MSG_PROCESSLOCAL) && (processlocal<2))
filtflags |= MSG_LOCAL_MASK;
-
+
qedge->filtid=canque_filtid2internal(filtid, filtflags);
qedge->filtmask=canque_filtid2internal(filtmask, filtflags>>MSG_FILT_MASK_SHIFT);
-
+
if(canque_fifo_test_fl(&qedge->fifo,DEAD)) ret=-1;
else ret=canque_fifo_test_and_set_fl(&qedge->fifo,BLOCK)?1:0;
can_spin_lock_irqsave(&qedge->fifo.fifo_lock,flags);
if(!ret) canque_fifo_clear_fl(&qedge->fifo,BLOCK);
can_spin_unlock_irqrestore(&qedge->fifo.fifo_lock,flags);
-
+
DEBUGQUE("canque_set_filt for edge %d, ID %ld, mask %ld, flags %d returned %d\n",
qedge->edge_num,filtid,filtmask,filtflags,ret);
return ret;
} else {
DEBUGQUE("canqueue_disconnect_edge called with not fully connected edge");
if(inends) can_spin_lock_irqsave(&inends->ends_lock,flags);
- if(outends) can_spin_lock(&outends->ends_lock);
- flags=0;
+ else if(outends) can_spin_lock_irqsave(&outends->ends_lock,flags);
+ else flags=0;
}
-
+
can_spin_lock(&qedge->fifo.fifo_lock);
if(atomic_read(&qedge->edge_used)==0) {
if(qedge->outends){
if(inends && outends) {
canque_edge_unlock_both_ends(inends, outends, flags);
} else {
- if(outends) can_spin_unlock(&outends->ends_lock);
if(inends) can_spin_unlock_irqrestore(&inends->ends_lock,flags);
+ else if(outends) can_spin_unlock_irqrestore(&outends->ends_lock,flags);
}
DEBUGQUE("canqueue_disconnect_edge %d returned %d\n",qedge->edge_num,ret);
/**
- * canqueue_block_inlist - block slot allocation of all outgoing edges of specified ends
+ * canqueue_block_inlist - block slot allocation of all outgoing edges of specified ends
* @qends: pointer to ends structure
*/
void canqueue_block_inlist(struct canque_ends_t *qends)
/**
- * canqueue_block_outlist - block slot allocation of all incoming edges of specified ends
+ * canqueue_block_outlist - block slot allocation of all incoming edges of specified ends
* @qends: pointer to ends structure
*/
void canqueue_block_outlist(struct canque_ends_t *qends)
int canqueue_ends_kill_inlist(struct canque_ends_t *qends, int send_rest)
{
struct canque_edge_t *edge;
-
+
canque_for_each_inedge(qends, edge){
canque_notify_bothends(edge, CANQUEUE_NOTIFY_DEAD_WANTED);
if(send_rest){
int canqueue_ends_kill_outlist(struct canque_ends_t *qends)
{
struct canque_edge_t *edge;
-
+
canque_for_each_outedge(qends, edge){
canque_notify_bothends(edge, CANQUEUE_NOTIFY_DEAD_WANTED);
}
filtid = edge->filtid;
else
filtmask &= ~(filtid ^ edge->filtid);
-
+
filtmask &= edge->filtmask;
}
-
+
filt->id = filtid & MSG_ID_MASK;
filt->mask = filtmask & MSG_ID_MASK;
filtid >>= 28;
int canqueue_ends_flush_inlist(struct canque_ends_t *qends)
{
struct canque_edge_t *edge;
-
+
canque_for_each_inedge(qends, edge){
canque_flush(edge);
}
int canqueue_ends_flush_outlist(struct canque_ends_t *qends)
{
struct canque_edge_t *edge;
-
+
canque_for_each_outedge(qends, edge){
canque_flush(edge);
}