private fork
Fork of GSwifiInterface by
Socket/UDPSocket.cpp
- Committer:
- gsfan
- Date:
- 2013-01-27
- Revision:
- 5:78943b3945b5
- Parent:
- 4:0bcec6272784
- Child:
- 8:64184a968e3b
File content as of revision 5:78943b3945b5:
/* Copyright (C) 2012 mbed.org, MIT License * * Permission is hereby granted, free of charge, to any person obtaining a copy of this software * and associated documentation files (the "Software"), to deal in the Software without restriction, * including without limitation the rights to use, copy, modify, merge, publish, distribute, * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is * furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in all copies or * substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ /* Copyright (C) 2013 gsfan, MIT License * port to the GainSpan Wi-FI module GS1011 */ #include "UDPSocket.h" #include <string> #include <algorithm> UDPSocket::UDPSocket() { endpoint_connected = false; } int UDPSocket::init(void) { _server = false; return 0; } // Server initialization int UDPSocket::bind(int port) { _port = port; _server = true; return 0; } // -1 if unsuccessful, else number of bytes written int UDPSocket::sendTo(Endpoint &remote, char *packet, int length) { Timer tmr; int idx = 0; tmr.start(); while ((tmr.read_ms() < _timeout) || _blocking) { idx += sendPacket(remote, packet, length); if (idx == -1) return -1; if (idx == length) return idx; } return (idx == 0) ? -1 : idx; } // -1 if unsuccessful, else number of bytes received int UDPSocket::receiveFrom(Endpoint &remote, char *buffer, int length) { Timer tmr; int idx = 0; int nb_available = 0; int time = -1; if (_cid < 0 || !_wifi->is_connected(_cid)) { // Socket open char cmd[CFG_CMD_SIZE]; if (_server) { sprintf(cmd, "AT+NSUDP=%d", _port); } else { sprintf(cmd, "AT+NCUDP=%s,%d", remote.get_address(), remote.get_port()); if (_port) { sprintf(&cmd[strlen(cmd)], ",%d", _port); } } if (_wifi->sendCommand(cmd, GSwifi::RES_CONNECT) == false) return -1; _cid = _wifi->readCID(); } if (_blocking) { while (1) { nb_available = _wifi->readable(_cid); if (nb_available != 0) { break; } } } tmr.start(); while (time < _timeout) { nb_available = _wifi->readable(_cid); for (int i = 0; i < min(nb_available, length); i++) { buffer[idx] = _wifi->getc(_cid); idx++; } if (idx == length) { break; } time = tmr.read_ms(); } if (_server) { char *ip; int port; if (_wifi->readRemote(_cid, &ip, &port)) { remote.set_address(ip, port); } } return (idx == 0) ? -1 : idx; } int UDPSocket::sendPacket (Endpoint &ep, const char *buf, int len) { char cmd[CFG_CMD_SIZE]; Timer tmr; int result = 0; if (_cid < 0 || !_wifi->is_connected(_cid)) { // Socket open char cmd[CFG_CMD_SIZE]; if (_server) { sprintf(cmd, "AT+NSUDP=%d", _port); } else { sprintf(cmd, "AT+NCUDP=%s,%d", ep.get_address(), ep.get_port()); if (_port) { sprintf(&cmd[strlen(cmd)], ",%d", _port); } } if (_wifi->sendCommand(cmd, GSwifi::RES_CONNECT) == false) return -1; _cid = _wifi->readCID(); } if (_server) { // UDP Server sprintf(cmd, "\x1bY%X%s:%d:%04d", _cid, ep.get_address(), ep.get_port(), len); _wifi->send(cmd, strlen(cmd)); result = _wifi->send(buf, len, GSwifi::RES_NORMAL); } else { // UDP Client sprintf(cmd, "\x1bZ%X%04d", _cid, len); _wifi->send(cmd, strlen(cmd)); result = _wifi->send(buf, len, GSwifi::RES_NORMAL); } return result; }