Yann Garcia / Mbed 2 deprecated DS130x_I2CApp

This short program illustrates how to use the DS130x_I2C library. My objective is to share the same RTC with Microchip 18F MCU.

Dependencies:   mbed DebugLibrary

NetServices/if/lwip/lwipNetUdpSocket.cpp@1:995212d326ca, 2011-02-11 (annotated)

Committer:
Yann
Date:
Fri Feb 11 10:17:20 2011 +0000
Revision:
1:995212d326ca
Parent:
0:f30e2135b0db 
V0.0.0.2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Yann 0:f30e2135b0db 1 #pragma diag_remark 1464
Yann 0:f30e2135b0db 2 /*
Yann 0:f30e2135b0db 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
Yann 0:f30e2135b0db 4
Yann 0:f30e2135b0db 5 Permission is hereby granted, free of charge, to any person obtaining a copy
Yann 0:f30e2135b0db 6 of this software and associated documentation files (the "Software"), to deal
Yann 0:f30e2135b0db 7 in the Software without restriction, including without limitation the rights
Yann 0:f30e2135b0db 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
Yann 0:f30e2135b0db 9 copies of the Software, and to permit persons to whom the Software is
Yann 0:f30e2135b0db 10 furnished to do so, subject to the following conditions:
Yann 0:f30e2135b0db 11
Yann 0:f30e2135b0db 12 The above copyright notice and this permission notice shall be included in
Yann 0:f30e2135b0db 13 all copies or substantial portions of the Software.
Yann 0:f30e2135b0db 14
Yann 0:f30e2135b0db 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
Yann 0:f30e2135b0db 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
Yann 0:f30e2135b0db 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
Yann 0:f30e2135b0db 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
Yann 0:f30e2135b0db 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Yann 0:f30e2135b0db 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
Yann 0:f30e2135b0db 21 THE SOFTWARE.
Yann 0:f30e2135b0db 22 */
Yann 0:f30e2135b0db 23
Yann 0:f30e2135b0db 24 #include "lwip/ip_addr.h"
Yann 0:f30e2135b0db 25 #include "lwipNetUdpSocket.h"
Yann 0:f30e2135b0db 26 #include "lwip/udp.h"
Yann 0:f30e2135b0db 27 #include "lwip/igmp.h"
Yann 0:f30e2135b0db 28
Yann 0:f30e2135b0db 29
Yann 0:f30e2135b0db 30 //#define __DEBUG
Yann 0:f30e2135b0db 31 #include "dbg/dbg.h"
Yann 0:f30e2135b0db 32
Yann 0:f30e2135b0db 33 #include "netCfg.h"
Yann 0:f30e2135b0db 34 #if NET_LWIP_STACK
Yann 0:f30e2135b0db 35
Yann 0:f30e2135b0db 36 LwipNetUdpSocket::LwipNetUdpSocket(udp_pcb* pPcb /*= NULL*/) : NetUdpSocket(), m_pPcb(pPcb), m_lInPkt(), m_multicastGroup() //Passes a pcb if already created (by an accept req for instance), in that case transfers ownership
Yann 0:f30e2135b0db 37 {
Yann 0:f30e2135b0db 38 DBG("New LwipNetUdpSocket %p (pPCb=%p)\n", (void*)this, (void*) pPcb);
Yann 0:f30e2135b0db 39 if(!m_pPcb)
Yann 0:f30e2135b0db 40 m_pPcb = udp_new();
Yann 0:f30e2135b0db 41 if(m_pPcb)
Yann 0:f30e2135b0db 42 {
Yann 0:f30e2135b0db 43 //Setup callback
Yann 0:f30e2135b0db 44 udp_recv( (udp_pcb*) m_pPcb, LwipNetUdpSocket::sRecvCb, (void*) this );
Yann 0:f30e2135b0db 45 }
Yann 0:f30e2135b0db 46 }
Yann 0:f30e2135b0db 47
Yann 0:f30e2135b0db 48 LwipNetUdpSocket::~LwipNetUdpSocket()
Yann 0:f30e2135b0db 49 {
Yann 0:f30e2135b0db 50 close();
Yann 0:f30e2135b0db 51 }
Yann 0:f30e2135b0db 52
Yann 0:f30e2135b0db 53 NetUdpSocketErr LwipNetUdpSocket::bind(const Host& me)
Yann 0:f30e2135b0db 54 {
Yann 0:f30e2135b0db 55 err_t err;
Yann 0:f30e2135b0db 56
Yann 0:f30e2135b0db 57 if(!m_pPcb)
Yann 0:f30e2135b0db 58 return NETUDPSOCKET_MEM; //NetUdpSocket was not properly initialised, should destroy it & retry
Yann 0:f30e2135b0db 59
Yann 0:f30e2135b0db 60 #if LWIP_IGMP //Multicast support enabled
Yann 0:f30e2135b0db 61 if(me.getIp().isMulticast())
Yann 0:f30e2135b0db 62 {
Yann 0:f30e2135b0db 63 DBG("This is a multicast addr, joining multicast group\n");
Yann 0:f30e2135b0db 64 m_multicastGroup = me.getIp();
Yann 0:f30e2135b0db 65 err = igmp_joingroup(IP_ADDR_ANY, &(m_multicastGroup.getStruct()));
Yann 0:f30e2135b0db 66 if(err)
Yann 0:f30e2135b0db 67 return NETUDPSOCKET_IF; //Could not find or create group
Yann 0:f30e2135b0db 68 }
Yann 0:f30e2135b0db 69 #endif
Yann 0:f30e2135b0db 70
Yann 0:f30e2135b0db 71 err = udp_bind( (udp_pcb*) m_pPcb, IP_ADDR_ANY, me.getPort()); //IP_ADDR_ANY : Bind the connection to all local addresses
Yann 0:f30e2135b0db 72 if(err)
Yann 0:f30e2135b0db 73 return NETUDPSOCKET_INUSE;
Yann 0:f30e2135b0db 74
Yann 0:f30e2135b0db 75 //Setup callback
Yann 0:f30e2135b0db 76 udp_recv( (udp_pcb*) m_pPcb, LwipNetUdpSocket::sRecvCb, (void*) this );
Yann 0:f30e2135b0db 77
Yann 0:f30e2135b0db 78 return NETUDPSOCKET_OK;
Yann 0:f30e2135b0db 79 }
Yann 0:f30e2135b0db 80
Yann 0:f30e2135b0db 81 #define MAX(a,b) ((a>b)?a:b)
Yann 0:f30e2135b0db 82 #define MIN(a,b) ((a<b)?a:b)
Yann 0:f30e2135b0db 83
Yann 0:f30e2135b0db 84 int /*if < 0 : NetUdpSocketErr*/ LwipNetUdpSocket::sendto(const char* buf, int len, Host* pHost)
Yann 0:f30e2135b0db 85 {
Yann 0:f30e2135b0db 86 if( !m_pPcb ) //Pcb doesn't exist (anymore)
Yann 0:f30e2135b0db 87 return NETUDPSOCKET_MEM;
Yann 0:f30e2135b0db 88 pbuf* p = pbuf_alloc(PBUF_TRANSPORT, len, PBUF_POOL);
Yann 0:f30e2135b0db 89 if( !p )
Yann 0:f30e2135b0db 90 return NETUDPSOCKET_MEM;
Yann 0:f30e2135b0db 91 char* pBuf = (char*) buf;
Yann 0:f30e2135b0db 92 pbuf* q = p;
Yann 0:f30e2135b0db 93 do
Yann 0:f30e2135b0db 94 {
Yann 0:f30e2135b0db 95 memcpy (q->payload, (void*)pBuf, q->len);
Yann 0:f30e2135b0db 96 pBuf += q->len;
Yann 0:f30e2135b0db 97 q = q->next;
Yann 0:f30e2135b0db 98 } while(q != NULL);
Yann 0:f30e2135b0db 99
Yann 0:f30e2135b0db 100 err_t err = udp_sendto( (udp_pcb*) m_pPcb, p, &(pHost->getIp().getStruct()), pHost->getPort() );
Yann 0:f30e2135b0db 101 pbuf_free( p );
Yann 0:f30e2135b0db 102 if(err)
Yann 0:f30e2135b0db 103 return NETUDPSOCKET_SETUP; //Connection problem
Yann 0:f30e2135b0db 104 DBG("%d bytes sent in UDP Socket.\n", len);
Yann 0:f30e2135b0db 105 return len;
Yann 0:f30e2135b0db 106 }
Yann 0:f30e2135b0db 107
Yann 0:f30e2135b0db 108 int /*if < 0 : NetUdpSocketErr*/ LwipNetUdpSocket::recvfrom(char* buf, int len, Host* pHost)
Yann 0:f30e2135b0db 109 {
Yann 0:f30e2135b0db 110 if( !m_pPcb ) //Pcb doesn't exist (anymore)
Yann 0:f30e2135b0db 111 return NETUDPSOCKET_MEM;
Yann 0:f30e2135b0db 112 int inLen = 0;
Yann 0:f30e2135b0db 113 int cpyLen = 0;
Yann 0:f30e2135b0db 114
Yann 0:f30e2135b0db 115 static int rmgLen = 0;
Yann 0:f30e2135b0db 116 //Contains the remaining len in this pbuf
Yann 0:f30e2135b0db 117
Yann 0:f30e2135b0db 118 if( m_lInPkt.empty() )
Yann 0:f30e2135b0db 119 return 0;
Yann 0:f30e2135b0db 120
Yann 0:f30e2135b0db 121 pbuf* pBuf = (pbuf*) m_lInPkt.front().pBuf;
Yann 0:f30e2135b0db 122
Yann 0:f30e2135b0db 123 if(pHost)
Yann 0:f30e2135b0db 124 *pHost = Host( IpAddr(&m_lInPkt.front().addr), m_lInPkt.front().port );
Yann 0:f30e2135b0db 125
Yann 0:f30e2135b0db 126 if( !pBuf )
Yann 0:f30e2135b0db 127 {
Yann 0:f30e2135b0db 128 rmgLen = 0;
Yann 0:f30e2135b0db 129 return 0;
Yann 0:f30e2135b0db 130 }
Yann 0:f30e2135b0db 131
Yann 0:f30e2135b0db 132 if ( !rmgLen ) //We did not know m_pReadPbuf->len last time we called this fn
Yann 0:f30e2135b0db 133 {
Yann 0:f30e2135b0db 134 rmgLen = pBuf->len;
Yann 0:f30e2135b0db 135 }
Yann 0:f30e2135b0db 136
Yann 0:f30e2135b0db 137 while ( inLen < len )
Yann 0:f30e2135b0db 138 {
Yann 0:f30e2135b0db 139 cpyLen = MIN( (len - inLen), rmgLen ); //Remaining len to copy, remaining len in THIS pbuf
Yann 0:f30e2135b0db 140 memcpy((void*)buf, (void*)((char*)(pBuf->payload) + (pBuf->len - rmgLen)), cpyLen);
Yann 0:f30e2135b0db 141 inLen += cpyLen;
Yann 0:f30e2135b0db 142 buf += cpyLen;
Yann 0:f30e2135b0db 143
Yann 0:f30e2135b0db 144 rmgLen = rmgLen - cpyLen; //Update rmgLen
Yann 0:f30e2135b0db 145
Yann 0:f30e2135b0db 146 if( rmgLen > 0 )
Yann 0:f30e2135b0db 147 {
Yann 0:f30e2135b0db 148 //We did not read this pbuf completely, so let's save it's pos & return
Yann 0:f30e2135b0db 149 break;
Yann 0:f30e2135b0db 150 }
Yann 0:f30e2135b0db 151
Yann 0:f30e2135b0db 152 if(pBuf->next)
Yann 0:f30e2135b0db 153 {
Yann 0:f30e2135b0db 154 pbuf* pNextPBuf = pBuf->next;
Yann 0:f30e2135b0db 155 pBuf->next = NULL; //So that it is not freed as well
Yann 0:f30e2135b0db 156 //We get the reference to pNextPBuf from m_pReadPbuf
Yann 0:f30e2135b0db 157 pbuf_free((pbuf*)pBuf);
Yann 0:f30e2135b0db 158 pBuf = pNextPBuf;
Yann 0:f30e2135b0db 159 rmgLen = pBuf->len;
Yann 0:f30e2135b0db 160 }
Yann 0:f30e2135b0db 161 else
Yann 0:f30e2135b0db 162 {
Yann 0:f30e2135b0db 163 pbuf_free((pbuf*)pBuf);
Yann 0:f30e2135b0db 164 pBuf = NULL;
Yann 0:f30e2135b0db 165 rmgLen = 0;
Yann 0:f30e2135b0db 166 m_lInPkt.pop_front();
Yann 0:f30e2135b0db 167 break; //No more data to read
Yann 0:f30e2135b0db 168 }
Yann 0:f30e2135b0db 169 }
Yann 0:f30e2135b0db 170
Yann 0:f30e2135b0db 171 return inLen;
Yann 0:f30e2135b0db 172 }
Yann 0:f30e2135b0db 173
Yann 0:f30e2135b0db 174 NetUdpSocketErr LwipNetUdpSocket::close()
Yann 0:f30e2135b0db 175 {
Yann 0:f30e2135b0db 176 DBG("LwipNetUdpSocket::close() : Closing...\n");
Yann 0:f30e2135b0db 177
Yann 0:f30e2135b0db 178 if(m_closed)
Yann 0:f30e2135b0db 179 return NETUDPSOCKET_OK; //Already being closed
Yann 0:f30e2135b0db 180 m_closed = true;
Yann 0:f30e2135b0db 181
Yann 0:f30e2135b0db 182 if( !m_pPcb ) //Pcb doesn't exist (anymore)
Yann 0:f30e2135b0db 183 return NETUDPSOCKET_MEM;
Yann 0:f30e2135b0db 184
Yann 0:f30e2135b0db 185 DBG("LwipNetUdpSocket::close() : Cleanup...\n");
Yann 0:f30e2135b0db 186
Yann 0:f30e2135b0db 187 //Cleanup incoming data
Yann 0:f30e2135b0db 188 cleanUp();
Yann 0:f30e2135b0db 189
Yann 0:f30e2135b0db 190
Yann 0:f30e2135b0db 191 DBG("LwipNetUdpSocket::close() : removing m_pPcb...\n");
Yann 0:f30e2135b0db 192 udp_remove( (udp_pcb*) m_pPcb);
Yann 0:f30e2135b0db 193
Yann 0:f30e2135b0db 194 m_pPcb = NULL;
Yann 0:f30e2135b0db 195 return NETUDPSOCKET_OK;
Yann 0:f30e2135b0db 196 }
Yann 0:f30e2135b0db 197
Yann 0:f30e2135b0db 198 NetUdpSocketErr LwipNetUdpSocket::poll()
Yann 0:f30e2135b0db 199 {
Yann 0:f30e2135b0db 200 NetUdpSocket::flushEvents();
Yann 0:f30e2135b0db 201 return NETUDPSOCKET_OK;
Yann 0:f30e2135b0db 202 }
Yann 0:f30e2135b0db 203
Yann 0:f30e2135b0db 204 // Callbacks events
Yann 0:f30e2135b0db 205
Yann 0:f30e2135b0db 206 void LwipNetUdpSocket::recvCb(udp_pcb* pcb, struct pbuf* p, ip_addr_t* addr, u16_t port)
Yann 0:f30e2135b0db 207 {
Yann 0:f30e2135b0db 208 DBG(" Packet of length %d arrived in UDP Socket.\n", p->tot_len);
Yann 0:f30e2135b0db 209 list<InPacket>::iterator it;
Yann 0:f30e2135b0db 210 for ( it = m_lInPkt.begin(); it != m_lInPkt.end(); it++ )
Yann 0:f30e2135b0db 211 {
Yann 0:f30e2135b0db 212 if( ip_addr_cmp((&((*it).addr)), addr) && ((*it).port == port) )
Yann 0:f30e2135b0db 213 {
Yann 0:f30e2135b0db 214 //Let's tail this packet to the previous one
Yann 0:f30e2135b0db 215 pbuf_cat((pbuf*)((*it).pBuf), p);
Yann 0:f30e2135b0db 216 //No need to queue an event in that case since the read buf has not been processed yet
Yann 0:f30e2135b0db 217 return;
Yann 0:f30e2135b0db 218 }
Yann 0:f30e2135b0db 219 }
Yann 0:f30e2135b0db 220
Yann 0:f30e2135b0db 221 //New host, add a packet to the queue
Yann 0:f30e2135b0db 222 InPacket pkt;
Yann 0:f30e2135b0db 223 pkt.pBuf = p;
Yann 0:f30e2135b0db 224 pkt.addr = *addr;
Yann 0:f30e2135b0db 225 pkt.port = port;
Yann 0:f30e2135b0db 226 m_lInPkt.push_back(pkt);
Yann 0:f30e2135b0db 227
Yann 0:f30e2135b0db 228 queueEvent(NETUDPSOCKET_READABLE);
Yann 0:f30e2135b0db 229 }
Yann 0:f30e2135b0db 230
Yann 0:f30e2135b0db 231 void LwipNetUdpSocket::cleanUp() //Flush input buffer
Yann 0:f30e2135b0db 232 {
Yann 0:f30e2135b0db 233 //Ensure that further error won't be followed to this inst (which can be destroyed)
Yann 0:f30e2135b0db 234 if( m_pPcb )
Yann 0:f30e2135b0db 235 {
Yann 0:f30e2135b0db 236 udp_recv( (udp_pcb*) m_pPcb, NULL, (void*) NULL );
Yann 0:f30e2135b0db 237 }
Yann 0:f30e2135b0db 238
Yann 0:f30e2135b0db 239 //Leaving multicast group(Ok because LwIP has a refscount for multicast group)
Yann 0:f30e2135b0db 240 #if LWIP_IGMP //Multicast support enabled
Yann 0:f30e2135b0db 241 if(m_multicastGroup.isMulticast())
Yann 0:f30e2135b0db 242 {
Yann 0:f30e2135b0db 243 igmp_leavegroup(IP_ADDR_ANY, &(m_multicastGroup.getStruct()));
Yann 0:f30e2135b0db 244 m_multicastGroup = IpAddr();
Yann 0:f30e2135b0db 245 }
Yann 0:f30e2135b0db 246 #endif
Yann 0:f30e2135b0db 247
Yann 0:f30e2135b0db 248 list<InPacket>::iterator it;
Yann 0:f30e2135b0db 249 for ( it = m_lInPkt.begin(); it != m_lInPkt.end(); it++ )
Yann 0:f30e2135b0db 250 {
Yann 0:f30e2135b0db 251 //Free buf
Yann 0:f30e2135b0db 252 pbuf_free((pbuf*)((*it).pBuf));
Yann 0:f30e2135b0db 253 }
Yann 0:f30e2135b0db 254 m_lInPkt.clear();
Yann 0:f30e2135b0db 255 }
Yann 0:f30e2135b0db 256
Yann 0:f30e2135b0db 257 // Static callback from LwIp
Yann 0:f30e2135b0db 258
Yann 0:f30e2135b0db 259 void LwipNetUdpSocket::sRecvCb(void *arg, struct udp_pcb *pcb, struct pbuf *p, ip_addr_t *addr, u16_t port)
Yann 0:f30e2135b0db 260 {
Yann 0:f30e2135b0db 261 LwipNetUdpSocket* pMe = (LwipNetUdpSocket*) arg;
Yann 0:f30e2135b0db 262 return pMe->recvCb( pcb, p, addr, port );
Yann 0:f30e2135b0db 263 }
Yann 0:f30e2135b0db 264
Yann 0:f30e2135b0db 265 #endif