cirbuf_add_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_add_buf_tail.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 /* multiple add */
  29
  30 cirbuf_int
  31 cirbuf_add_buf_tail(struct cirbuf * cbuf, const char * c, cirbuf_uint n)
  32 {
  33         cirbuf_uint e;
  34
  35         if (!n || n > CIRBUF_GET_FREELEN(cbuf))
  36                 return -EINVAL;
  37
  38         e = CIRBUF_IS_EMPTY(cbuf) ? 1 : 0;
  39
  40         if (n < cbuf->maxlen - cbuf->end - 1 + e) {
  41                 dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->end + !e, n);
  42                 memcpy(cbuf->buf + cbuf->end + !e, c, n);
  43         }
  44         else {
  45                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->end + !e, 0, cbuf->maxlen - cbuf->end - 1 + e);
  46                 dprintf("s[%d] -> d[%d] (%d)\n", cbuf->maxlen - cbuf->end - 1 + e, 0, n - cbuf->maxlen + cbuf->end + 1 - e);
  47                 memcpy(cbuf->buf + cbuf->end + !e, c, cbuf->maxlen - cbuf->end - 1 + e);
  48                 memcpy(cbuf->buf, c + cbuf->maxlen - cbuf->end - 1 + e, n - cbuf->maxlen + cbuf->end + 1 - e);
  49         }
  50         cbuf->len += n;
  51         cbuf->end += n - e;
  52         cbuf->end %= cbuf->maxlen;
  53         return n;
  54 }
  55