netbuf.c

Go to the documentation of this file.
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 

© 2000-2007 by egnite Software GmbH - visit http://www.ethernut.de/