Diff: MyNetUdpSocket.cpp

Revision:

0:61831b843b44

Child:

1:803123933c5a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MyNetUdpSocket.cpp	Sat Apr 14 17:21:11 2012 +0000
@@ -0,0 +1,126 @@
+// MyNetUdpSocket.cpp 2012/4/15
+#include "mbed.h"
+#include "MyNetUdpSocket.h"
+#include "w5100.h"
+
+#define DEBUG
+
+#ifdef DEBUG
+#include "Utils.h"
+#define PRINT_FUNC() printf("%p %d:%s\n", this,__LINE__,__PRETTY_FUNCTION__)
+#else //DEBUG
+#define PRINT_FUNC()
+#endif //DEBUG
+
+MyNetUdpSocket::MyNetUdpSocket() : NetUdpSocket()  {
+    PRINT_FUNC();
+    _socket = 0;
+    W5100.writeSnMR(_socket, SnMR::UDP); // set UDP mode
+}
+
+MyNetUdpSocket::~MyNetUdpSocket() {
+    PRINT_FUNC();
+    close();
+}
+
+NetUdpSocketErr MyNetUdpSocket::bind(const Host& me) {
+    PRINT_FUNC();
+    int port = me.getPort();
+    W5100.writeSnPORT(_socket, port);
+    W5100.execCmdSn( _socket, Sock_OPEN); // set OPEN command
+    return NETUDPSOCKET_OK;
+}
+
+int /*if < 0 : NetUdpSocketErr*/ MyNetUdpSocket::sendto(const char* buf, int len, Host* pHost) {
+    PRINT_FUNC();
+    uint8_t ip[4];
+    ip[0] = pHost->getIp()[0];
+    ip[1] = pHost->getIp()[1];
+    ip[2] = pHost->getIp()[2];
+    ip[3] = pHost->getIp()[3];
+    int port = pHost->getPort();
+    W5100.writeSnDIPR(_socket, ip);
+    W5100.writeSnDPORT(_socket, port);
+    W5100.send_data_processing(_socket, (uint8_t*)buf, len);
+    W5100.execCmdSn(_socket, Sock_SEND);
+#ifdef DEBUG
+    printHex((u8*)buf, len);
+    W5100.getIPAddress(ip);
+    printf("SIPR: %d.%d.%d.%d Sn_PORT:%d\n", ip[0], ip[1], ip[2], ip[3], W5100.readSnPORT(_socket));
+    W5100.readSnDIPR(_socket, ip);
+    printf("Sn_DIPR: %d.%d.%d.%d Sn_DPORT:%d\n", ip[0], ip[1], ip[2], ip[3], W5100.readSnDPORT(_socket));
+#endif //DEBUG
+    return len;
+}
+
+int /*if < 0 : NetUdpSocketErr*/ MyNetUdpSocket::recvfrom(char* buf, int len, Host* pHost) {
+    PRINT_FUNC();
+    int size = W5100.getRXReceivedSize(_socket);
+    if (size < 8) {
+        return -1;
+    }
+    uint8_t info[8];
+    W5100.recv_data_processing(_socket, info, 8);
+    W5100.execCmdSn(_socket, Sock_RECV);
+    pHost->setIp(IpAddr(info[0],info[1],info[2],info[3]));
+    pHost->setPort(info[4]<<8|info[5]);
+    size -= 8;
+    if (size > len) {
+        size = len;
+    }    
+    W5100.recv_data_processing(_socket, (uint8_t*)buf, size);
+    W5100.execCmdSn(_socket, Sock_RECV);
+#ifdef DEBUG
+    printfBytes("UDP PACKET-INFO", (u8*)info, 8);
+    printHex((u8*)buf, size);
+#endif //DEBUG
+    return size;
+}
+
+NetUdpSocketErr MyNetUdpSocket::close() {
+    PRINT_FUNC();
+    if(m_closed) {
+        return NETUDPSOCKET_OK;
+    }
+    m_closed = true;
+    cleanUp();
+    return NETUDPSOCKET_OK;
+}
+
+NetUdpSocketErr MyNetUdpSocket::poll() {
+    PRINT_FUNC();
+    NetUdpSocket::flushEvents();
+#ifdef DEBUG
+    printf("socket:%d SnMR:%02x SnIR:%02x SnSR:%02x\n", _socket, 
+        W5100.readSnMR(_socket), W5100.readSnIR(_socket), W5100.readSnSR(_socket));
+    uint8_t ip[4];
+    W5100.readSnDIPR(_socket, ip);
+    printf("Sn_DIPR: %d.%d.%d.%d Sn_DPORT: %d\n", ip[0], ip[1], ip[2], ip[3], W5100.readSnDPORT(_socket));
+    uint8_t mac[6];
+    W5100.readSnDHAR(_socket, mac);
+    printf("Sn_DHAR: %02x:%02x:%02x:%02x:%02x:%02x\n", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
+    printf("Sn_RX_RSR:%d, Sn_RX_RD:%d, Sn_RX_WR:%d\n",
+                W5100.readSnRX_RSR(_socket), W5100.readSnRX_RD(_socket), W5100.readSnRX_WR(_socket));
+    printf("Sn_TX_FSR:%d, Sn_TX_RD:%d, Sn_TX_WR:%d\n",
+                W5100.readSnTX_FSR(_socket), W5100.readSnTX_RD(_socket), W5100.readSnTX_WR(_socket));
+    wait_ms(500);    
+#endif //DEBUG
+    if (W5100.getRXReceivedSize(_socket) > 0) {
+        queueEvent(NETUDPSOCKET_READABLE);
+    }
+    return NETUDPSOCKET_OK;
+}
+
+void MyNetUdpSocket::cleanUp() //Flush input buffer
+{
+    PRINT_FUNC();
+    while(1) {
+        int len = W5100.getRXReceivedSize(_socket);
+        if (len <= 0) {
+            break;
+        }
+        uint8_t temp[8];
+        W5100.recv_data_processing(_socket, temp, sizeof(temp));
+        W5100.execCmdSn(_socket, Sock_RECV);
+    }    
+}