fix bootloader for atm2560
[protos/xbee-avr.git] / cirbuf_add_head.c
1 /*  
2  *  Copyright Droids Corporation (2007)
3  *  Olivier MATZ <zer0@droids-corp.org>
4  * 
5  *  This program is free software; you can redistribute it and/or modify
6  *  it under the terms of the GNU General Public License as published by
7  *  the Free Software Foundation; either version 2 of the License, or
8  *  (at your option) any later version.
9  *
10  *  This program is distributed in the hope that it will be useful,
11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  *  GNU General Public License for more details.
14  *
15  *  You should have received a copy of the GNU General Public License
16  *  along with this program; if not, write to the Free Software
17  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
18  *
19  *  Revision : $Id: cirbuf_add_head.c,v 1.1.2.2 2007-09-12 17:52:20 zer0 Exp $
20  *
21  */
22
23 #include <string.h>
24
25 #include <cirbuf.h>
26
27
28 /* add at head */
29
30 static inline void 
31 __cirbuf_add_head(struct cirbuf * cbuf, char c)
32 {
33         if (!CIRBUF_IS_EMPTY(cbuf)) {
34                 cbuf->start += (cbuf->maxlen - 1);
35                 cbuf->start %= cbuf->maxlen;
36         }
37         cbuf->buf[cbuf->start] = c;
38         cbuf->len ++;
39 }
40
41 cirbuf_int 
42 cirbuf_add_head_safe(struct cirbuf * cbuf, char c)
43 {
44         if (cbuf && !CIRBUF_IS_FULL(cbuf)) {
45                 __cirbuf_add_head(cbuf, c);     
46                 return 0;
47         }
48         return -EINVAL;
49 }
50
51 void
52 cirbuf_add_head(struct cirbuf * cbuf, char c)
53 {
54         __cirbuf_add_head(cbuf, c);     
55 }
56