Ankit Patel / Mbed 2 deprecated Robot_Control_UDP_Wifi

Control a robot over the internet using UDP and a Wifly module (WiFi).

Dependencies:   Motor TextLCD WiflyInterface mbed-rtos mbed

WiflyInterface/Socket/TCPSocketConnection.cpp@0:c0dc3a76f3d4, 2013-10-17 (annotated)

Committer:
apatel336
Date:
Thu Oct 17 13:27:56 2013 +0000
Revision:
0:c0dc3a76f3d4
Initial Release

Who changed what in which revision?

UserRevisionLine numberNew contents of line
apatel336 0:c0dc3a76f3d4 1 /* Copyright (C) 2012 mbed.org, MIT License
apatel336 0:c0dc3a76f3d4 2 *
apatel336 0:c0dc3a76f3d4 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
apatel336 0:c0dc3a76f3d4 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
apatel336 0:c0dc3a76f3d4 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
apatel336 0:c0dc3a76f3d4 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
apatel336 0:c0dc3a76f3d4 7 * furnished to do so, subject to the following conditions:
apatel336 0:c0dc3a76f3d4 8 *
apatel336 0:c0dc3a76f3d4 9 * The above copyright notice and this permission notice shall be included in all copies or
apatel336 0:c0dc3a76f3d4 10 * substantial portions of the Software.
apatel336 0:c0dc3a76f3d4 11 *
apatel336 0:c0dc3a76f3d4 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
apatel336 0:c0dc3a76f3d4 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
apatel336 0:c0dc3a76f3d4 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
apatel336 0:c0dc3a76f3d4 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
apatel336 0:c0dc3a76f3d4 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
apatel336 0:c0dc3a76f3d4 17 */
apatel336 0:c0dc3a76f3d4 18
apatel336 0:c0dc3a76f3d4 19 #include "TCPSocketConnection.h"
apatel336 0:c0dc3a76f3d4 20 #include <algorithm>
apatel336 0:c0dc3a76f3d4 21
apatel336 0:c0dc3a76f3d4 22 TCPSocketConnection::TCPSocketConnection() {}
apatel336 0:c0dc3a76f3d4 23
apatel336 0:c0dc3a76f3d4 24 int TCPSocketConnection::connect(const char* host, const int port)
apatel336 0:c0dc3a76f3d4 25 {
apatel336 0:c0dc3a76f3d4 26 if (!wifi->connect(host, port))
apatel336 0:c0dc3a76f3d4 27 return -1;
apatel336 0:c0dc3a76f3d4 28 wifi->flush();
apatel336 0:c0dc3a76f3d4 29 return 0;
apatel336 0:c0dc3a76f3d4 30 }
apatel336 0:c0dc3a76f3d4 31
apatel336 0:c0dc3a76f3d4 32 bool TCPSocketConnection::is_connected(void)
apatel336 0:c0dc3a76f3d4 33 {
apatel336 0:c0dc3a76f3d4 34 return wifi->is_connected();
apatel336 0:c0dc3a76f3d4 35 }
apatel336 0:c0dc3a76f3d4 36
apatel336 0:c0dc3a76f3d4 37 int TCPSocketConnection::send(char* data, int length)
apatel336 0:c0dc3a76f3d4 38 {
apatel336 0:c0dc3a76f3d4 39 Timer tmr;
apatel336 0:c0dc3a76f3d4 40
apatel336 0:c0dc3a76f3d4 41 if (!_blocking) {
apatel336 0:c0dc3a76f3d4 42 tmr.start();
apatel336 0:c0dc3a76f3d4 43 while (tmr.read_ms() < _timeout) {
apatel336 0:c0dc3a76f3d4 44 if (wifi->writeable())
apatel336 0:c0dc3a76f3d4 45 break;
apatel336 0:c0dc3a76f3d4 46 }
apatel336 0:c0dc3a76f3d4 47 if (tmr.read_ms() >= _timeout) {
apatel336 0:c0dc3a76f3d4 48 return -1;
apatel336 0:c0dc3a76f3d4 49 }
apatel336 0:c0dc3a76f3d4 50 }
apatel336 0:c0dc3a76f3d4 51 return wifi->send(data, length);
apatel336 0:c0dc3a76f3d4 52 }
apatel336 0:c0dc3a76f3d4 53
apatel336 0:c0dc3a76f3d4 54 // -1 if unsuccessful, else number of bytes written
apatel336 0:c0dc3a76f3d4 55 int TCPSocketConnection::send_all(char* data, int length)
apatel336 0:c0dc3a76f3d4 56 {
apatel336 0:c0dc3a76f3d4 57 Timer tmr;
apatel336 0:c0dc3a76f3d4 58 int idx = 0;
apatel336 0:c0dc3a76f3d4 59 tmr.start();
apatel336 0:c0dc3a76f3d4 60
apatel336 0:c0dc3a76f3d4 61 while ((tmr.read_ms() < _timeout) || _blocking) {
apatel336 0:c0dc3a76f3d4 62
apatel336 0:c0dc3a76f3d4 63 idx += wifi->send(data, length);
apatel336 0:c0dc3a76f3d4 64
apatel336 0:c0dc3a76f3d4 65 if (idx == length)
apatel336 0:c0dc3a76f3d4 66 return idx;
apatel336 0:c0dc3a76f3d4 67 }
apatel336 0:c0dc3a76f3d4 68 return (idx == 0) ? -1 : idx;
apatel336 0:c0dc3a76f3d4 69 }
apatel336 0:c0dc3a76f3d4 70
apatel336 0:c0dc3a76f3d4 71 // -1 if unsuccessful, else number of bytes received
apatel336 0:c0dc3a76f3d4 72 int TCPSocketConnection::receive(char* data, int length)
apatel336 0:c0dc3a76f3d4 73 {
apatel336 0:c0dc3a76f3d4 74 Timer tmr;
apatel336 0:c0dc3a76f3d4 75 int time = -1;
apatel336 0:c0dc3a76f3d4 76
apatel336 0:c0dc3a76f3d4 77
apatel336 0:c0dc3a76f3d4 78 if (!_blocking) {
apatel336 0:c0dc3a76f3d4 79 tmr.start();
apatel336 0:c0dc3a76f3d4 80 while (time < _timeout + 20) {
apatel336 0:c0dc3a76f3d4 81 if (wifi->readable()) {
apatel336 0:c0dc3a76f3d4 82 break;
apatel336 0:c0dc3a76f3d4 83 }
apatel336 0:c0dc3a76f3d4 84 time = tmr.read_ms();
apatel336 0:c0dc3a76f3d4 85 }
apatel336 0:c0dc3a76f3d4 86 if (time >= _timeout + 20) {
apatel336 0:c0dc3a76f3d4 87 return -1;
apatel336 0:c0dc3a76f3d4 88 }
apatel336 0:c0dc3a76f3d4 89 }
apatel336 0:c0dc3a76f3d4 90
apatel336 0:c0dc3a76f3d4 91
apatel336 0:c0dc3a76f3d4 92 while(!wifi->readable());
apatel336 0:c0dc3a76f3d4 93 int nb_available = wifi->readable();
apatel336 0:c0dc3a76f3d4 94 for (int i = 0; i < min(nb_available, length); i++) {
apatel336 0:c0dc3a76f3d4 95 data[i] = wifi->getc();
apatel336 0:c0dc3a76f3d4 96 }
apatel336 0:c0dc3a76f3d4 97
apatel336 0:c0dc3a76f3d4 98 return min(nb_available, length);
apatel336 0:c0dc3a76f3d4 99 }
apatel336 0:c0dc3a76f3d4 100
apatel336 0:c0dc3a76f3d4 101
apatel336 0:c0dc3a76f3d4 102 // -1 if unsuccessful, else number of bytes received
apatel336 0:c0dc3a76f3d4 103 int TCPSocketConnection::receive_all(char* data, int length)
apatel336 0:c0dc3a76f3d4 104 {
apatel336 0:c0dc3a76f3d4 105 Timer tmr;
apatel336 0:c0dc3a76f3d4 106 int idx = 0;
apatel336 0:c0dc3a76f3d4 107 int time = -1;
apatel336 0:c0dc3a76f3d4 108
apatel336 0:c0dc3a76f3d4 109 tmr.start();
apatel336 0:c0dc3a76f3d4 110
apatel336 0:c0dc3a76f3d4 111 while (time < _timeout || _blocking) {
apatel336 0:c0dc3a76f3d4 112
apatel336 0:c0dc3a76f3d4 113 int nb_available = wifi->readable();
apatel336 0:c0dc3a76f3d4 114 for (int i = 0; i < min(nb_available, length); i++) {
apatel336 0:c0dc3a76f3d4 115 data[idx++] = wifi->getc();
apatel336 0:c0dc3a76f3d4 116 }
apatel336 0:c0dc3a76f3d4 117
apatel336 0:c0dc3a76f3d4 118 if (idx == length)
apatel336 0:c0dc3a76f3d4 119 break;
apatel336 0:c0dc3a76f3d4 120
apatel336 0:c0dc3a76f3d4 121 time = tmr.read_ms();
apatel336 0:c0dc3a76f3d4 122 }
apatel336 0:c0dc3a76f3d4 123
apatel336 0:c0dc3a76f3d4 124 return (idx == 0) ? -1 : idx;
apatel336 0:c0dc3a76f3d4 125 }