00001 /* 00002 * Copyright (C) 2001-2003 by egnite Software GmbH. All rights reserved. 00003 * 00004 * Redistribution and use in source and binary forms, with or without 00005 * modification, are permitted provided that the following conditions 00006 * are met: 00007 * 00008 * 1. Redistributions of source code must retain the above copyright 00009 * notice, this list of conditions and the following disclaimer. 00010 * 2. Redistributions in binary form must reproduce the above copyright 00011 * notice, this list of conditions and the following disclaimer in the 00012 * documentation and/or other materials provided with the distribution. 00013 * 3. Neither the name of the copyright holders nor the names of 00014 * contributors may be used to endorse or promote products derived 00015 * from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY EGNITE SOFTWARE GMBH AND CONTRIBUTORS 00018 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00019 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00020 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL EGNITE 00021 * SOFTWARE GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00022 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00023 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 00024 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 00025 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 00026 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 00027 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00028 * SUCH DAMAGE. 00029 * 00030 * For additional information see http://www.ethernut.de/ 00031 * 00032 * - 00033 * Portions Copyright (C) 2000 David J. Hudson <dave@humbug.demon.co.uk> 00034 * 00035 * This file is distributed in the hope that it will be useful, but WITHOUT 00036 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 00037 * FITNESS FOR A PARTICULAR PURPOSE. 00038 * 00039 * You can redistribute this file and/or modify it under the terms of the GNU 00040 * General Public License (GPL) as published by the Free Software Foundation; 00041 * either version 2 of the License, or (at your discretion) any later version. 00042 * See the accompanying file "copying-gpl.txt" for more details. 00043 * 00044 * As a special exception to the GPL, permission is granted for additional 00045 * uses of the text contained in this file. See the accompanying file 00046 * "copying-liquorice.txt" for details. 00047 * - 00048 * Portions Copyright (c) 1983, 1993 by 00049 * The Regents of the University of California. All rights reserved. 00050 * 00051 * Redistribution and use in source and binary forms, with or without 00052 * modification, are permitted provided that the following conditions 00053 * are met: 00054 * 1. Redistributions of source code must retain the above copyright 00055 * notice, this list of conditions and the following disclaimer. 00056 * 2. Redistributions in binary form must reproduce the above copyright 00057 * notice, this list of conditions and the following disclaimer in the 00058 * documentation and/or other materials provided with the distribution. 00059 * 3. Neither the name of the University nor the names of its contributors 00060 * may be used to endorse or promote products derived from this software 00061 * without specific prior written permission. 00062 * 00063 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 00064 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00065 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00066 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 00067 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 00068 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 00069 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 00070 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00071 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 00072 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00073 * SUCH DAMAGE. 00074 * - 00075 * Portions Copyright (c) 1993 by Digital Equipment Corporation. 00076 * 00077 * Permission to use, copy, modify, and distribute this software for any 00078 * purpose with or without fee is hereby granted, provided that the above 00079 * copyright notice and this permission notice appear in all copies, and that 00080 * the name of Digital Equipment Corporation not be used in advertising or 00081 * publicity pertaining to distribution of the document or software without 00082 * specific, written prior permission. 00083 * 00084 * THE SOFTWARE IS PROVIDED "AS IS" AND DIGITAL EQUIPMENT CORP. DISCLAIMS ALL 00085 * WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES 00086 * OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL DIGITAL EQUIPMENT 00087 * CORPORATION BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 00088 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR 00089 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS 00090 * ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS 00091 * SOFTWARE. 00092 */ 00093 00094 /* 00095 * $Log: netbuf.c,v $ 00096 * Revision 1.4 2008/04/18 13:31:59 haraldkipp 00097 * Changed size parameter from u_short to int, which is easier to handle 00098 * for 32-bit targets. You need to recompile your ARM code. No impact on 00099 * AVR expected 00100 * I changed u_int to int at some places to avoid some warnings during 00101 * compilation of Nut/Net. 00102 * libs. 00103 * 00104 * Revision 1.3 2005/04/30 16:42:41 chaac 00105 * Fixed bug in handling of NUTDEBUG. Added include for cfg/os.h. If NUTDEBUG 00106 * is defined in NutConf, it will make effect where it is used. 00107 * 00108 * Revision 1.2 2004/01/16 07:51:43 drsung 00109 * Bugfix for reallocating smaller network buffers. Thx to Mike Cornelius. 00110 * 00111 * Revision 1.1.1.1 2003/05/09 14:40:46 haraldkipp 00112 * Initial using 3.2.1 00113 * 00114 * Revision 1.12 2003/03/31 14:53:07 harald 00115 * Prepare release 3.1 00116 * 00117 * Revision 1.11 2003/02/04 17:50:54 harald 00118 * Version 3 released 00119 * 00120 * Revision 1.10 2002/06/26 17:29:08 harald 00121 * First pre-release with 2.4 stack 00122 * 00123 */ 00124 00125 #include <cfg/os.h> 00126 #include <string.h> 00127 00128 #include <sys/heap.h> 00129 #include <dev/netbuf.h> 00130 00131 #ifdef NUTDEBUG 00132 #include <sys/osdebug.h> 00133 #endif 00134 00139 00140 static int NutNetBufAllocData(NBDATA * nbd, int size) 00141 { 00142 if ((nbd->vp = NutHeapAlloc(size)) == 0) { 00143 nbd->sz = 0; 00144 return -1; 00145 } 00146 nbd->sz = size; 00147 return 0; 00148 } 00149 00150 static void NutNetBufFreeData(NBDATA * nbd) 00151 { 00152 NutHeapFree(nbd->vp); 00153 nbd->vp = 0; 00154 nbd->sz = 0; 00155 } 00156 00176 NETBUF *NutNetBufAlloc(NETBUF * nb, u_char type, int size) 00177 { 00178 if (nb == 0) { 00179 nb = NutHeapAllocClear(sizeof(NETBUF)); 00180 } 00181 00182 if (nb && type) { 00183 if (size) { 00184 if (type & NBAF_DATALINK) { 00185 if (nb->nb_flags & NBAF_DATALINK) { 00186 if (nb->nb_dl.sz < size) { 00187 NutNetBufFreeData(&nb->nb_dl); 00188 if (NutNetBufAllocData(&nb->nb_dl, size)) { 00189 NutNetBufFree(nb); 00190 return 0; 00191 } 00192 } else 00193 nb->nb_dl.sz = size; 00194 } else if (NutNetBufAllocData(&nb->nb_dl, size)) { 00195 NutNetBufFree(nb); 00196 return 0; 00197 } 00198 } 00199 00200 if (type & NBAF_NETWORK) { 00201 if (nb->nb_flags & NBAF_NETWORK) { 00202 if (nb->nb_nw.sz < size) { 00203 NutNetBufFreeData(&nb->nb_nw); 00204 if (NutNetBufAllocData(&nb->nb_nw, size)) { 00205 NutNetBufFree(nb); 00206 return 0; 00207 } 00208 } else 00209 nb->nb_nw.sz = size; 00210 } else if (NutNetBufAllocData(&nb->nb_nw, size)) { 00211 NutNetBufFree(nb); 00212 return 0; 00213 } 00214 } 00215 00216 if (type & NBAF_TRANSPORT) { 00217 if (nb->nb_flags & NBAF_TRANSPORT) { 00218 if (nb->nb_tp.sz < size) { 00219 NutNetBufFreeData(&nb->nb_tp); 00220 if (NutNetBufAllocData(&nb->nb_tp, size)) { 00221 NutNetBufFree(nb); 00222 return 0; 00223 } 00224 } else 00225 nb->nb_tp.sz = size; 00226 } else if (NutNetBufAllocData(&nb->nb_tp, size)) { 00227 NutNetBufFree(nb); 00228 return 0; 00229 } 00230 } 00231 00232 if (type & NBAF_APPLICATION) { 00233 if (nb->nb_flags & NBAF_APPLICATION) { 00234 if (nb->nb_ap.sz < size) { 00235 NutNetBufFreeData(&nb->nb_ap); 00236 if (NutNetBufAllocData(&nb->nb_ap, size)) { 00237 NutNetBufFree(nb); 00238 return 0; 00239 } 00240 } else 00241 nb->nb_ap.sz = size; 00242 } else if (NutNetBufAllocData(&nb->nb_ap, size)) { 00243 NutNetBufFree(nb); 00244 return 0; 00245 } 00246 } 00247 nb->nb_flags |= type; 00248 } else { 00249 type &= nb->nb_flags; 00250 if (type & NBAF_DATALINK) 00251 NutNetBufFreeData(&nb->nb_dl); 00252 if (type & NBAF_NETWORK) 00253 NutNetBufFreeData(&nb->nb_nw); 00254 if (type & NBAF_TRANSPORT) 00255 NutNetBufFreeData(&nb->nb_tp); 00256 if (type & NBAF_APPLICATION) 00257 NutNetBufFreeData(&nb->nb_ap); 00258 nb->nb_flags &= ~type; 00259 } 00260 } 00261 return nb; 00262 } 00263 00274 NETBUF *NutNetBufClone(NETBUF * nb) 00275 { 00276 NETBUF *clone; 00277 00278 if ((clone = NutHeapAllocClear(sizeof(NETBUF))) == 0) 00279 return 0; 00280 00281 if (nb->nb_dl.sz) { 00282 if (NutNetBufAllocData(&clone->nb_dl, nb->nb_dl.sz)) { 00283 NutNetBufFree(clone); 00284 return 0; 00285 } 00286 memcpy(clone->nb_dl.vp, nb->nb_dl.vp, nb->nb_dl.sz); 00287 clone->nb_flags |= NBAF_DATALINK; 00288 } 00289 if (nb->nb_nw.sz) { 00290 if (NutNetBufAllocData(&clone->nb_nw, nb->nb_nw.sz)) { 00291 NutNetBufFree(clone); 00292 return 0; 00293 } 00294 memcpy(clone->nb_nw.vp, nb->nb_nw.vp, nb->nb_nw.sz); 00295 clone->nb_flags |= NBAF_NETWORK; 00296 } 00297 if (nb->nb_tp.sz) { 00298 if (NutNetBufAllocData(&clone->nb_tp, nb->nb_tp.sz)) { 00299 NutNetBufFree(clone); 00300 return 0; 00301 } 00302 memcpy(clone->nb_tp.vp, nb->nb_tp.vp, nb->nb_tp.sz); 00303 clone->nb_flags |= NBAF_TRANSPORT; 00304 } 00305 if (nb->nb_ap.sz) { 00306 if (NutNetBufAllocData(&clone->nb_ap, nb->nb_ap.sz)) { 00307 NutNetBufFree(clone); 00308 return 0; 00309 } 00310 memcpy(clone->nb_ap.vp, nb->nb_ap.vp, nb->nb_ap.sz); 00311 clone->nb_flags |= NBAF_APPLICATION; 00312 } 00313 return clone; 00314 } 00315 00329 int NutNetBufFree(NETBUF * nb) 00330 { 00331 if(nb) { 00332 NutNetBufAlloc(nb, nb->nb_flags, 0); 00333 if (NutHeapFree(nb)) { 00334 return -1; 00335 } 00336 } 00337 return 0; 00338 } 00339