ワークショップ用のプログラム

Dependencies:   Milkcocoa mbed

Committer:
jksoft
Date:
Thu Sep 22 00:49:42 2016 +0000
Revision:
0:d0b3a5d1ba28
????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jksoft 0:d0b3a5d1ba28 1 /* Copyright (C) 2012 mbed.org, MIT License
jksoft 0:d0b3a5d1ba28 2 *
jksoft 0:d0b3a5d1ba28 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
jksoft 0:d0b3a5d1ba28 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
jksoft 0:d0b3a5d1ba28 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
jksoft 0:d0b3a5d1ba28 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
jksoft 0:d0b3a5d1ba28 7 * furnished to do so, subject to the following conditions:
jksoft 0:d0b3a5d1ba28 8 *
jksoft 0:d0b3a5d1ba28 9 * The above copyright notice and this permission notice shall be included in all copies or
jksoft 0:d0b3a5d1ba28 10 * substantial portions of the Software.
jksoft 0:d0b3a5d1ba28 11 *
jksoft 0:d0b3a5d1ba28 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
jksoft 0:d0b3a5d1ba28 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
jksoft 0:d0b3a5d1ba28 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
jksoft 0:d0b3a5d1ba28 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
jksoft 0:d0b3a5d1ba28 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
jksoft 0:d0b3a5d1ba28 17 */
jksoft 0:d0b3a5d1ba28 18
jksoft 0:d0b3a5d1ba28 19 #include "UDPSocket.h"
jksoft 0:d0b3a5d1ba28 20
jksoft 0:d0b3a5d1ba28 21 #include <string>
jksoft 0:d0b3a5d1ba28 22 #include <algorithm>
jksoft 0:d0b3a5d1ba28 23
jksoft 0:d0b3a5d1ba28 24 UDPSocket::UDPSocket()
jksoft 0:d0b3a5d1ba28 25 {
jksoft 0:d0b3a5d1ba28 26 endpoint_configured = false;
jksoft 0:d0b3a5d1ba28 27 endpoint_read = false;
jksoft 0:d0b3a5d1ba28 28 Endpoint currentEndpoint;
jksoft 0:d0b3a5d1ba28 29 }
jksoft 0:d0b3a5d1ba28 30
jksoft 0:d0b3a5d1ba28 31 int UDPSocket::init(void)
jksoft 0:d0b3a5d1ba28 32 {
jksoft 0:d0b3a5d1ba28 33 return 0;
jksoft 0:d0b3a5d1ba28 34 }
jksoft 0:d0b3a5d1ba28 35
jksoft 0:d0b3a5d1ba28 36 // Server initialization
jksoft 0:d0b3a5d1ba28 37 int UDPSocket::bind(int port)
jksoft 0:d0b3a5d1ba28 38 {
jksoft 0:d0b3a5d1ba28 39 return 0;
jksoft 0:d0b3a5d1ba28 40 }
jksoft 0:d0b3a5d1ba28 41
jksoft 0:d0b3a5d1ba28 42 // -1 if unsuccessful, else number of bytes written
jksoft 0:d0b3a5d1ba28 43 int UDPSocket::sendTo(Endpoint &remote, char *packet, int length)
jksoft 0:d0b3a5d1ba28 44 {
jksoft 0:d0b3a5d1ba28 45 Timer tmr;
jksoft 0:d0b3a5d1ba28 46 int idx = 0;
jksoft 0:d0b3a5d1ba28 47
jksoft 0:d0b3a5d1ba28 48
jksoft 0:d0b3a5d1ba28 49 confEndpoint(remote);
jksoft 0:d0b3a5d1ba28 50
jksoft 0:d0b3a5d1ba28 51 // initialize transparent mode if not already done
jksoft 0:d0b3a5d1ba28 52 if(!endpoint_configured) {
jksoft 0:d0b3a5d1ba28 53 // initialize UDP (default id of -1 means transparent mode)
jksoft 0:d0b3a5d1ba28 54 //!wifi->start(ESP_UDP_TYPE, remote._ipAddress, remote._port, remote._id
jksoft 0:d0b3a5d1ba28 55 if(!wifi->startUDP(remote._ipAddress, remote._port, 0,length)) {
jksoft 0:d0b3a5d1ba28 56 return(-1);
jksoft 0:d0b3a5d1ba28 57 }
jksoft 0:d0b3a5d1ba28 58 endpoint_configured = true;
jksoft 0:d0b3a5d1ba28 59 }
jksoft 0:d0b3a5d1ba28 60
jksoft 0:d0b3a5d1ba28 61 tmr.start();
jksoft 0:d0b3a5d1ba28 62
jksoft 0:d0b3a5d1ba28 63 while ((tmr.read_ms() < _timeout) || _blocking) {
jksoft 0:d0b3a5d1ba28 64
jksoft 0:d0b3a5d1ba28 65 idx += wifi->send(packet, length);
jksoft 0:d0b3a5d1ba28 66
jksoft 0:d0b3a5d1ba28 67 if (idx == length)
jksoft 0:d0b3a5d1ba28 68 return idx;
jksoft 0:d0b3a5d1ba28 69 }
jksoft 0:d0b3a5d1ba28 70 return (idx == 0) ? -1 : idx;
jksoft 0:d0b3a5d1ba28 71 }
jksoft 0:d0b3a5d1ba28 72
jksoft 0:d0b3a5d1ba28 73 // -1 if unsuccessful, else number of bytes received
jksoft 0:d0b3a5d1ba28 74 int UDPSocket::receiveFrom(Endpoint &remote, char *buffer, int length)
jksoft 0:d0b3a5d1ba28 75 {
jksoft 0:d0b3a5d1ba28 76 Timer tmr;
jksoft 0:d0b3a5d1ba28 77 int idx = 0;
jksoft 0:d0b3a5d1ba28 78 int nb_available = 0;
jksoft 0:d0b3a5d1ba28 79 int time = -1;
jksoft 0:d0b3a5d1ba28 80
jksoft 0:d0b3a5d1ba28 81 //make this the non-blocking case and return if <= 0
jksoft 0:d0b3a5d1ba28 82 // remember to change the config to blocking
jksoft 0:d0b3a5d1ba28 83 // if ( ! _blocking) {
jksoft 0:d0b3a5d1ba28 84 // if ( wifi.readable <= 0 ) {
jksoft 0:d0b3a5d1ba28 85 // return (wifi.readable);
jksoft 0:d0b3a5d1ba28 86 // }
jksoft 0:d0b3a5d1ba28 87 // }
jksoft 0:d0b3a5d1ba28 88 //---
jksoft 0:d0b3a5d1ba28 89 tmr.start();
jksoft 0:d0b3a5d1ba28 90 if (_blocking) {
jksoft 0:d0b3a5d1ba28 91 while (1) {
jksoft 0:d0b3a5d1ba28 92 nb_available = wifi->readable();
jksoft 0:d0b3a5d1ba28 93 if (nb_available != 0) {
jksoft 0:d0b3a5d1ba28 94 break;
jksoft 0:d0b3a5d1ba28 95 }
jksoft 0:d0b3a5d1ba28 96 }
jksoft 0:d0b3a5d1ba28 97 }
jksoft 0:d0b3a5d1ba28 98 //---
jksoft 0:d0b3a5d1ba28 99 // blocking case
jksoft 0:d0b3a5d1ba28 100 else {
jksoft 0:d0b3a5d1ba28 101 tmr.reset();
jksoft 0:d0b3a5d1ba28 102
jksoft 0:d0b3a5d1ba28 103 while (time < _timeout) {
jksoft 0:d0b3a5d1ba28 104 nb_available = wifi->readable();
jksoft 0:d0b3a5d1ba28 105 if (nb_available < 0) return nb_available;
jksoft 0:d0b3a5d1ba28 106 if (nb_available > 0) break ;
jksoft 0:d0b3a5d1ba28 107 time = tmr.read_ms();
jksoft 0:d0b3a5d1ba28 108 }
jksoft 0:d0b3a5d1ba28 109
jksoft 0:d0b3a5d1ba28 110 if (nb_available == 0) return nb_available;
jksoft 0:d0b3a5d1ba28 111 }
jksoft 0:d0b3a5d1ba28 112
jksoft 0:d0b3a5d1ba28 113 // change this to < 20 mS timeout per byte to detect end of packet gap
jksoft 0:d0b3a5d1ba28 114 // this may not work due to buffering at the UART interface
jksoft 0:d0b3a5d1ba28 115 tmr.reset();
jksoft 0:d0b3a5d1ba28 116 // while ( tmr.read_ms() < 20 ) {
jksoft 0:d0b3a5d1ba28 117 // if ( wifi.readable() && (idx < length) ) {
jksoft 0:d0b3a5d1ba28 118 // buffer[idx++] = wifi->getc();
jksoft 0:d0b3a5d1ba28 119 // tmr.reset();
jksoft 0:d0b3a5d1ba28 120 // }
jksoft 0:d0b3a5d1ba28 121 // if ( idx == length ) {
jksoft 0:d0b3a5d1ba28 122 // break;
jksoft 0:d0b3a5d1ba28 123 // }
jksoft 0:d0b3a5d1ba28 124 // }
jksoft 0:d0b3a5d1ba28 125 //---
jksoft 0:d0b3a5d1ba28 126 while (time < _timeout) {
jksoft 0:d0b3a5d1ba28 127
jksoft 0:d0b3a5d1ba28 128 nb_available = wifi->readable();
jksoft 0:d0b3a5d1ba28 129 //for (int i = 0; i < min(nb_available, length); i++) {
jksoft 0:d0b3a5d1ba28 130 for (int i = 0; i < min(nb_available, (length-idx)); i++) {
jksoft 0:d0b3a5d1ba28 131 buffer[idx] = wifi->getc();
jksoft 0:d0b3a5d1ba28 132 idx++;
jksoft 0:d0b3a5d1ba28 133 }
jksoft 0:d0b3a5d1ba28 134 if (idx == length) {
jksoft 0:d0b3a5d1ba28 135 break;
jksoft 0:d0b3a5d1ba28 136 }
jksoft 0:d0b3a5d1ba28 137 time = tmr.read_ms();
jksoft 0:d0b3a5d1ba28 138 }
jksoft 0:d0b3a5d1ba28 139 //---
jksoft 0:d0b3a5d1ba28 140 readEndpoint(remote);
jksoft 0:d0b3a5d1ba28 141 return (idx == 0) ? -1 : idx;
jksoft 0:d0b3a5d1ba28 142 }
jksoft 0:d0b3a5d1ba28 143
jksoft 0:d0b3a5d1ba28 144 bool UDPSocket::confEndpoint(Endpoint & ep)
jksoft 0:d0b3a5d1ba28 145 {
jksoft 0:d0b3a5d1ba28 146 currentEndpoint = ep;
jksoft 0:d0b3a5d1ba28 147 return true;
jksoft 0:d0b3a5d1ba28 148 }
jksoft 0:d0b3a5d1ba28 149
jksoft 0:d0b3a5d1ba28 150 bool UDPSocket::readEndpoint(Endpoint & ep)
jksoft 0:d0b3a5d1ba28 151 {
jksoft 0:d0b3a5d1ba28 152 ep = currentEndpoint;
jksoft 0:d0b3a5d1ba28 153 return true;
jksoft 0:d0b3a5d1ba28 154 }