takashi kadono / Mbed OS Nucleo446_SSD1331

Dependencies:   ssd1331

Committer:
kadonotakashi
Date:
Thu Oct 11 02:27:46 2018 +0000
Revision:
3:f3764f852aa8
Parent:
0:8fdf9a60065b
Nucreo 446 + SSD1331 test version;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kadonotakashi 0:8fdf9a60065b 1 /* Socket
kadonotakashi 0:8fdf9a60065b 2 * Copyright (c) 2015 ARM Limited
kadonotakashi 0:8fdf9a60065b 3 *
kadonotakashi 0:8fdf9a60065b 4 * Licensed under the Apache License, Version 2.0 (the "License");
kadonotakashi 0:8fdf9a60065b 5 * you may not use this file except in compliance with the License.
kadonotakashi 0:8fdf9a60065b 6 * You may obtain a copy of the License at
kadonotakashi 0:8fdf9a60065b 7 *
kadonotakashi 0:8fdf9a60065b 8 * http://www.apache.org/licenses/LICENSE-2.0
kadonotakashi 0:8fdf9a60065b 9 *
kadonotakashi 0:8fdf9a60065b 10 * Unless required by applicable law or agreed to in writing, software
kadonotakashi 0:8fdf9a60065b 11 * distributed under the License is distributed on an "AS IS" BASIS,
kadonotakashi 0:8fdf9a60065b 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kadonotakashi 0:8fdf9a60065b 13 * See the License for the specific language governing permissions and
kadonotakashi 0:8fdf9a60065b 14 * limitations under the License.
kadonotakashi 0:8fdf9a60065b 15 */
kadonotakashi 0:8fdf9a60065b 16
kadonotakashi 0:8fdf9a60065b 17 #include "SocketAddress.h"
kadonotakashi 0:8fdf9a60065b 18 #include "NetworkInterface.h"
kadonotakashi 0:8fdf9a60065b 19 #include "NetworkStack.h"
kadonotakashi 0:8fdf9a60065b 20 #include <string.h>
kadonotakashi 0:8fdf9a60065b 21 #include <stdio.h>
kadonotakashi 0:8fdf9a60065b 22 #include "ip4string.h"
kadonotakashi 0:8fdf9a60065b 23 #include "ip6string.h"
kadonotakashi 0:8fdf9a60065b 24
kadonotakashi 0:8fdf9a60065b 25
kadonotakashi 0:8fdf9a60065b 26
kadonotakashi 0:8fdf9a60065b 27 static bool ipv6_is_valid(const char *addr)
kadonotakashi 0:8fdf9a60065b 28 {
kadonotakashi 0:8fdf9a60065b 29 // Check each digit for [0-9a-fA-F:]
kadonotakashi 0:8fdf9a60065b 30 // Must also have at least 2 colons
kadonotakashi 0:8fdf9a60065b 31 int colons = 0;
kadonotakashi 0:8fdf9a60065b 32 for (int i = 0; addr[i]; i++) {
kadonotakashi 0:8fdf9a60065b 33 if (!(addr[i] >= '0' && addr[i] <= '9') &&
kadonotakashi 0:8fdf9a60065b 34 !(addr[i] >= 'a' && addr[i] <= 'f') &&
kadonotakashi 0:8fdf9a60065b 35 !(addr[i] >= 'A' && addr[i] <= 'F') &&
kadonotakashi 0:8fdf9a60065b 36 addr[i] != ':') {
kadonotakashi 0:8fdf9a60065b 37 return false;
kadonotakashi 0:8fdf9a60065b 38 }
kadonotakashi 0:8fdf9a60065b 39 if (addr[i] == ':') {
kadonotakashi 0:8fdf9a60065b 40 colons++;
kadonotakashi 0:8fdf9a60065b 41 }
kadonotakashi 0:8fdf9a60065b 42 }
kadonotakashi 0:8fdf9a60065b 43
kadonotakashi 0:8fdf9a60065b 44 return colons >= 2;
kadonotakashi 0:8fdf9a60065b 45 }
kadonotakashi 0:8fdf9a60065b 46
kadonotakashi 0:8fdf9a60065b 47 SocketAddress::SocketAddress(nsapi_addr_t addr, uint16_t port)
kadonotakashi 0:8fdf9a60065b 48 {
kadonotakashi 0:8fdf9a60065b 49 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 50 set_addr(addr);
kadonotakashi 0:8fdf9a60065b 51 set_port(port);
kadonotakashi 0:8fdf9a60065b 52 }
kadonotakashi 0:8fdf9a60065b 53
kadonotakashi 0:8fdf9a60065b 54 SocketAddress::SocketAddress(const char *addr, uint16_t port)
kadonotakashi 0:8fdf9a60065b 55 {
kadonotakashi 0:8fdf9a60065b 56 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 57 set_ip_address(addr);
kadonotakashi 0:8fdf9a60065b 58 set_port(port);
kadonotakashi 0:8fdf9a60065b 59 }
kadonotakashi 0:8fdf9a60065b 60
kadonotakashi 0:8fdf9a60065b 61 SocketAddress::SocketAddress(const void *bytes, nsapi_version_t version, uint16_t port)
kadonotakashi 0:8fdf9a60065b 62 {
kadonotakashi 0:8fdf9a60065b 63 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 64 set_ip_bytes(bytes, version);
kadonotakashi 0:8fdf9a60065b 65 set_port(port);
kadonotakashi 0:8fdf9a60065b 66 }
kadonotakashi 0:8fdf9a60065b 67
kadonotakashi 0:8fdf9a60065b 68 SocketAddress::SocketAddress(const SocketAddress &addr)
kadonotakashi 0:8fdf9a60065b 69 {
kadonotakashi 0:8fdf9a60065b 70 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 71 set_addr(addr.get_addr());
kadonotakashi 0:8fdf9a60065b 72 set_port(addr.get_port());
kadonotakashi 0:8fdf9a60065b 73 }
kadonotakashi 0:8fdf9a60065b 74
kadonotakashi 0:8fdf9a60065b 75 bool SocketAddress::set_ip_address(const char *addr)
kadonotakashi 0:8fdf9a60065b 76 {
kadonotakashi 0:8fdf9a60065b 77 delete[] _ip_address;
kadonotakashi 0:8fdf9a60065b 78 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 79
kadonotakashi 0:8fdf9a60065b 80 if (addr && stoip4(addr, strlen(addr), _addr.bytes)) {
kadonotakashi 0:8fdf9a60065b 81 _addr.version = NSAPI_IPv4;
kadonotakashi 0:8fdf9a60065b 82 return true;
kadonotakashi 0:8fdf9a60065b 83 } else if (addr && ipv6_is_valid(addr)) {
kadonotakashi 0:8fdf9a60065b 84 _addr.version = NSAPI_IPv6;
kadonotakashi 0:8fdf9a60065b 85 stoip6(addr, strlen(addr), _addr.bytes);
kadonotakashi 0:8fdf9a60065b 86 return true;
kadonotakashi 0:8fdf9a60065b 87 } else {
kadonotakashi 0:8fdf9a60065b 88 _addr = nsapi_addr_t();
kadonotakashi 0:8fdf9a60065b 89 return false;
kadonotakashi 0:8fdf9a60065b 90 }
kadonotakashi 0:8fdf9a60065b 91 }
kadonotakashi 0:8fdf9a60065b 92
kadonotakashi 0:8fdf9a60065b 93 void SocketAddress::set_ip_bytes(const void *bytes, nsapi_version_t version)
kadonotakashi 0:8fdf9a60065b 94 {
kadonotakashi 0:8fdf9a60065b 95 nsapi_addr_t addr;
kadonotakashi 0:8fdf9a60065b 96
kadonotakashi 0:8fdf9a60065b 97 addr = nsapi_addr_t();
kadonotakashi 0:8fdf9a60065b 98 addr.version = version;
kadonotakashi 0:8fdf9a60065b 99 if (version == NSAPI_IPv6) {
kadonotakashi 0:8fdf9a60065b 100 memcpy(addr.bytes, bytes, NSAPI_IPv6_BYTES);
kadonotakashi 0:8fdf9a60065b 101 } else if (version == NSAPI_IPv4) {
kadonotakashi 0:8fdf9a60065b 102 memcpy(addr.bytes, bytes, NSAPI_IPv4_BYTES);
kadonotakashi 0:8fdf9a60065b 103 }
kadonotakashi 0:8fdf9a60065b 104 set_addr(addr);
kadonotakashi 0:8fdf9a60065b 105 }
kadonotakashi 0:8fdf9a60065b 106
kadonotakashi 0:8fdf9a60065b 107 void SocketAddress::set_addr(nsapi_addr_t addr)
kadonotakashi 0:8fdf9a60065b 108 {
kadonotakashi 0:8fdf9a60065b 109 delete[] _ip_address;
kadonotakashi 0:8fdf9a60065b 110 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 111 _addr = addr;
kadonotakashi 0:8fdf9a60065b 112 }
kadonotakashi 0:8fdf9a60065b 113
kadonotakashi 0:8fdf9a60065b 114 void SocketAddress::set_port(uint16_t port)
kadonotakashi 0:8fdf9a60065b 115 {
kadonotakashi 0:8fdf9a60065b 116 _port = port;
kadonotakashi 0:8fdf9a60065b 117 }
kadonotakashi 0:8fdf9a60065b 118
kadonotakashi 0:8fdf9a60065b 119 const char *SocketAddress::get_ip_address() const
kadonotakashi 0:8fdf9a60065b 120 {
kadonotakashi 0:8fdf9a60065b 121 if (_addr.version == NSAPI_UNSPEC) {
kadonotakashi 0:8fdf9a60065b 122 return NULL;
kadonotakashi 0:8fdf9a60065b 123 }
kadonotakashi 0:8fdf9a60065b 124
kadonotakashi 0:8fdf9a60065b 125 if (!_ip_address) {
kadonotakashi 0:8fdf9a60065b 126 _ip_address = new char[NSAPI_IP_SIZE];
kadonotakashi 0:8fdf9a60065b 127 if (_addr.version == NSAPI_IPv4) {
kadonotakashi 0:8fdf9a60065b 128 ip4tos(_addr.bytes, _ip_address);
kadonotakashi 0:8fdf9a60065b 129 } else if (_addr.version == NSAPI_IPv6) {
kadonotakashi 0:8fdf9a60065b 130 ip6tos(_addr.bytes, _ip_address);
kadonotakashi 0:8fdf9a60065b 131 }
kadonotakashi 0:8fdf9a60065b 132 }
kadonotakashi 0:8fdf9a60065b 133
kadonotakashi 0:8fdf9a60065b 134 return _ip_address;
kadonotakashi 0:8fdf9a60065b 135 }
kadonotakashi 0:8fdf9a60065b 136
kadonotakashi 0:8fdf9a60065b 137 const void *SocketAddress::get_ip_bytes() const
kadonotakashi 0:8fdf9a60065b 138 {
kadonotakashi 0:8fdf9a60065b 139 return _addr.bytes;
kadonotakashi 0:8fdf9a60065b 140 }
kadonotakashi 0:8fdf9a60065b 141
kadonotakashi 0:8fdf9a60065b 142 nsapi_version_t SocketAddress::get_ip_version() const
kadonotakashi 0:8fdf9a60065b 143 {
kadonotakashi 0:8fdf9a60065b 144 return _addr.version;
kadonotakashi 0:8fdf9a60065b 145 }
kadonotakashi 0:8fdf9a60065b 146
kadonotakashi 0:8fdf9a60065b 147 nsapi_addr_t SocketAddress::get_addr() const
kadonotakashi 0:8fdf9a60065b 148 {
kadonotakashi 0:8fdf9a60065b 149 return _addr;
kadonotakashi 0:8fdf9a60065b 150 }
kadonotakashi 0:8fdf9a60065b 151
kadonotakashi 0:8fdf9a60065b 152 uint16_t SocketAddress::get_port() const
kadonotakashi 0:8fdf9a60065b 153 {
kadonotakashi 0:8fdf9a60065b 154 return _port;
kadonotakashi 0:8fdf9a60065b 155 }
kadonotakashi 0:8fdf9a60065b 156
kadonotakashi 0:8fdf9a60065b 157 SocketAddress::operator bool() const
kadonotakashi 0:8fdf9a60065b 158 {
kadonotakashi 0:8fdf9a60065b 159 if (_addr.version == NSAPI_IPv4) {
kadonotakashi 0:8fdf9a60065b 160 for (int i = 0; i < NSAPI_IPv4_BYTES; i++) {
kadonotakashi 0:8fdf9a60065b 161 if (_addr.bytes[i]) {
kadonotakashi 0:8fdf9a60065b 162 return true;
kadonotakashi 0:8fdf9a60065b 163 }
kadonotakashi 0:8fdf9a60065b 164 }
kadonotakashi 0:8fdf9a60065b 165
kadonotakashi 0:8fdf9a60065b 166 return false;
kadonotakashi 0:8fdf9a60065b 167 } else if (_addr.version == NSAPI_IPv6) {
kadonotakashi 0:8fdf9a60065b 168 for (int i = 0; i < NSAPI_IPv6_BYTES; i++) {
kadonotakashi 0:8fdf9a60065b 169 if (_addr.bytes[i]) {
kadonotakashi 0:8fdf9a60065b 170 return true;
kadonotakashi 0:8fdf9a60065b 171 }
kadonotakashi 0:8fdf9a60065b 172 }
kadonotakashi 0:8fdf9a60065b 173
kadonotakashi 0:8fdf9a60065b 174 return false;
kadonotakashi 0:8fdf9a60065b 175 } else {
kadonotakashi 0:8fdf9a60065b 176 return false;
kadonotakashi 0:8fdf9a60065b 177 }
kadonotakashi 0:8fdf9a60065b 178 }
kadonotakashi 0:8fdf9a60065b 179
kadonotakashi 0:8fdf9a60065b 180 SocketAddress &SocketAddress::operator=(const SocketAddress &addr)
kadonotakashi 0:8fdf9a60065b 181 {
kadonotakashi 0:8fdf9a60065b 182 delete[] _ip_address;
kadonotakashi 0:8fdf9a60065b 183 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 184 set_addr(addr.get_addr());
kadonotakashi 0:8fdf9a60065b 185 set_port(addr.get_port());
kadonotakashi 0:8fdf9a60065b 186 return *this;
kadonotakashi 0:8fdf9a60065b 187 }
kadonotakashi 0:8fdf9a60065b 188
kadonotakashi 0:8fdf9a60065b 189 bool operator==(const SocketAddress &a, const SocketAddress &b)
kadonotakashi 0:8fdf9a60065b 190 {
kadonotakashi 0:8fdf9a60065b 191 if (!a && !b) {
kadonotakashi 0:8fdf9a60065b 192 return true;
kadonotakashi 0:8fdf9a60065b 193 } else if (a._addr.version != b._addr.version) {
kadonotakashi 0:8fdf9a60065b 194 return false;
kadonotakashi 0:8fdf9a60065b 195 } else if (a._addr.version == NSAPI_IPv4) {
kadonotakashi 0:8fdf9a60065b 196 return memcmp(a._addr.bytes, b._addr.bytes, NSAPI_IPv4_BYTES) == 0;
kadonotakashi 0:8fdf9a60065b 197 } else if (a._addr.version == NSAPI_IPv6) {
kadonotakashi 0:8fdf9a60065b 198 return memcmp(a._addr.bytes, b._addr.bytes, NSAPI_IPv6_BYTES) == 0;
kadonotakashi 0:8fdf9a60065b 199 }
kadonotakashi 0:8fdf9a60065b 200
kadonotakashi 0:8fdf9a60065b 201 MBED_UNREACHABLE;
kadonotakashi 0:8fdf9a60065b 202 }
kadonotakashi 0:8fdf9a60065b 203
kadonotakashi 0:8fdf9a60065b 204 bool operator!=(const SocketAddress &a, const SocketAddress &b)
kadonotakashi 0:8fdf9a60065b 205 {
kadonotakashi 0:8fdf9a60065b 206 return !(a == b);
kadonotakashi 0:8fdf9a60065b 207 }
kadonotakashi 0:8fdf9a60065b 208
kadonotakashi 0:8fdf9a60065b 209 void SocketAddress::_SocketAddress(NetworkStack *iface, const char *host, uint16_t port)
kadonotakashi 0:8fdf9a60065b 210 {
kadonotakashi 0:8fdf9a60065b 211 _ip_address = NULL;
kadonotakashi 0:8fdf9a60065b 212
kadonotakashi 0:8fdf9a60065b 213 // gethostbyname must check for literals, so can call it directly
kadonotakashi 0:8fdf9a60065b 214 int err = iface->gethostbyname(host, this);
kadonotakashi 0:8fdf9a60065b 215 _port = port;
kadonotakashi 0:8fdf9a60065b 216 if (err) {
kadonotakashi 0:8fdf9a60065b 217 _addr = nsapi_addr_t();
kadonotakashi 0:8fdf9a60065b 218 _port = 0;
kadonotakashi 0:8fdf9a60065b 219 }
kadonotakashi 0:8fdf9a60065b 220 }
kadonotakashi 0:8fdf9a60065b 221
kadonotakashi 0:8fdf9a60065b 222 SocketAddress::~SocketAddress()
kadonotakashi 0:8fdf9a60065b 223 {
kadonotakashi 0:8fdf9a60065b 224 delete[] _ip_address;
kadonotakashi 0:8fdf9a60065b 225 }