[s3c24xx] ar6000: use net_device_ops
[openwrt/svn-archive/archive.git] / target / linux / s3c24xx / files-2.6.30 / drivers / ar6000 / ar6000 / netbuf.c
1
2 /*
3 *
4 * Copyright (c) 2004-2007 Atheros Communications Inc.
5 * All rights reserved.
6 *
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation;
11 *
12 * Software distributed under the License is distributed on an "AS
13 * IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
14 * implied. See the License for the specific language governing
15 * rights and limitations under the License.
16 *
17 *
18 *
19 */
20 #include <linux/kernel.h>
21 #include <linux/skbuff.h>
22 #include <a_config.h>
23 #include "athdefs.h"
24 #include "a_types.h"
25 #include "a_osapi.h"
26 #include "htc_packet.h"
27
28 #define AR6000_DATA_OFFSET 64
29
30 void a_netbuf_enqueue(A_NETBUF_QUEUE_T *q, void *pkt)
31 {
32 skb_queue_tail((struct sk_buff_head *) q, (struct sk_buff *) pkt);
33 }
34
35 void a_netbuf_prequeue(A_NETBUF_QUEUE_T *q, void *pkt)
36 {
37 skb_queue_head((struct sk_buff_head *) q, (struct sk_buff *) pkt);
38 }
39
40 void *a_netbuf_dequeue(A_NETBUF_QUEUE_T *q)
41 {
42 return((void *) skb_dequeue((struct sk_buff_head *) q));
43 }
44
45 int a_netbuf_queue_size(A_NETBUF_QUEUE_T *q)
46 {
47 return(skb_queue_len((struct sk_buff_head *) q));
48 }
49
50 int a_netbuf_queue_empty(A_NETBUF_QUEUE_T *q)
51 {
52 return(skb_queue_empty((struct sk_buff_head *) q));
53 }
54
55 void a_netbuf_queue_init(A_NETBUF_QUEUE_T *q)
56 {
57 skb_queue_head_init((struct sk_buff_head *) q);
58 }
59
60 void *
61 a_netbuf_alloc(int size)
62 {
63 struct sk_buff *skb;
64 skb = dev_alloc_skb(AR6000_DATA_OFFSET + sizeof(HTC_PACKET) + size);
65 skb_reserve(skb, AR6000_DATA_OFFSET + sizeof(HTC_PACKET));
66 return ((void *)skb);
67 }
68
69 /*
70 * Allocate an SKB w.o. any encapsulation requirement.
71 */
72 void *
73 a_netbuf_alloc_raw(int size)
74 {
75 struct sk_buff *skb;
76
77 skb = dev_alloc_skb(size);
78
79 return ((void *)skb);
80 }
81
82 void
83 a_netbuf_free(void *bufPtr)
84 {
85 struct sk_buff *skb = (struct sk_buff *)bufPtr;
86
87 dev_kfree_skb(skb);
88 }
89
90 A_UINT32
91 a_netbuf_to_len(void *bufPtr)
92 {
93 return (((struct sk_buff *)bufPtr)->len);
94 }
95
96 void *
97 a_netbuf_to_data(void *bufPtr)
98 {
99 return (((struct sk_buff *)bufPtr)->data);
100 }
101
102 /*
103 * Add len # of bytes to the beginning of the network buffer
104 * pointed to by bufPtr
105 */
106 A_STATUS
107 a_netbuf_push(void *bufPtr, A_INT32 len)
108 {
109 skb_push((struct sk_buff *)bufPtr, len);
110
111 return A_OK;
112 }
113
114 /*
115 * Add len # of bytes to the beginning of the network buffer
116 * pointed to by bufPtr and also fill with data
117 */
118 A_STATUS
119 a_netbuf_push_data(void *bufPtr, char *srcPtr, A_INT32 len)
120 {
121 skb_push((struct sk_buff *) bufPtr, len);
122 A_MEMCPY(((struct sk_buff *)bufPtr)->data, srcPtr, len);
123
124 return A_OK;
125 }
126
127 /*
128 * Add len # of bytes to the end of the network buffer
129 * pointed to by bufPtr
130 */
131 A_STATUS
132 a_netbuf_put(void *bufPtr, A_INT32 len)
133 {
134 skb_put((struct sk_buff *)bufPtr, len);
135
136 return A_OK;
137 }
138
139 /*
140 * Add len # of bytes to the end of the network buffer
141 * pointed to by bufPtr and also fill with data
142 */
143 A_STATUS
144 a_netbuf_put_data(void *bufPtr, char *srcPtr, A_INT32 len)
145 {
146 char *start = ((struct sk_buff *)bufPtr)->data +
147 ((struct sk_buff *)bufPtr)->len;
148 skb_put((struct sk_buff *)bufPtr, len);
149 A_MEMCPY(start, srcPtr, len);
150
151 return A_OK;
152 }
153
154
155 /*
156 * Trim the network buffer pointed to by bufPtr to len # of bytes
157 */
158 A_STATUS
159 a_netbuf_setlen(void *bufPtr, A_INT32 len)
160 {
161 skb_trim((struct sk_buff *)bufPtr, len);
162
163 return A_OK;
164 }
165
166 /*
167 * Chop of len # of bytes from the end of the buffer.
168 */
169 A_STATUS
170 a_netbuf_trim(void *bufPtr, A_INT32 len)
171 {
172 skb_trim((struct sk_buff *)bufPtr, ((struct sk_buff *)bufPtr)->len - len);
173
174 return A_OK;
175 }
176
177 /*
178 * Chop of len # of bytes from the end of the buffer and return the data.
179 */
180 A_STATUS
181 a_netbuf_trim_data(void *bufPtr, char *dstPtr, A_INT32 len)
182 {
183 char *start = ((struct sk_buff *)bufPtr)->data +
184 (((struct sk_buff *)bufPtr)->len - len);
185
186 A_MEMCPY(dstPtr, start, len);
187 skb_trim((struct sk_buff *)bufPtr, ((struct sk_buff *)bufPtr)->len - len);
188
189 return A_OK;
190 }
191
192
193 /*
194 * Returns the number of bytes available to a a_netbuf_push()
195 */
196 A_INT32
197 a_netbuf_headroom(void *bufPtr)
198 {
199 return (skb_headroom((struct sk_buff *)bufPtr));
200 }
201
202 /*
203 * Removes specified number of bytes from the beginning of the buffer
204 */
205 A_STATUS
206 a_netbuf_pull(void *bufPtr, A_INT32 len)
207 {
208 skb_pull((struct sk_buff *)bufPtr, len);
209
210 return A_OK;
211 }
212
213 /*
214 * Removes specified number of bytes from the beginning of the buffer
215 * and return the data
216 */
217 A_STATUS
218 a_netbuf_pull_data(void *bufPtr, char *dstPtr, A_INT32 len)
219 {
220 A_MEMCPY(dstPtr, ((struct sk_buff *)bufPtr)->data, len);
221 skb_pull((struct sk_buff *)bufPtr, len);
222
223 return A_OK;
224 }
225