update ldscript
[protos/xbee-avr.git] / cirbuf_get_buf_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_get_buf_head.c,v 1.1.2.3 2007-09-12 17:52:20 zer0 Exp $
20  *
21  */
22
23 #include <string.h>
24
25 #include <cirbuf.h>
26
27 /* convert to buffer */
28
29 cirbuf_int
30 cirbuf_get_buf_head(struct cirbuf * cbuf, char * c, cirbuf_uint size)
31 {
32         cirbuf_uint n = (size < CIRBUF_GET_LEN(cbuf)) ? size : CIRBUF_GET_LEN(cbuf);
33         
34         if (!n)
35                 return 0;
36
37         if (cbuf->start <= cbuf->end) {
38                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->start, 0, n);
39                 memcpy(c, cbuf->buf + cbuf->start , n);
40         }
41         else {
42                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->start, 0, cbuf->maxlen - cbuf->start);
43                 dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->maxlen - cbuf->start, n - cbuf->maxlen + cbuf->start);
44                 memcpy(c, cbuf->buf + cbuf->start , cbuf->maxlen - cbuf->start);
45                 memcpy(c + cbuf->maxlen - cbuf->start, cbuf->buf, n - cbuf->maxlen + cbuf->start);
46         }
47         return n;
48 }
49