spi support
[protos/xbee-avr.git] / cirbuf_align.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_align.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 static inline void
28 __cirbuf_shift_left(struct cirbuf * cbuf)
29 {
30         cirbuf_uint i;
31         char tmp = cbuf->buf[cbuf->start];
32
33         for (i=0 ; i<cbuf->len ; i++) {
34                 cbuf->buf[(cbuf->start+i)%cbuf->maxlen] = 
35                         cbuf->buf[(cbuf->start+i+1)%cbuf->maxlen];
36         }
37         cbuf->buf[(cbuf->start-1+cbuf->maxlen)%cbuf->maxlen] = tmp;
38         cbuf->start += (cbuf->maxlen - 1);
39         cbuf->start %= cbuf->maxlen;
40         cbuf->end += (cbuf->maxlen - 1);
41         cbuf->end %= cbuf->maxlen;
42 }
43
44 static inline void
45 __cirbuf_shift_right(struct cirbuf * cbuf)
46 {
47         cirbuf_uint i;
48         char tmp = cbuf->buf[cbuf->end];
49
50         for (i=0 ; i<cbuf->len ; i++) {
51                 cbuf->buf[(cbuf->end+cbuf->maxlen-i)%cbuf->maxlen] = 
52                         cbuf->buf[(cbuf->end+cbuf->maxlen-i-1)%cbuf->maxlen];
53         }
54         cbuf->buf[(cbuf->end+1)%cbuf->maxlen] = tmp;
55         cbuf->start += 1;
56         cbuf->start %= cbuf->maxlen;
57         cbuf->end += 1;
58         cbuf->end %= cbuf->maxlen;
59 }
60
61 /* XXX we could do a better algorithm here... */
62 void cirbuf_align_left(struct cirbuf * cbuf)
63 {
64         if (cbuf->start < cbuf->maxlen/2) {
65                 while (cbuf->start != 0) {
66                         __cirbuf_shift_left(cbuf);
67                 }
68         }
69         else {
70                 while (cbuf->start != 0) {
71                         __cirbuf_shift_right(cbuf);
72                 }
73         }
74 }
75
76 /* XXX we could do a better algorithm here... */
77 void cirbuf_align_right(struct cirbuf * cbuf)
78 {
79         if (cbuf->start >= cbuf->maxlen/2) {
80                 while (cbuf->end != cbuf->maxlen-1) {
81                         __cirbuf_shift_left(cbuf);
82                 }
83         }
84         else {
85                 while (cbuf->start != cbuf->maxlen-1) {
86                         __cirbuf_shift_right(cbuf);
87                 }
88         }
89 }
90