git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/lwIP_MCF5235_GCC/lwip/src/netif/slipif.c

   1 /*\r
   2  * Copyright (c) 2001-2004 Swedish Institute of Computer Science.\r
   3  * All rights reserved. \r
   4  *\r
   5  * Redistribution and use in source and binary forms, with or without \r
   6  * modification, are permitted provided that the following conditions \r
   7  * are met: \r
   8  * 1. Redistributions of source code must retain the above copyright \r
   9  *    notice, this list of conditions and the following disclaimer. \r
  10  * 2. Redistributions in binary form must reproduce the above copyright \r
  11  *    notice, this list of conditions and the following disclaimer in the \r
  12  *    documentation and/or other materials provided with the distribution. \r
  13  * 3. Neither the name of the Institute nor the names of its contributors \r
  14  *    may be used to endorse or promote products derived from this software \r
  15  *    without specific prior written permission. \r
  16  *\r
  17  * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND \r
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE \r
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE \r
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE \r
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL \r
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS \r
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) \r
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT \r
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY \r
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF \r
  27  * SUCH DAMAGE. \r
  28  *\r
  29  * This file is built upon the file: src/arch/rtxc/netif/sioslip.c\r
  30  *\r
  31  * Author: Magnus Ivarsson <magnus.ivarsson(at)volvo.com> \r
  32  */\r
  33 \r
  34 /* \r
  35  * This is an arch independent SLIP netif. The specific serial hooks must be\r
  36  * provided by another file. They are sio_open, sio_recv and sio_send\r
  37  */\r
  38 \r
  39 #include "netif/slipif.h"\r
  40 #include "lwip/opt.h"\r
  41 #include "lwip/def.h"\r
  42 #include "lwip/pbuf.h"\r
  43 #include "lwip/sys.h"\r
  44 #include "lwip/stats.h"\r
  45 #include "lwip/sio.h"\r
  46 \r
  47 #define SLIP_END     0300\r
  48 #define SLIP_ESC     0333\r
  49 #define SLIP_ESC_END 0334\r
  50 #define SLIP_ESC_ESC 0335\r
  51 \r
  52 #define MAX_SIZE     1500\r
  53 \r
  54 /**\r
  55  * Send a pbuf doing the necessary SLIP encapsulation\r
  56  *\r
  57  * Uses the serial layer's sio_send() \r
  58  */\r
  59 err_t\r
  60 slipif_output(struct netif *netif, struct pbuf *p, struct ip_addr *ipaddr)\r
  61 {\r
  62   struct pbuf *q;\r
  63   u16_t i;\r
  64   u8_t c;\r
  65 \r
  66   /* Send pbuf out on the serial I/O device. */\r
  67   sio_send(SLIP_END, netif->state);\r
  68 \r
  69   for (q = p; q != NULL; q = q->next) {\r
  70     for (i = 0; i < q->len; i++) {\r
  71       c = ((u8_t *)q->payload)[i];\r
  72       switch (c) {\r
  73       case SLIP_END:\r
  74         sio_send(SLIP_ESC, netif->state);\r
  75         sio_send(SLIP_ESC_END, netif->state);\r
  76         break;\r
  77       case SLIP_ESC:\r
  78         sio_send(SLIP_ESC, netif->state);\r
  79         sio_send(SLIP_ESC_ESC, netif->state);\r
  80         break;\r
  81       default:\r
  82         sio_send(c, netif->state);\r
  83         break;\r
  84       }\r
  85     }\r
  86   }\r
  87   sio_send(SLIP_END, netif->state);\r
  88   return 0;\r
  89 }\r
  90 \r
  91 /**\r
  92  * Handle the incoming SLIP stream character by character\r
  93  *\r
  94  * Poll the serial layer by calling sio_recv()\r
  95  * \r
  96  * @return The IP packet when SLIP_END is received \r
  97  */\r
  98 static struct pbuf *\r
  99 slipif_input(struct netif *netif)\r
 100 {\r
 101   u8_t c;\r
 102   struct pbuf *p, *q;\r
 103   u16_t recved;\r
 104   u16_t i;\r
 105 \r
 106   q = p = NULL;\r
 107   recved = i = 0;\r
 108   c = 0;\r
 109 \r
 110   while (1) {\r
 111     c = sio_recv(netif->state);\r
 112     switch (c) {\r
 113     case SLIP_END:\r
 114       if (recved > 0) {\r
 115         /* Received whole packet. */\r
 116         pbuf_realloc(q, recved);\r
 117         \r
 118         LINK_STATS_INC(link.recv);\r
 119         \r
 120         LWIP_DEBUGF(SLIP_DEBUG, ("slipif: Got packet\n"));\r
 121         return q;\r
 122       }\r
 123       break;\r
 124 \r
 125     case SLIP_ESC:\r
 126       c = sio_recv(netif->state);\r
 127       switch (c) {\r
 128       case SLIP_ESC_END:\r
 129         c = SLIP_END;\r
 130         break;\r
 131       case SLIP_ESC_ESC:\r
 132         c = SLIP_ESC;\r
 133         break;\r
 134       }\r
 135       /* FALLTHROUGH */\r
 136 \r
 137     default:\r
 138       if (p == NULL) {\r
 139         LWIP_DEBUGF(SLIP_DEBUG, ("slipif_input: alloc\n"));\r
 140         p = pbuf_alloc(PBUF_LINK, PBUF_POOL_BUFSIZE, PBUF_POOL);\r
 141 \r
 142         if (p == NULL) {\r
 143           LINK_STATS_INC(link.drop);\r
 144           LWIP_DEBUGF(SLIP_DEBUG, ("slipif_input: no new pbuf! (DROP)\n"));\r
 145         }\r
 146 \r
 147         if (q != NULL) {\r
 148           pbuf_cat(q, p);\r
 149         } else {\r
 150           q = p;\r
 151         }\r
 152       }\r
 153       if (p != NULL && recved < MAX_SIZE) {\r
 154         ((u8_t *)p->payload)[i] = c;\r
 155         recved++;\r
 156         i++;\r
 157         if (i >= p->len) {\r
 158           i = 0;\r
 159           if (p->next != NULL && p->next->len > 0)\r
 160             p = p->next;\r
 161           else\r
 162             p = NULL;\r
 163         }\r
 164       }\r
 165       break;\r
 166     }\r
 167 \r
 168   }\r
 169   return NULL;\r
 170 }\r
 171 \r
 172 /**\r
 173  * The SLIP input thread.\r
 174  *\r
 175  * Feed the IP layer with incoming packets\r
 176  */\r
 177 static void\r
 178 slipif_loop(void *nf)\r
 179 {\r
 180   struct pbuf *p;\r
 181   struct netif *netif = (struct netif *)nf;\r
 182 \r
 183   while (1) {\r
 184     p = slipif_input(netif);\r
 185     netif->input(p, netif);\r
 186   }\r
 187 }\r
 188 \r
 189 /**\r
 190  * SLIP netif initialization\r
 191  *\r
 192  * Call the arch specific sio_open and remember\r
 193  * the opened device in the state field of the netif.\r
 194  */\r
 195 err_t\r
 196 slipif_init(struct netif *netif)\r
 197 {\r
 198 \r
 199   LWIP_DEBUGF(SLIP_DEBUG, ("slipif_init: netif->num=%"U16_F"\n", (u16_t)netif->num));\r
 200 \r
 201   netif->name[0] = 's';\r
 202   netif->name[1] = 'l';\r
 203   netif->output = slipif_output;\r
 204   netif->mtu = 1500;\r
 205   netif->flags = NETIF_FLAG_POINTTOPOINT;\r
 206 \r
 207   netif->state = sio_open(netif->num);\r
 208   if (!netif->state)\r
 209     return ERR_IF;\r
 210 \r
 211   sys_thread_new(slipif_loop, netif, SLIPIF_THREAD_PRIO);\r
 212   return ERR_OK;\r
 213 }\r