X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/c759ac4ffabb78a8863d9bced695980077eeb319..21d8a0ab23ef9aa66557c7645c604887497f188a:/lincan/src/can_queue.c diff --git a/lincan/src/can_queue.c b/lincan/src/can_queue.c index d90b9c5..a1aa1df 100644 --- a/lincan/src/can_queue.c +++ b/lincan/src/can_queue.c @@ -1,17 +1,42 @@ -/* can_queue.c - CAN message queues - * Linux CAN-bus device driver. - * 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.3 17 Jun 2004 - */ +/**************************************************************************/ +/* File: can_queue.c - CAN message queues */ +/* */ +/* LinCAN - (Not only) Linux CAN bus driver */ +/* Copyright (C) 2002-2009 DCE FEE CTU Prague */ +/* Copyright (C) 2002-2009 Pavel Pisa */ +/* Funded by OCERA and FRESCOR IST projects */ +/* */ +/* LinCAN is free software; you can redistribute it and/or modify it */ +/* under terms of the GNU General Public License as published by the */ +/* Free Software Foundation; either version 2, or (at your option) any */ +/* later version. LinCAN is distributed in the hope that it will be */ +/* useful, but WITHOUT ANY WARRANTY; without even the implied warranty */ +/* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU */ +/* General Public License for more details. You should have received a */ +/* copy of the GNU General Public License along with LinCAN; see file */ +/* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave, */ +/* Cambridge, MA 02139, USA. */ +/* */ +/* To allow use of LinCAN in the compact embedded systems firmware */ +/* and RT-executives (RTEMS for example), main authors agree with next */ +/* special exception: */ +/* */ +/* Including LinCAN header files in a file, instantiating LinCAN generics */ +/* or templates, or linking other files with LinCAN objects to produce */ +/* an application image/executable, does not by itself cause the */ +/* resulting application image/executable to be covered by */ +/* the GNU General Public License. */ +/* This exception does not however invalidate any other reasons */ +/* why the executable file might be covered by the GNU Public License. */ +/* Publication of enhanced or derived LinCAN files is required although. */ +/**************************************************************************/ #include "../include/can.h" #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 @@ -119,7 +144,7 @@ int canque_get_inslot(struct canque_ends_t *qends, { int ret=-2; struct canque_edge_t *edge; - + edge=canque_first_inedge(qends); if(edge){ if(!canque_fifo_test_fl(&edge->fifo,BLOCK)){ @@ -161,7 +186,7 @@ int canque_get_inslot4id(struct canque_ends_t *qends, { 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; @@ -267,7 +292,7 @@ int canque_filter_msg2edges(struct canque_ends_t *qends, struct canmsg_t *msg) 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); @@ -312,7 +337,7 @@ int canque_test_outslot(struct canque_ends_t *qends, 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])){ @@ -434,13 +459,13 @@ int canque_set_filt(struct canque_edge_t *qedge, 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; @@ -451,7 +476,7 @@ int canque_set_filt(struct canque_edge_t *qedge, 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; @@ -561,10 +586,10 @@ int canqueue_disconnect_edge(struct canque_edge_t *qedge) } 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){ @@ -584,8 +609,8 @@ int canqueue_disconnect_edge(struct canque_edge_t *qedge) 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); @@ -594,7 +619,7 @@ int canqueue_disconnect_edge(struct canque_edge_t *qedge) /** - * 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) @@ -608,7 +633,7 @@ 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) @@ -633,7 +658,7 @@ 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){ @@ -661,7 +686,7 @@ int canqueue_ends_kill_inlist(struct canque_ends_t *qends, int 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); } @@ -693,10 +718,10 @@ int canqueue_ends_filt_conjuction(struct canque_ends_t *qends, struct canfilt_t 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; @@ -721,7 +746,7 @@ int canqueue_ends_filt_conjuction(struct canque_ends_t *qends, struct canfilt_t int canqueue_ends_flush_inlist(struct canque_ends_t *qends) { struct canque_edge_t *edge; - + canque_for_each_inedge(qends, edge){ canque_flush(edge); } @@ -738,7 +763,7 @@ int canqueue_ends_flush_inlist(struct canque_ends_t *qends) int canqueue_ends_flush_outlist(struct canque_ends_t *qends) { struct canque_edge_t *edge; - + canque_for_each_outedge(qends, edge){ canque_flush(edge); }