quadramp issues -- not really fixed
[aversive.git] / modules / base / cirbuf / cirbuf_get_buf_tail.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_tail.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
30 cirbuf_int
31 cirbuf_get_buf_tail(struct cirbuf * cbuf, char * c, cirbuf_uint size)
32 {
33         cirbuf_uint n = (size < CIRBUF_GET_LEN(cbuf)) ? size : CIRBUF_GET_LEN(cbuf);
34
35         if (!n)
36                 return 0;
37
38         if (cbuf->start <= cbuf->end) {
39                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->end - n + 1, 0, n);
40                 memcpy(c, cbuf->buf + cbuf->end - n + 1, n);
41         }
42         else {
43                 dprintf("s[%d] -> d[%d] (%d)\n", 0,  cbuf->maxlen - cbuf->start, cbuf->end + 1);
44                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->maxlen - n + cbuf->end + 1, 0, n - cbuf->end - 1);
45
46                 memcpy(c + cbuf->maxlen - cbuf->start, cbuf->buf, cbuf->end + 1);
47                 memcpy(c, cbuf->buf + cbuf->maxlen - n + cbuf->end +1, n - cbuf->end - 1);
48         }
49         return n;
50 }
51