David Fletcher / Mbed 2 deprecated cc3100_Test_websock_Camera_CM4F

Dependencies:   mbed

Committer:
dflet
Date:
Wed Jun 24 09:54:16 2015 +0000
Revision:
0:50cedd586816
Child:
19:3dd3e7f30f8b
First commit work in progress

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dflet 0:50cedd586816 1 /*
dflet 0:50cedd586816 2 * socket.c - CC31xx/CC32xx Host Driver Implementation
dflet 0:50cedd586816 3 *
dflet 0:50cedd586816 4 * Copyright (C) 2014 Texas Instruments Incorporated - http://www.ti.com/
dflet 0:50cedd586816 5 *
dflet 0:50cedd586816 6 *
dflet 0:50cedd586816 7 * Redistribution and use in source and binary forms, with or without
dflet 0:50cedd586816 8 * modification, are permitted provided that the following conditions
dflet 0:50cedd586816 9 * are met:
dflet 0:50cedd586816 10 *
dflet 0:50cedd586816 11 * Redistributions of source code must retain the above copyright
dflet 0:50cedd586816 12 * notice, this list of conditions and the following disclaimer.
dflet 0:50cedd586816 13 *
dflet 0:50cedd586816 14 * Redistributions in binary form must reproduce the above copyright
dflet 0:50cedd586816 15 * notice, this list of conditions and the following disclaimer in the
dflet 0:50cedd586816 16 * documentation and/or other materials provided with the
dflet 0:50cedd586816 17 * distribution.
dflet 0:50cedd586816 18 *
dflet 0:50cedd586816 19 * Neither the name of Texas Instruments Incorporated nor the names of
dflet 0:50cedd586816 20 * its contributors may be used to endorse or promote products derived
dflet 0:50cedd586816 21 * from this software without specific prior written permission.
dflet 0:50cedd586816 22 *
dflet 0:50cedd586816 23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
dflet 0:50cedd586816 24 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
dflet 0:50cedd586816 25 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
dflet 0:50cedd586816 26 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
dflet 0:50cedd586816 27 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
dflet 0:50cedd586816 28 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
dflet 0:50cedd586816 29 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
dflet 0:50cedd586816 30 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
dflet 0:50cedd586816 31 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
dflet 0:50cedd586816 32 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
dflet 0:50cedd586816 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
dflet 0:50cedd586816 34 *
dflet 0:50cedd586816 35 */
dflet 0:50cedd586816 36
dflet 0:50cedd586816 37
dflet 0:50cedd586816 38
dflet 0:50cedd586816 39
dflet 0:50cedd586816 40 /*****************************************************************************/
dflet 0:50cedd586816 41 /* Include files */
dflet 0:50cedd586816 42 /*****************************************************************************/
dflet 0:50cedd586816 43 #include "cc3100_simplelink.h"
dflet 0:50cedd586816 44 #include "cc3100_protocol.h"
dflet 0:50cedd586816 45 #include "cc3100_driver.h"
dflet 0:50cedd586816 46
dflet 0:50cedd586816 47 #include "cc3100_socket.h"
dflet 0:50cedd586816 48 #include "HttpDebug.h"
dflet 0:50cedd586816 49
dflet 0:50cedd586816 50 namespace mbed_cc3100 {
dflet 0:50cedd586816 51
dflet 0:50cedd586816 52 /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48 */
dflet 0:50cedd586816 53 /* is possible as _i32 as these parameters are in the same offset and size for these */
dflet 0:50cedd586816 54 /* three families. */
dflet 0:50cedd586816 55 #define SL_SOCKET_PAYLOAD_BASE (1350)
dflet 0:50cedd586816 56
dflet 0:50cedd586816 57 const uint8_t _SlPayloadByProtocolLUT[16] =
dflet 0:50cedd586816 58 {
dflet 0:50cedd586816 59 (1472 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV4 */
dflet 0:50cedd586816 60 (1460 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV4 */
dflet 0:50cedd586816 61 (1452 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV6 */
dflet 0:50cedd586816 62 (1440 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV6 */
dflet 0:50cedd586816 63 (1386 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV4_SECURE */
dflet 0:50cedd586816 64 (1386 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV4_SECURE */
dflet 0:50cedd586816 65 (1396 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV6_SECURE */
dflet 0:50cedd586816 66 (1396 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV6_SECURE */
dflet 0:50cedd586816 67 (1476 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_TRANCEIVER */
dflet 0:50cedd586816 68 (1514 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_PACKET */
dflet 0:50cedd586816 69 (1480 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_IP4 */
dflet 0:50cedd586816 70 (1480 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_IP6 */
dflet 0:50cedd586816 71 (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */
dflet 0:50cedd586816 72 (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */
dflet 0:50cedd586816 73 (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */
dflet 0:50cedd586816 74 (1440 - SL_SOCKET_PAYLOAD_BASE) /* Default */
dflet 0:50cedd586816 75 };
dflet 0:50cedd586816 76
dflet 0:50cedd586816 77 #ifndef SL_PLATFORM_MULTI_THREADED
dflet 0:50cedd586816 78 cc3100_socket::cc3100_socket(cc3100_driver &driver, cc3100_nonos &nonos)
dflet 0:50cedd586816 79 : _driver(driver), _nonos(nonos)
dflet 0:50cedd586816 80 {
dflet 0:50cedd586816 81 }
dflet 0:50cedd586816 82 #else
dflet 0:50cedd586816 83 cc3100_socket::cc3100_socket(cc3100_driver &driver)
dflet 0:50cedd586816 84 : _driver(driver)
dflet 0:50cedd586816 85 {
dflet 0:50cedd586816 86 }
dflet 0:50cedd586816 87 #endif
dflet 0:50cedd586816 88 cc3100_socket::~cc3100_socket()
dflet 0:50cedd586816 89 {
dflet 0:50cedd586816 90
dflet 0:50cedd586816 91 }
dflet 0:50cedd586816 92
dflet 0:50cedd586816 93 /*******************************************************************************/
dflet 0:50cedd586816 94 /* Functions */
dflet 0:50cedd586816 95 /*******************************************************************************/
dflet 0:50cedd586816 96
dflet 0:50cedd586816 97 /* ******************************************************************************/
dflet 0:50cedd586816 98 /* _sl_BuildAddress */
dflet 0:50cedd586816 99 /* ******************************************************************************/
dflet 0:50cedd586816 100 void cc3100_socket::_sl_BuildAddress(const SlSockAddr_t *addr, _SocketAddrCommand_u *pCmd)
dflet 0:50cedd586816 101 {
dflet 0:50cedd586816 102 /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48
dflet 0:50cedd586816 103 is possible as long as these parameters are in the same offset and size for these
dflet 0:50cedd586816 104 three families. */
dflet 0:50cedd586816 105 pCmd->IpV4.FamilyAndFlags = (addr->sa_family << 4) & 0xF0;
dflet 0:50cedd586816 106 pCmd->IpV4.port = ((SlSockAddrIn_t *)addr)->sin_port;
dflet 0:50cedd586816 107
dflet 0:50cedd586816 108 if(SL_AF_INET == addr->sa_family) {
dflet 0:50cedd586816 109 pCmd->IpV4.address = ((SlSockAddrIn_t *)addr)->sin_addr.s_addr;
dflet 0:50cedd586816 110 } else if (SL_AF_INET6_EUI_48 == addr->sa_family ) {
dflet 0:50cedd586816 111 memcpy( pCmd->IpV6EUI48.address,((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, 6);
dflet 0:50cedd586816 112 }
dflet 0:50cedd586816 113 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 114 else {
dflet 0:50cedd586816 115 memcpy(pCmd->IpV6.address, ((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, 16 );
dflet 0:50cedd586816 116 }
dflet 0:50cedd586816 117 #endif
dflet 0:50cedd586816 118 }
dflet 0:50cedd586816 119
dflet 0:50cedd586816 120 /* ******************************************************************************/
dflet 0:50cedd586816 121 /* _sl_TruncatePayloadByProtocol */
dflet 0:50cedd586816 122 /* ******************************************************************************/
dflet 0:50cedd586816 123 uint16_t cc3100_socket::_sl_TruncatePayloadByProtocol(const int16_t sd,const uint16_t length)
dflet 0:50cedd586816 124 {
dflet 0:50cedd586816 125
dflet 0:50cedd586816 126 uint32_t maxLength;
dflet 0:50cedd586816 127
dflet 0:50cedd586816 128 maxLength = SL_SOCKET_PAYLOAD_BASE + _SlPayloadByProtocolLUT[((sd & SL_SOCKET_PAYLOAD_TYPE_MASK) >> 4)];
dflet 0:50cedd586816 129
dflet 0:50cedd586816 130 if( length > maxLength )
dflet 0:50cedd586816 131 {
dflet 0:50cedd586816 132 return maxLength;
dflet 0:50cedd586816 133 }
dflet 0:50cedd586816 134 else
dflet 0:50cedd586816 135 {
dflet 0:50cedd586816 136 return length;
dflet 0:50cedd586816 137 }
dflet 0:50cedd586816 138
dflet 0:50cedd586816 139 }
dflet 0:50cedd586816 140
dflet 0:50cedd586816 141 /*******************************************************************************/
dflet 0:50cedd586816 142 /* _sl_ParseAddress */
dflet 0:50cedd586816 143 /*******************************************************************************/
dflet 0:50cedd586816 144 #ifndef SL_TINY_EXT
dflet 0:50cedd586816 145 void cc3100_socket::_sl_ParseAddress(_SocketAddrResponse_u *pRsp, SlSockAddr_t *addr, SlSocklen_t *addrlen)
dflet 0:50cedd586816 146 {
dflet 0:50cedd586816 147 /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48 */
dflet 0:50cedd586816 148 /* is possible as long as these parameters are in the same offset and size for these */
dflet 0:50cedd586816 149 /* three families. */
dflet 0:50cedd586816 150 addr->sa_family = pRsp->IpV4.family;
dflet 0:50cedd586816 151 ((SlSockAddrIn_t *)addr)->sin_port = pRsp->IpV4.port;
dflet 0:50cedd586816 152
dflet 0:50cedd586816 153 *addrlen = (SL_AF_INET == addr->sa_family) ? sizeof(SlSockAddrIn_t) : sizeof(SlSockAddrIn6_t);
dflet 0:50cedd586816 154
dflet 0:50cedd586816 155 if(SL_AF_INET == addr->sa_family) {
dflet 0:50cedd586816 156 ((SlSockAddrIn_t *)addr)->sin_addr.s_addr = pRsp->IpV4.address;
dflet 0:50cedd586816 157 } else if (SL_AF_INET6_EUI_48 == addr->sa_family ) {
dflet 0:50cedd586816 158 memcpy(((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, pRsp->IpV6EUI48.address, 6);
dflet 0:50cedd586816 159 }
dflet 0:50cedd586816 160 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 161 else {
dflet 0:50cedd586816 162 memcpy(((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, pRsp->IpV6.address, 16);
dflet 0:50cedd586816 163 }
dflet 0:50cedd586816 164 #endif
dflet 0:50cedd586816 165 }
dflet 0:50cedd586816 166 #endif
dflet 0:50cedd586816 167
dflet 0:50cedd586816 168 /*******************************************************************************/
dflet 0:50cedd586816 169 /* sl_Socket */
dflet 0:50cedd586816 170 /*******************************************************************************/
dflet 0:50cedd586816 171 typedef union {
dflet 0:50cedd586816 172 uint32_t Dummy;
dflet 0:50cedd586816 173 _SocketCommand_t Cmd;
dflet 0:50cedd586816 174 _SocketResponse_t Rsp;
dflet 0:50cedd586816 175 } _SlSockSocketMsg_u;
dflet 0:50cedd586816 176
dflet 0:50cedd586816 177 #if _SL_INCLUDE_FUNC(sl_Socket)
dflet 0:50cedd586816 178 const _SlCmdCtrl_t _SlSockSocketCmdCtrl = {
dflet 0:50cedd586816 179 SL_OPCODE_SOCKET_SOCKET,
dflet 0:50cedd586816 180 sizeof(_SocketCommand_t),
dflet 0:50cedd586816 181 sizeof(_SocketResponse_t)
dflet 0:50cedd586816 182 };
dflet 0:50cedd586816 183
dflet 0:50cedd586816 184 int16_t cc3100_socket::sl_Socket(int16_t Domain, int16_t Type, int16_t Protocol)
dflet 0:50cedd586816 185 {
dflet 0:50cedd586816 186 _SlSockSocketMsg_u Msg;
dflet 0:50cedd586816 187
dflet 0:50cedd586816 188 Msg.Cmd.Domain = (uint8_t)Domain;
dflet 0:50cedd586816 189 Msg.Cmd.Type = (uint8_t)Type;
dflet 0:50cedd586816 190 Msg.Cmd.Protocol = (uint8_t)Protocol;
dflet 0:50cedd586816 191
dflet 0:50cedd586816 192 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSockSocketCmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 193
dflet 0:50cedd586816 194 if( Msg.Rsp.statusOrLen < 0 ) {
dflet 0:50cedd586816 195 return( Msg.Rsp.statusOrLen );
dflet 0:50cedd586816 196 } else {
dflet 0:50cedd586816 197 return (int16_t)((uint8_t)Msg.Rsp.sd);
dflet 0:50cedd586816 198 }
dflet 0:50cedd586816 199 }
dflet 0:50cedd586816 200 #endif
dflet 0:50cedd586816 201
dflet 0:50cedd586816 202 /*******************************************************************************/
dflet 0:50cedd586816 203 /* sl_Close */
dflet 0:50cedd586816 204 /*******************************************************************************/
dflet 0:50cedd586816 205 typedef union {
dflet 0:50cedd586816 206 _CloseCommand_t Cmd;
dflet 0:50cedd586816 207 _SocketResponse_t Rsp;
dflet 0:50cedd586816 208 } _SlSockCloseMsg_u;
dflet 0:50cedd586816 209
dflet 0:50cedd586816 210 #if _SL_INCLUDE_FUNC(sl_Close)
dflet 0:50cedd586816 211 const _SlCmdCtrl_t _SlSockCloseCmdCtrl = {
dflet 0:50cedd586816 212 SL_OPCODE_SOCKET_CLOSE,
dflet 0:50cedd586816 213 sizeof(_CloseCommand_t),
dflet 0:50cedd586816 214 sizeof(_SocketResponse_t)
dflet 0:50cedd586816 215 };
dflet 0:50cedd586816 216
dflet 0:50cedd586816 217 int16_t cc3100_socket::sl_Close(int16_t sd)
dflet 0:50cedd586816 218 {
dflet 0:50cedd586816 219 _SlSockCloseMsg_u Msg;
dflet 0:50cedd586816 220
dflet 0:50cedd586816 221 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 222
dflet 0:50cedd586816 223 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSockCloseCmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 224
dflet 0:50cedd586816 225 return Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 226 }
dflet 0:50cedd586816 227 #endif
dflet 0:50cedd586816 228
dflet 0:50cedd586816 229 /*******************************************************************************/
dflet 0:50cedd586816 230 /* sl_Bind */
dflet 0:50cedd586816 231 /*******************************************************************************/
dflet 0:50cedd586816 232 typedef union {
dflet 0:50cedd586816 233 _SocketAddrCommand_u Cmd;
dflet 0:50cedd586816 234 _SocketResponse_t Rsp;
dflet 0:50cedd586816 235 } _SlSockBindMsg_u;
dflet 0:50cedd586816 236
dflet 0:50cedd586816 237 #if _SL_INCLUDE_FUNC(sl_Bind)
dflet 0:50cedd586816 238 int16_t cc3100_socket::sl_Bind(int16_t sd, const SlSockAddr_t *addr, int16_t addrlen)
dflet 0:50cedd586816 239 {
dflet 0:50cedd586816 240 _SlSockBindMsg_u Msg;
dflet 0:50cedd586816 241 _SlCmdCtrl_t CmdCtrl = {0, 0, sizeof(_SocketResponse_t)};
dflet 0:50cedd586816 242
dflet 0:50cedd586816 243 switch(addr->sa_family) {
dflet 0:50cedd586816 244 case SL_AF_INET :
dflet 0:50cedd586816 245 CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND;
dflet 0:50cedd586816 246 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv4Command_t);
dflet 0:50cedd586816 247 break;
dflet 0:50cedd586816 248 #ifndef SL_TINY_EXT
dflet 0:50cedd586816 249 case SL_AF_INET6_EUI_48:
dflet 0:50cedd586816 250 CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6;
dflet 0:50cedd586816 251 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6EUI48Command_t);
dflet 0:50cedd586816 252 break;
dflet 0:50cedd586816 253 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 254 case AF_INET6:
dflet 0:50cedd586816 255 CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6;
dflet 0:50cedd586816 256 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6Command_t);
dflet 0:50cedd586816 257 break;
dflet 0:50cedd586816 258 #endif
dflet 0:50cedd586816 259 #endif
dflet 0:50cedd586816 260 case SL_AF_RF :
dflet 0:50cedd586816 261 default:
dflet 0:50cedd586816 262 return SL_RET_CODE_INVALID_INPUT;
dflet 0:50cedd586816 263 }
dflet 0:50cedd586816 264
dflet 0:50cedd586816 265 Msg.Cmd.IpV4.lenOrPadding = 0;
dflet 0:50cedd586816 266 Msg.Cmd.IpV4.sd = (uint8_t)sd;
dflet 0:50cedd586816 267
dflet 0:50cedd586816 268 _sl_BuildAddress(addr, &Msg.Cmd);
dflet 0:50cedd586816 269
dflet 0:50cedd586816 270 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&CmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 271
dflet 0:50cedd586816 272 return Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 273 }
dflet 0:50cedd586816 274 #endif
dflet 0:50cedd586816 275
dflet 0:50cedd586816 276 /*******************************************************************************/
dflet 0:50cedd586816 277 /* sl_Sendto */
dflet 0:50cedd586816 278 /*******************************************************************************/
dflet 0:50cedd586816 279 typedef union {
dflet 0:50cedd586816 280 _SocketAddrCommand_u Cmd;
dflet 0:50cedd586816 281 /* no response for 'sendto' commands*/
dflet 0:50cedd586816 282 } _SlSendtoMsg_u;
dflet 0:50cedd586816 283
dflet 0:50cedd586816 284 #if _SL_INCLUDE_FUNC(sl_SendTo)
dflet 0:50cedd586816 285 int16_t cc3100_socket::sl_SendTo(int16_t sd, const void *pBuf, int16_t Len, int16_t flags, const SlSockAddr_t *to, SlSocklen_t tolen)
dflet 0:50cedd586816 286 {
dflet 0:50cedd586816 287 _SlSendtoMsg_u Msg;
dflet 0:50cedd586816 288 _SlCmdCtrl_t CmdCtrl = {0, 0, 0};
dflet 0:50cedd586816 289 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 290 uint16_t ChunkLen;
dflet 0:50cedd586816 291 int16_t RetVal;
dflet 0:50cedd586816 292
dflet 0:50cedd586816 293 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 294 CmdExt.TxPayloadLen = (uint16_t)Len;
dflet 0:50cedd586816 295 CmdExt.pTxPayload = (uint8_t *)pBuf;
dflet 0:50cedd586816 296
dflet 0:50cedd586816 297 switch(to->sa_family) {
dflet 0:50cedd586816 298 case SL_AF_INET:
dflet 0:50cedd586816 299 CmdCtrl.Opcode = SL_OPCODE_SOCKET_SENDTO;
dflet 0:50cedd586816 300 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv4Command_t);
dflet 0:50cedd586816 301 break;
dflet 0:50cedd586816 302 #ifndef SL_TINY_EXT
dflet 0:50cedd586816 303 case SL_AF_INET6_EUI_48:
dflet 0:50cedd586816 304 CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6;
dflet 0:50cedd586816 305 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6EUI48Command_t);
dflet 0:50cedd586816 306 break;
dflet 0:50cedd586816 307 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 308 case AF_INET6:
dflet 0:50cedd586816 309 CmdCtrl.Opcode = SL_OPCODE_SOCKET_SENDTO_V6;
dflet 0:50cedd586816 310 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6Command_t);
dflet 0:50cedd586816 311 break;
dflet 0:50cedd586816 312 #endif
dflet 0:50cedd586816 313 #endif
dflet 0:50cedd586816 314 case SL_AF_RF:
dflet 0:50cedd586816 315 default:
dflet 0:50cedd586816 316 return SL_RET_CODE_INVALID_INPUT;
dflet 0:50cedd586816 317 }
dflet 0:50cedd586816 318
dflet 0:50cedd586816 319 ChunkLen = _sl_TruncatePayloadByProtocol(sd,Len);
dflet 0:50cedd586816 320 Msg.Cmd.IpV4.lenOrPadding = ChunkLen;
dflet 0:50cedd586816 321 CmdExt.TxPayloadLen = ChunkLen;
dflet 0:50cedd586816 322
dflet 0:50cedd586816 323 Msg.Cmd.IpV4.sd = (unsigned char)sd;
dflet 0:50cedd586816 324
dflet 0:50cedd586816 325 _sl_BuildAddress(to, &Msg.Cmd);
dflet 0:50cedd586816 326
dflet 0:50cedd586816 327 Msg.Cmd.IpV4.FamilyAndFlags |= flags & 0x0F;
dflet 0:50cedd586816 328
dflet 0:50cedd586816 329 do {
dflet 0:50cedd586816 330 RetVal = _driver._SlDrvDataWriteOp((_SlSd_t)sd, &CmdCtrl, &Msg, &CmdExt);
dflet 0:50cedd586816 331
dflet 0:50cedd586816 332 if(SL_OS_RET_CODE_OK == RetVal) {
dflet 0:50cedd586816 333 CmdExt.pTxPayload += ChunkLen;
dflet 0:50cedd586816 334 ChunkLen = (uint16_t)((unsigned char *)pBuf + Len - CmdExt.pTxPayload);
dflet 0:50cedd586816 335 ChunkLen = _sl_TruncatePayloadByProtocol(sd,ChunkLen);
dflet 0:50cedd586816 336 CmdExt.TxPayloadLen = ChunkLen;
dflet 0:50cedd586816 337 Msg.Cmd.IpV4.lenOrPadding = ChunkLen;
dflet 0:50cedd586816 338 } else {
dflet 0:50cedd586816 339 return RetVal;
dflet 0:50cedd586816 340 }
dflet 0:50cedd586816 341 } while(ChunkLen > 0);
dflet 0:50cedd586816 342
dflet 0:50cedd586816 343 return (int16_t)Len;
dflet 0:50cedd586816 344 }
dflet 0:50cedd586816 345 #endif
dflet 0:50cedd586816 346
dflet 0:50cedd586816 347 /*******************************************************************************/
dflet 0:50cedd586816 348 /* sl_Recvfrom */
dflet 0:50cedd586816 349 /*******************************************************************************/
dflet 0:50cedd586816 350 typedef union {
dflet 0:50cedd586816 351 _sendRecvCommand_t Cmd;
dflet 0:50cedd586816 352 _SocketAddrResponse_u Rsp;
dflet 0:50cedd586816 353 } _SlRecvfromMsg_u;
dflet 0:50cedd586816 354
dflet 0:50cedd586816 355 const _SlCmdCtrl_t _SlRecvfomCmdCtrl = {
dflet 0:50cedd586816 356 SL_OPCODE_SOCKET_RECVFROM,
dflet 0:50cedd586816 357 sizeof(_sendRecvCommand_t),
dflet 0:50cedd586816 358 sizeof(_SocketAddrResponse_u)
dflet 0:50cedd586816 359 };
dflet 0:50cedd586816 360
dflet 0:50cedd586816 361 #if _SL_INCLUDE_FUNC(sl_RecvFrom)
dflet 0:50cedd586816 362 int16_t cc3100_socket::sl_RecvFrom(int16_t sd, void *buf, int16_t Len, int16_t flags, SlSockAddr_t *from, SlSocklen_t *fromlen)
dflet 0:50cedd586816 363 {
dflet 0:50cedd586816 364 _SlRecvfromMsg_u Msg;
dflet 0:50cedd586816 365 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 366 int16_t RetVal;
dflet 0:50cedd586816 367
dflet 0:50cedd586816 368 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 369 CmdExt.RxPayloadLen = Len;
dflet 0:50cedd586816 370 CmdExt.pRxPayload = (uint8_t *)buf;
dflet 0:50cedd586816 371
dflet 0:50cedd586816 372 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 373 Msg.Cmd.StatusOrLen = Len;
dflet 0:50cedd586816 374 /* no size truncation in recv path */
dflet 0:50cedd586816 375 CmdExt.RxPayloadLen = Msg.Cmd.StatusOrLen;
dflet 0:50cedd586816 376
dflet 0:50cedd586816 377 Msg.Cmd.FamilyAndFlags = flags & 0x0F;
dflet 0:50cedd586816 378
dflet 0:50cedd586816 379 if(sizeof(SlSockAddrIn_t) == *fromlen) {
dflet 0:50cedd586816 380 Msg.Cmd.FamilyAndFlags |= (SL_AF_INET << 4);
dflet 0:50cedd586816 381 }
dflet 0:50cedd586816 382 else if (sizeof(SlSockAddrIn6_t) == *fromlen)
dflet 0:50cedd586816 383 {
dflet 0:50cedd586816 384 Msg.Cmd.FamilyAndFlags |= (SL_AF_INET6 << 4);
dflet 0:50cedd586816 385 }
dflet 0:50cedd586816 386 else
dflet 0:50cedd586816 387 {
dflet 0:50cedd586816 388 return SL_RET_CODE_INVALID_INPUT;
dflet 0:50cedd586816 389 }
dflet 0:50cedd586816 390
dflet 0:50cedd586816 391 RetVal = _driver._SlDrvDataReadOp((_SlSd_t)sd, (_SlCmdCtrl_t *)&_SlRecvfomCmdCtrl, &Msg, &CmdExt);
dflet 0:50cedd586816 392
dflet 0:50cedd586816 393 if( RetVal != SL_OS_RET_CODE_OK ) {
dflet 0:50cedd586816 394 return RetVal;
dflet 0:50cedd586816 395 }
dflet 0:50cedd586816 396
dflet 0:50cedd586816 397 RetVal = Msg.Rsp.IpV4.statusOrLen;
dflet 0:50cedd586816 398
dflet 0:50cedd586816 399 if(RetVal >= 0) {
dflet 0:50cedd586816 400 VERIFY_PROTOCOL(sd == Msg.Rsp.IpV4.sd);
dflet 0:50cedd586816 401 #if 0
dflet 0:50cedd586816 402 _sl_ParseAddress(&Msg.Rsp, from, fromlen);
dflet 0:50cedd586816 403 #else
dflet 0:50cedd586816 404 from->sa_family = Msg.Rsp.IpV4.family;
dflet 0:50cedd586816 405 if(SL_AF_INET == from->sa_family) {
dflet 0:50cedd586816 406 ((SlSockAddrIn_t *)from)->sin_port = Msg.Rsp.IpV4.port;
dflet 0:50cedd586816 407 ((SlSockAddrIn_t *)from)->sin_addr.s_addr = Msg.Rsp.IpV4.address;
dflet 0:50cedd586816 408 *fromlen = sizeof(SlSockAddrIn_t);
dflet 0:50cedd586816 409 } else if (SL_AF_INET6_EUI_48 == from->sa_family ) {
dflet 0:50cedd586816 410 ((SlSockAddrIn6_t *)from)->sin6_port = Msg.Rsp.IpV6EUI48.port;
dflet 0:50cedd586816 411 memcpy(((SlSockAddrIn6_t *)from)->sin6_addr._S6_un._S6_u8, Msg.Rsp.IpV6EUI48.address, 6);
dflet 0:50cedd586816 412 }
dflet 0:50cedd586816 413 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 414 else if(AF_INET6 == from->sa_family) {
dflet 0:50cedd586816 415 VERIFY_PROTOCOL(*fromlen >= sizeof(sockaddr_in6));
dflet 0:50cedd586816 416
dflet 0:50cedd586816 417 ((sockaddr_in6 *)from)->sin6_port = Msg.Rsp.IpV6.port;
dflet 0:50cedd586816 418 memcpy(((sockaddr_in6 *)from)->sin6_addr._S6_un._S6_u32, Msg.Rsp.IpV6.address, 16);
dflet 0:50cedd586816 419 *fromlen = sizeof(sockaddr_in6);
dflet 0:50cedd586816 420 }
dflet 0:50cedd586816 421 #endif
dflet 0:50cedd586816 422 #endif
dflet 0:50cedd586816 423 }
dflet 0:50cedd586816 424
dflet 0:50cedd586816 425 return (int16_t)RetVal;
dflet 0:50cedd586816 426 }
dflet 0:50cedd586816 427 #endif
dflet 0:50cedd586816 428
dflet 0:50cedd586816 429 /*******************************************************************************/
dflet 0:50cedd586816 430 /* sl_Connect */
dflet 0:50cedd586816 431 /*******************************************************************************/
dflet 0:50cedd586816 432 typedef union {
dflet 0:50cedd586816 433 _SocketAddrCommand_u Cmd;
dflet 0:50cedd586816 434 _SocketResponse_t Rsp;
dflet 0:50cedd586816 435 } _SlSockConnectMsg_u;
dflet 0:50cedd586816 436
dflet 0:50cedd586816 437 #if _SL_INCLUDE_FUNC(sl_Connect)
dflet 0:50cedd586816 438 int16_t cc3100_socket::sl_Connect(int16_t sd, const SlSockAddr_t *addr, int16_t addrlen)
dflet 0:50cedd586816 439 {
dflet 0:50cedd586816 440 _SlSockConnectMsg_u Msg;
dflet 0:50cedd586816 441 _SlReturnVal_t RetVal;
dflet 0:50cedd586816 442 _SlCmdCtrl_t CmdCtrl = {0, 0, sizeof(_SocketResponse_t)};
dflet 0:50cedd586816 443 _SocketResponse_t AsyncRsp;
dflet 0:50cedd586816 444 uint8_t ObjIdx = MAX_CONCURRENT_ACTIONS;
dflet 0:50cedd586816 445
dflet 0:50cedd586816 446
dflet 0:50cedd586816 447 switch(addr->sa_family) {
dflet 0:50cedd586816 448 case SL_AF_INET :
dflet 0:50cedd586816 449 CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT;
dflet 0:50cedd586816 450 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv4Command_t);
dflet 0:50cedd586816 451 /* Do nothing - cmd already initialized to this type */
dflet 0:50cedd586816 452 break;
dflet 0:50cedd586816 453 case SL_AF_INET6_EUI_48:
dflet 0:50cedd586816 454 CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT_V6;
dflet 0:50cedd586816 455 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6EUI48Command_t);
dflet 0:50cedd586816 456 break;
dflet 0:50cedd586816 457 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 458 case AF_INET6:
dflet 0:50cedd586816 459 CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT_V6;
dflet 0:50cedd586816 460 CmdCtrl.TxDescLen = sizeof(_SocketAddrIPv6Command_t);
dflet 0:50cedd586816 461 break;
dflet 0:50cedd586816 462 #endif
dflet 0:50cedd586816 463 case SL_AF_RF :
dflet 0:50cedd586816 464 default:
dflet 0:50cedd586816 465 return SL_RET_CODE_INVALID_INPUT;
dflet 0:50cedd586816 466 }
dflet 0:50cedd586816 467
dflet 0:50cedd586816 468 Msg.Cmd.IpV4.lenOrPadding = 0;
dflet 0:50cedd586816 469 Msg.Cmd.IpV4.sd = (uint8_t)sd;
dflet 0:50cedd586816 470
dflet 0:50cedd586816 471 _sl_BuildAddress(addr, &Msg.Cmd);
dflet 0:50cedd586816 472
dflet 0:50cedd586816 473
dflet 0:50cedd586816 474 ObjIdx = _driver._SlDrvProtectAsyncRespSetting((uint8_t*)&AsyncRsp, CONNECT_ID, sd & BSD_SOCKET_ID_MASK);
dflet 0:50cedd586816 475
dflet 0:50cedd586816 476 if (MAX_CONCURRENT_ACTIONS == ObjIdx)
dflet 0:50cedd586816 477 {
dflet 0:50cedd586816 478 return SL_POOL_IS_EMPTY;
dflet 0:50cedd586816 479 }
dflet 0:50cedd586816 480
dflet 0:50cedd586816 481 /* send the command */
dflet 0:50cedd586816 482 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&CmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 483 VERIFY_PROTOCOL(Msg.Rsp.sd == sd)
dflet 0:50cedd586816 484
dflet 0:50cedd586816 485 RetVal = Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 486
dflet 0:50cedd586816 487 if(SL_RET_CODE_OK == RetVal) {
dflet 0:50cedd586816 488 /* wait for async and get Data Read parameters */
dflet 0:50cedd586816 489 _driver._SlDrvSyncObjWaitForever(&g_pCB->ObjPool[ObjIdx].SyncObj);
dflet 0:50cedd586816 490
dflet 0:50cedd586816 491 VERIFY_PROTOCOL(AsyncRsp.sd == sd);
dflet 0:50cedd586816 492
dflet 0:50cedd586816 493 RetVal = AsyncRsp.statusOrLen;
dflet 0:50cedd586816 494 }
dflet 0:50cedd586816 495 _driver._SlDrvReleasePoolObj(ObjIdx);
dflet 0:50cedd586816 496 return RetVal;
dflet 0:50cedd586816 497 }
dflet 0:50cedd586816 498 #endif
dflet 0:50cedd586816 499
dflet 0:50cedd586816 500 /*******************************************************************************/
dflet 0:50cedd586816 501 /* sl_Send */
dflet 0:50cedd586816 502 /*******************************************************************************/
dflet 0:50cedd586816 503 typedef union {
dflet 0:50cedd586816 504 _sendRecvCommand_t Cmd;
dflet 0:50cedd586816 505 /* no response for 'sendto' commands*/
dflet 0:50cedd586816 506 } _SlSendMsg_u;
dflet 0:50cedd586816 507
dflet 0:50cedd586816 508 const _SlCmdCtrl_t _SlSendCmdCtrl = {
dflet 0:50cedd586816 509 SL_OPCODE_SOCKET_SEND,
dflet 0:50cedd586816 510 sizeof(_sendRecvCommand_t),
dflet 0:50cedd586816 511 0
dflet 0:50cedd586816 512 };
dflet 0:50cedd586816 513
dflet 0:50cedd586816 514 #if _SL_INCLUDE_FUNC(sl_Send)
dflet 0:50cedd586816 515 int16_t cc3100_socket::sl_Send(int16_t sd, const void *pBuf, int16_t Len, int16_t flags)
dflet 0:50cedd586816 516 {
dflet 0:50cedd586816 517 _SlSendMsg_u Msg;
dflet 0:50cedd586816 518 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 519 uint16_t ChunkLen;
dflet 0:50cedd586816 520 int16_t RetVal;
dflet 0:50cedd586816 521 uint32_t tempVal;
dflet 0:50cedd586816 522 uint8_t runSingleChunk = FALSE;
dflet 0:50cedd586816 523
dflet 0:50cedd586816 524 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 525 CmdExt.TxPayloadLen = Len;
dflet 0:50cedd586816 526 CmdExt.pTxPayload = (uint8_t *)pBuf;
dflet 0:50cedd586816 527
dflet 0:50cedd586816 528 /* Only for RAW transceiver type socket, relay the flags parameter in the 2 bytes (4 byte aligned) before the actual payload */
dflet 0:50cedd586816 529 if ((sd & SL_SOCKET_PAYLOAD_TYPE_MASK) == SL_SOCKET_PAYLOAD_TYPE_RAW_TRANCEIVER) {
dflet 0:50cedd586816 530 tempVal = flags;
dflet 0:50cedd586816 531 CmdExt.pRxPayload = (uint8_t *)&tempVal;
dflet 0:50cedd586816 532 CmdExt.RxPayloadLen = -4; /* mark as Rx data to send */
dflet 0:50cedd586816 533 runSingleChunk = TRUE;
dflet 0:50cedd586816 534 } else {
dflet 0:50cedd586816 535 CmdExt.pRxPayload = NULL;
dflet 0:50cedd586816 536 }
dflet 0:50cedd586816 537
dflet 0:50cedd586816 538 ChunkLen = _sl_TruncatePayloadByProtocol(sd,Len);
dflet 0:50cedd586816 539 CmdExt.TxPayloadLen = ChunkLen;
dflet 0:50cedd586816 540
dflet 0:50cedd586816 541 Msg.Cmd.StatusOrLen = ChunkLen;
dflet 0:50cedd586816 542 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 543 Msg.Cmd.FamilyAndFlags |= flags & 0x0F;
dflet 0:50cedd586816 544
dflet 0:50cedd586816 545 do {
dflet 0:50cedd586816 546 RetVal = _driver._SlDrvDataWriteOp((uint8_t)sd, (_SlCmdCtrl_t *)&_SlSendCmdCtrl, &Msg, &CmdExt);
dflet 0:50cedd586816 547 if(SL_OS_RET_CODE_OK == RetVal) {
dflet 0:50cedd586816 548 CmdExt.pTxPayload += ChunkLen;
dflet 0:50cedd586816 549 ChunkLen = (uint8_t *)pBuf + Len - CmdExt.pTxPayload;
dflet 0:50cedd586816 550 ChunkLen = _sl_TruncatePayloadByProtocol(sd,ChunkLen);
dflet 0:50cedd586816 551 CmdExt.TxPayloadLen = ChunkLen;
dflet 0:50cedd586816 552 Msg.Cmd.StatusOrLen = ChunkLen;
dflet 0:50cedd586816 553 } else {
dflet 0:50cedd586816 554 return RetVal;
dflet 0:50cedd586816 555 }
dflet 0:50cedd586816 556 } while((ChunkLen > 0) && (runSingleChunk==FALSE));
dflet 0:50cedd586816 557
dflet 0:50cedd586816 558 return (int16_t)Len;
dflet 0:50cedd586816 559 }
dflet 0:50cedd586816 560 #endif
dflet 0:50cedd586816 561
dflet 0:50cedd586816 562 /*******************************************************************************/
dflet 0:50cedd586816 563 /* sl_Listen */
dflet 0:50cedd586816 564 /*******************************************************************************/
dflet 0:50cedd586816 565 typedef union {
dflet 0:50cedd586816 566 _ListenCommand_t Cmd;
dflet 0:50cedd586816 567 _BasicResponse_t Rsp;
dflet 0:50cedd586816 568 } _SlListenMsg_u;
dflet 0:50cedd586816 569
dflet 0:50cedd586816 570 #if _SL_INCLUDE_FUNC(sl_Listen)
dflet 0:50cedd586816 571 const _SlCmdCtrl_t _SlListenCmdCtrl = {
dflet 0:50cedd586816 572 SL_OPCODE_SOCKET_LISTEN,
dflet 0:50cedd586816 573 sizeof(_ListenCommand_t),
dflet 0:50cedd586816 574 sizeof(_BasicResponse_t),
dflet 0:50cedd586816 575 };
dflet 0:50cedd586816 576
dflet 0:50cedd586816 577 int16_t cc3100_socket::sl_Listen(int16_t sd, int16_t backlog)
dflet 0:50cedd586816 578 {
dflet 0:50cedd586816 579 _SlListenMsg_u Msg;
dflet 0:50cedd586816 580
dflet 0:50cedd586816 581 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 582 Msg.Cmd.backlog = (uint8_t)backlog;
dflet 0:50cedd586816 583
dflet 0:50cedd586816 584 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlListenCmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 585
dflet 0:50cedd586816 586 return (int16_t)Msg.Rsp.status;
dflet 0:50cedd586816 587 }
dflet 0:50cedd586816 588 #endif
dflet 0:50cedd586816 589
dflet 0:50cedd586816 590 /*******************************************************************************/
dflet 0:50cedd586816 591 /* sl_Accept */
dflet 0:50cedd586816 592 /*******************************************************************************/
dflet 0:50cedd586816 593 typedef union {
dflet 0:50cedd586816 594 _AcceptCommand_t Cmd;
dflet 0:50cedd586816 595 _SocketResponse_t Rsp;
dflet 0:50cedd586816 596 } _SlSockAcceptMsg_u;
dflet 0:50cedd586816 597
dflet 0:50cedd586816 598 #if _SL_INCLUDE_FUNC(sl_Accept)
dflet 0:50cedd586816 599 const _SlCmdCtrl_t _SlAcceptCmdCtrl = {
dflet 0:50cedd586816 600 SL_OPCODE_SOCKET_ACCEPT,
dflet 0:50cedd586816 601 sizeof(_AcceptCommand_t),
dflet 0:50cedd586816 602 sizeof(_BasicResponse_t),
dflet 0:50cedd586816 603 };
dflet 0:50cedd586816 604
dflet 0:50cedd586816 605 int16_t cc3100_socket::sl_Accept(int16_t sd, SlSockAddr_t *addr, SlSocklen_t *addrlen)
dflet 0:50cedd586816 606 {
dflet 0:50cedd586816 607 _SlSockAcceptMsg_u Msg;
dflet 0:50cedd586816 608 _SlReturnVal_t RetVal;
dflet 0:50cedd586816 609 _SocketAddrResponse_u AsyncRsp;
dflet 0:50cedd586816 610
dflet 0:50cedd586816 611 uint8_t ObjIdx = MAX_CONCURRENT_ACTIONS;
dflet 0:50cedd586816 612
dflet 0:50cedd586816 613
dflet 0:50cedd586816 614 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 615 Msg.Cmd.family = (sizeof(SlSockAddrIn_t) == *addrlen) ? SL_AF_INET : SL_AF_INET6;
dflet 0:50cedd586816 616
dflet 0:50cedd586816 617 ObjIdx = _driver._SlDrvProtectAsyncRespSetting((uint8_t*)&AsyncRsp, ACCEPT_ID, sd & BSD_SOCKET_ID_MASK );
dflet 0:50cedd586816 618
dflet 0:50cedd586816 619 if (MAX_CONCURRENT_ACTIONS == ObjIdx)
dflet 0:50cedd586816 620 {
dflet 0:50cedd586816 621 return SL_POOL_IS_EMPTY;
dflet 0:50cedd586816 622 }
dflet 0:50cedd586816 623
dflet 0:50cedd586816 624 /* send the command */
dflet 0:50cedd586816 625 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlAcceptCmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 626 VERIFY_PROTOCOL(Msg.Rsp.sd == sd);
dflet 0:50cedd586816 627
dflet 0:50cedd586816 628 RetVal = Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 629
dflet 0:50cedd586816 630 if(SL_OS_RET_CODE_OK == RetVal) {
dflet 0:50cedd586816 631 /* wait for async and get Data Read parameters */
dflet 0:50cedd586816 632 _driver._SlDrvSyncObjWaitForever(&g_pCB->ObjPool[ObjIdx].SyncObj);
dflet 0:50cedd586816 633
dflet 0:50cedd586816 634 VERIFY_PROTOCOL(AsyncRsp.IpV4.sd == sd);
dflet 0:50cedd586816 635
dflet 0:50cedd586816 636 RetVal = AsyncRsp.IpV4.statusOrLen;
dflet 0:50cedd586816 637 if( (NULL != addr) && (NULL != addrlen) ) {
dflet 0:50cedd586816 638 #if 0 /* Kept for backup */
dflet 0:50cedd586816 639 _sl_ParseAddress(&AsyncRsp, addr, addrlen);
dflet 0:50cedd586816 640 #else
dflet 0:50cedd586816 641 addr->sa_family = AsyncRsp.IpV4.family;
dflet 0:50cedd586816 642
dflet 0:50cedd586816 643 if(SL_AF_INET == addr->sa_family) {
dflet 0:50cedd586816 644 if( *addrlen == sizeof( SlSockAddrIn_t ) ) {
dflet 0:50cedd586816 645 ((SlSockAddrIn_t *)addr)->sin_port = AsyncRsp.IpV4.port;
dflet 0:50cedd586816 646 ((SlSockAddrIn_t *)addr)->sin_addr.s_addr = AsyncRsp.IpV4.address;
dflet 0:50cedd586816 647 } else {
dflet 0:50cedd586816 648 *addrlen = 0;
dflet 0:50cedd586816 649 }
dflet 0:50cedd586816 650 } else if (SL_AF_INET6_EUI_48 == addr->sa_family ) {
dflet 0:50cedd586816 651 if( *addrlen == sizeof( SlSockAddrIn6_t ) ) {
dflet 0:50cedd586816 652 ((SlSockAddrIn6_t *)addr)->sin6_port = AsyncRsp.IpV6EUI48.port;
dflet 0:50cedd586816 653 /* will be called from here and from _sl_BuildAddress*/
dflet 0:50cedd586816 654 memcpy(((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, AsyncRsp.IpV6EUI48.address, 6);
dflet 0:50cedd586816 655 } else {
dflet 0:50cedd586816 656 *addrlen = 0;
dflet 0:50cedd586816 657 }
dflet 0:50cedd586816 658 }
dflet 0:50cedd586816 659 #ifdef SL_SUPPORT_IPV6
dflet 0:50cedd586816 660 else {
dflet 0:50cedd586816 661 if( *addrlen == sizeof( sockaddr_in6 ) ) {
dflet 0:50cedd586816 662 ((sockaddr_in6 *)addr)->sin6_port = AsyncRsp.IpV6.port;
dflet 0:50cedd586816 663 memcpy(((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, AsyncRsp.IpV6.address, 16);
dflet 0:50cedd586816 664 } else {
dflet 0:50cedd586816 665 *addrlen = 0;
dflet 0:50cedd586816 666 }
dflet 0:50cedd586816 667 }
dflet 0:50cedd586816 668 #endif
dflet 0:50cedd586816 669 #endif
dflet 0:50cedd586816 670 }
dflet 0:50cedd586816 671 }
dflet 0:50cedd586816 672
dflet 0:50cedd586816 673 _driver._SlDrvReleasePoolObj(ObjIdx);
dflet 0:50cedd586816 674 return (int16_t)RetVal;
dflet 0:50cedd586816 675 }
dflet 0:50cedd586816 676 #endif
dflet 0:50cedd586816 677
dflet 0:50cedd586816 678
dflet 0:50cedd586816 679 /*******************************************************************************/
dflet 0:50cedd586816 680 /* sl_Htonl */
dflet 0:50cedd586816 681 /*******************************************************************************/
dflet 0:50cedd586816 682 uint32_t cc3100_socket::sl_Htonl( uint32_t val )
dflet 0:50cedd586816 683 {
dflet 0:50cedd586816 684 uint32_t i = 1;
dflet 0:50cedd586816 685 int8_t *p = (int8_t *)&i;
dflet 0:50cedd586816 686 if (p[0] == 1) { /* little endian */
dflet 0:50cedd586816 687 p[0] = ((int8_t* )&val)[3];
dflet 0:50cedd586816 688 p[1] = ((int8_t* )&val)[2];
dflet 0:50cedd586816 689 p[2] = ((int8_t* )&val)[1];
dflet 0:50cedd586816 690 p[3] = ((int8_t* )&val)[0];
dflet 0:50cedd586816 691 return i;
dflet 0:50cedd586816 692 } else { /* big endian */
dflet 0:50cedd586816 693 return val;
dflet 0:50cedd586816 694 }
dflet 0:50cedd586816 695 }
dflet 0:50cedd586816 696
dflet 0:50cedd586816 697 /*******************************************************************************/
dflet 0:50cedd586816 698 /* sl_Htonl */
dflet 0:50cedd586816 699 /*******************************************************************************/
dflet 0:50cedd586816 700 uint16_t cc3100_socket::sl_Htons( uint16_t val )
dflet 0:50cedd586816 701 {
dflet 0:50cedd586816 702 int16_t i = 1;
dflet 0:50cedd586816 703 int8_t *p = (int8_t *)&i;
dflet 0:50cedd586816 704 if (p[0] == 1) { /* little endian */
dflet 0:50cedd586816 705 p[0] = ((int8_t* )&val)[1];
dflet 0:50cedd586816 706 p[1] = ((int8_t* )&val)[0];
dflet 0:50cedd586816 707 return i;
dflet 0:50cedd586816 708 } else { /* big endian */
dflet 0:50cedd586816 709 return val;
dflet 0:50cedd586816 710 }
dflet 0:50cedd586816 711 }
dflet 0:50cedd586816 712
dflet 0:50cedd586816 713 /*******************************************************************************/
dflet 0:50cedd586816 714 /* sl_Recv */
dflet 0:50cedd586816 715 /*******************************************************************************/
dflet 0:50cedd586816 716 typedef union {
dflet 0:50cedd586816 717 _sendRecvCommand_t Cmd;
dflet 0:50cedd586816 718 _SocketResponse_t Rsp;
dflet 0:50cedd586816 719 } _SlRecvMsg_u;
dflet 0:50cedd586816 720
dflet 0:50cedd586816 721 #if _SL_INCLUDE_FUNC(sl_Recv)
dflet 0:50cedd586816 722 const _SlCmdCtrl_t _SlRecvCmdCtrl = {
dflet 0:50cedd586816 723 SL_OPCODE_SOCKET_RECV,
dflet 0:50cedd586816 724 sizeof(_sendRecvCommand_t),
dflet 0:50cedd586816 725 sizeof(_SocketResponse_t)
dflet 0:50cedd586816 726 };
dflet 0:50cedd586816 727
dflet 0:50cedd586816 728 int16_t cc3100_socket::sl_Recv(int16_t sd, void *pBuf, int16_t Len, int16_t flags)
dflet 0:50cedd586816 729 {
dflet 0:50cedd586816 730 _SlRecvMsg_u Msg;
dflet 0:50cedd586816 731 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 732 _SlReturnVal_t status;
dflet 0:50cedd586816 733
dflet 0:50cedd586816 734 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 735 CmdExt.RxPayloadLen = Len;
dflet 0:50cedd586816 736 CmdExt.pRxPayload = (uint8_t *)pBuf;
dflet 0:50cedd586816 737
dflet 0:50cedd586816 738 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 739 Msg.Cmd.StatusOrLen = Len;
dflet 0:50cedd586816 740
dflet 0:50cedd586816 741 /* no size truncation in recv path */
dflet 0:50cedd586816 742 CmdExt.RxPayloadLen = Msg.Cmd.StatusOrLen;
dflet 0:50cedd586816 743
dflet 0:50cedd586816 744 Msg.Cmd.FamilyAndFlags = flags & 0x0F;
dflet 0:50cedd586816 745
dflet 0:50cedd586816 746 status = _driver._SlDrvDataReadOp((_SlSd_t)sd, (_SlCmdCtrl_t *)&_SlRecvCmdCtrl, &Msg, &CmdExt);
dflet 0:50cedd586816 747 if( status != SL_OS_RET_CODE_OK ) {
dflet 0:50cedd586816 748 return status;
dflet 0:50cedd586816 749 }
dflet 0:50cedd586816 750
dflet 0:50cedd586816 751 /* if the Device side sends less than expected it is not the Driver's role */
dflet 0:50cedd586816 752 /* the returned value could be smaller than the requested size */
dflet 0:50cedd586816 753 return (int16_t)Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 754 }
dflet 0:50cedd586816 755 #endif
dflet 0:50cedd586816 756
dflet 0:50cedd586816 757 /*******************************************************************************/
dflet 0:50cedd586816 758 /* sl_SetSockOpt */
dflet 0:50cedd586816 759 /*******************************************************************************/
dflet 0:50cedd586816 760 typedef union {
dflet 0:50cedd586816 761 _setSockOptCommand_t Cmd;
dflet 0:50cedd586816 762 _SocketResponse_t Rsp;
dflet 0:50cedd586816 763 } _SlSetSockOptMsg_u;
dflet 0:50cedd586816 764
dflet 0:50cedd586816 765 const _SlCmdCtrl_t _SlSetSockOptCmdCtrl = {
dflet 0:50cedd586816 766 SL_OPCODE_SOCKET_SETSOCKOPT,
dflet 0:50cedd586816 767 sizeof(_setSockOptCommand_t),
dflet 0:50cedd586816 768 sizeof(_SocketResponse_t)
dflet 0:50cedd586816 769 };
dflet 0:50cedd586816 770
dflet 0:50cedd586816 771 #if _SL_INCLUDE_FUNC(sl_SetSockOpt)
dflet 0:50cedd586816 772 int16_t cc3100_socket::sl_SetSockOpt(int16_t sd, int16_t level, int16_t optname, const void *optval, SlSocklen_t optlen)
dflet 0:50cedd586816 773 {
dflet 0:50cedd586816 774 _SlSetSockOptMsg_u Msg;
dflet 0:50cedd586816 775 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 776
dflet 0:50cedd586816 777 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 778 CmdExt.TxPayloadLen = optlen;
dflet 0:50cedd586816 779 CmdExt.pTxPayload = (uint8_t *)optval;
dflet 0:50cedd586816 780
dflet 0:50cedd586816 781 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 782 Msg.Cmd.level = (uint8_t)level;
dflet 0:50cedd586816 783 Msg.Cmd.optionLen = (uint8_t)optlen;
dflet 0:50cedd586816 784 Msg.Cmd.optionName = (uint8_t)optname;
dflet 0:50cedd586816 785
dflet 0:50cedd586816 786 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSetSockOptCmdCtrl, &Msg, &CmdExt));
dflet 0:50cedd586816 787
dflet 0:50cedd586816 788 return (int16_t)Msg.Rsp.statusOrLen;
dflet 0:50cedd586816 789 }
dflet 0:50cedd586816 790 #endif
dflet 0:50cedd586816 791
dflet 0:50cedd586816 792 /*******************************************************************************/
dflet 0:50cedd586816 793 /* sl_GetSockOpt */
dflet 0:50cedd586816 794 /*******************************************************************************/
dflet 0:50cedd586816 795 typedef union {
dflet 0:50cedd586816 796 _getSockOptCommand_t Cmd;
dflet 0:50cedd586816 797 _getSockOptResponse_t Rsp;
dflet 0:50cedd586816 798 } _SlGetSockOptMsg_u;
dflet 0:50cedd586816 799
dflet 0:50cedd586816 800 #if _SL_INCLUDE_FUNC(sl_GetSockOpt)
dflet 0:50cedd586816 801 const _SlCmdCtrl_t _SlGetSockOptCmdCtrl = {
dflet 0:50cedd586816 802 SL_OPCODE_SOCKET_GETSOCKOPT,
dflet 0:50cedd586816 803 sizeof(_getSockOptCommand_t),
dflet 0:50cedd586816 804 sizeof(_getSockOptResponse_t)
dflet 0:50cedd586816 805 };
dflet 0:50cedd586816 806
dflet 0:50cedd586816 807 int16_t cc3100_socket::sl_GetSockOpt(int16_t sd, int16_t level, int16_t optname, void *optval, SlSocklen_t *optlen)
dflet 0:50cedd586816 808 {
dflet 0:50cedd586816 809 _SlGetSockOptMsg_u Msg;
dflet 0:50cedd586816 810 _SlCmdExt_t CmdExt;
dflet 0:50cedd586816 811
dflet 0:50cedd586816 812 if (*optlen == 0) {
dflet 0:50cedd586816 813 return SL_EZEROLEN;
dflet 0:50cedd586816 814 }
dflet 0:50cedd586816 815
dflet 0:50cedd586816 816 _driver._SlDrvResetCmdExt(&CmdExt);
dflet 0:50cedd586816 817 CmdExt.RxPayloadLen = *optlen;
dflet 0:50cedd586816 818 CmdExt.pRxPayload = (uint8_t*)optval;
dflet 0:50cedd586816 819
dflet 0:50cedd586816 820 Msg.Cmd.sd = (uint8_t)sd;
dflet 0:50cedd586816 821 Msg.Cmd.level = (uint8_t)level;
dflet 0:50cedd586816 822 Msg.Cmd.optionLen = (uint8_t)(*optlen);
dflet 0:50cedd586816 823 Msg.Cmd.optionName = (uint8_t)optname;
dflet 0:50cedd586816 824
dflet 0:50cedd586816 825 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlGetSockOptCmdCtrl, &Msg, &CmdExt));
dflet 0:50cedd586816 826
dflet 0:50cedd586816 827 if (CmdExt.RxPayloadLen < CmdExt.ActualRxPayloadLen) {
dflet 0:50cedd586816 828 *optlen = Msg.Rsp.optionLen;
dflet 0:50cedd586816 829 return SL_ESMALLBUF;
dflet 0:50cedd586816 830 } else {
dflet 0:50cedd586816 831 *optlen = (uint8_t)CmdExt.ActualRxPayloadLen;
dflet 0:50cedd586816 832 }
dflet 0:50cedd586816 833 return (int16_t)Msg.Rsp.status;
dflet 0:50cedd586816 834 }
dflet 0:50cedd586816 835 #endif
dflet 0:50cedd586816 836
dflet 0:50cedd586816 837 /*******************************************************************************/
dflet 0:50cedd586816 838 /* sl_Select */
dflet 0:50cedd586816 839 /* ******************************************************************************/
dflet 0:50cedd586816 840 typedef union {
dflet 0:50cedd586816 841 _SelectCommand_t Cmd;
dflet 0:50cedd586816 842 _BasicResponse_t Rsp;
dflet 0:50cedd586816 843 } _SlSelectMsg_u;
dflet 0:50cedd586816 844
dflet 0:50cedd586816 845 #ifndef SL_TINY_EXT
dflet 0:50cedd586816 846 #if _SL_INCLUDE_FUNC(sl_Select)
dflet 0:50cedd586816 847 const _SlCmdCtrl_t _SlSelectCmdCtrl = {
dflet 0:50cedd586816 848 SL_OPCODE_SOCKET_SELECT,
dflet 0:50cedd586816 849 sizeof(_SelectCommand_t),
dflet 0:50cedd586816 850 sizeof(_BasicResponse_t)
dflet 0:50cedd586816 851 };
dflet 0:50cedd586816 852
dflet 0:50cedd586816 853 int16_t cc3100_socket::sl_Select(int16_t nfds, SlFdSet_t *readsds, SlFdSet_t *writesds, SlFdSet_t *exceptsds, SlTimeval_t *timeout)
dflet 0:50cedd586816 854 {
dflet 0:50cedd586816 855 _SlSelectMsg_u Msg;
dflet 0:50cedd586816 856 _SelectAsyncResponse_t AsyncRsp;
dflet 0:50cedd586816 857 uint8_t ObjIdx = MAX_CONCURRENT_ACTIONS;
dflet 0:50cedd586816 858
dflet 0:50cedd586816 859 Msg.Cmd.nfds = (uint8_t)nfds;
dflet 0:50cedd586816 860 Msg.Cmd.readFdsCount = 0;
dflet 0:50cedd586816 861 Msg.Cmd.writeFdsCount = 0;
dflet 0:50cedd586816 862
dflet 0:50cedd586816 863 Msg.Cmd.readFds = 0;
dflet 0:50cedd586816 864 Msg.Cmd.writeFds = 0;
dflet 0:50cedd586816 865
dflet 0:50cedd586816 866 if( readsds ) {
dflet 0:50cedd586816 867 Msg.Cmd.readFds = (uint16_t)readsds->fd_array[0];
dflet 0:50cedd586816 868 }
dflet 0:50cedd586816 869 if( writesds ) {
dflet 0:50cedd586816 870 Msg.Cmd.writeFds = (uint16_t)writesds->fd_array[0];
dflet 0:50cedd586816 871 }
dflet 0:50cedd586816 872 if( NULL == timeout ) {
dflet 0:50cedd586816 873 Msg.Cmd.tv_sec = 0xffff;
dflet 0:50cedd586816 874 Msg.Cmd.tv_usec = 0xffff;
dflet 0:50cedd586816 875 } else {
dflet 0:50cedd586816 876 if( 0xffff <= timeout->tv_sec ) {
dflet 0:50cedd586816 877 Msg.Cmd.tv_sec = 0xffff;
dflet 0:50cedd586816 878 } else {
dflet 0:50cedd586816 879 Msg.Cmd.tv_sec = (uint16_t)timeout->tv_sec;
dflet 0:50cedd586816 880 }
dflet 0:50cedd586816 881 timeout->tv_usec = timeout->tv_usec >> 10; /* convert to milliseconds */
dflet 0:50cedd586816 882 if( 0xffff <= timeout->tv_usec ) {
dflet 0:50cedd586816 883 Msg.Cmd.tv_usec = 0xffff;
dflet 0:50cedd586816 884 } else {
dflet 0:50cedd586816 885 Msg.Cmd.tv_usec = (uint16_t)timeout->tv_usec;
dflet 0:50cedd586816 886 }
dflet 0:50cedd586816 887 }
dflet 0:50cedd586816 888
dflet 0:50cedd586816 889 /* Use Obj to issue the command, if not available try later */
dflet 0:50cedd586816 890 ObjIdx = _driver._SlDrvProtectAsyncRespSetting((uint8_t*)&AsyncRsp, SELECT_ID, SL_MAX_SOCKETS);
dflet 0:50cedd586816 891
dflet 0:50cedd586816 892 if (MAX_CONCURRENT_ACTIONS == ObjIdx)
dflet 0:50cedd586816 893 {
dflet 0:50cedd586816 894 return SL_POOL_IS_EMPTY;
dflet 0:50cedd586816 895 }
dflet 0:50cedd586816 896
dflet 0:50cedd586816 897 /* send the command */
dflet 0:50cedd586816 898 VERIFY_RET_OK(_driver._SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSelectCmdCtrl, &Msg, NULL));
dflet 0:50cedd586816 899
dflet 0:50cedd586816 900 if(SL_OS_RET_CODE_OK == (int16_t)Msg.Rsp.status) {
dflet 0:50cedd586816 901 _driver._SlDrvSyncObjWaitForever(&g_pCB->ObjPool[ObjIdx].SyncObj);
dflet 0:50cedd586816 902 Msg.Rsp.status = AsyncRsp.status;
dflet 0:50cedd586816 903
dflet 0:50cedd586816 904 if( ((int16_t)Msg.Rsp.status) >= 0 ) {
dflet 0:50cedd586816 905 if( readsds ) {
dflet 0:50cedd586816 906 readsds->fd_array[0] = AsyncRsp.readFds;
dflet 0:50cedd586816 907 }
dflet 0:50cedd586816 908 if( writesds ) {
dflet 0:50cedd586816 909 writesds->fd_array[0] = AsyncRsp.writeFds;
dflet 0:50cedd586816 910 }
dflet 0:50cedd586816 911 }
dflet 0:50cedd586816 912 }
dflet 0:50cedd586816 913
dflet 0:50cedd586816 914 _driver._SlDrvReleasePoolObj(ObjIdx);
dflet 0:50cedd586816 915 return (int16_t)Msg.Rsp.status;
dflet 0:50cedd586816 916 }
dflet 0:50cedd586816 917
dflet 0:50cedd586816 918 /* Select helper functions */
dflet 0:50cedd586816 919 /*******************************************************************************/
dflet 0:50cedd586816 920 /* SL_FD_SET */
dflet 0:50cedd586816 921 /* ******************************************************************************/
dflet 0:50cedd586816 922 void cc3100_socket::SL_FD_SET(int16_t fd, SlFdSet_t *fdset)
dflet 0:50cedd586816 923 {
dflet 0:50cedd586816 924 fdset->fd_array[0] |= (1<< (fd & BSD_SOCKET_ID_MASK));
dflet 0:50cedd586816 925 }
dflet 0:50cedd586816 926 /*******************************************************************************/
dflet 0:50cedd586816 927 /* SL_FD_CLR */
dflet 0:50cedd586816 928 /*******************************************************************************/
dflet 0:50cedd586816 929 void cc3100_socket::SL_FD_CLR(int16_t fd, SlFdSet_t *fdset)
dflet 0:50cedd586816 930 {
dflet 0:50cedd586816 931 fdset->fd_array[0] &= ~(1<< (fd & BSD_SOCKET_ID_MASK));
dflet 0:50cedd586816 932 }
dflet 0:50cedd586816 933 /*******************************************************************************/
dflet 0:50cedd586816 934 /* SL_FD_ISSET */
dflet 0:50cedd586816 935 /*******************************************************************************/
dflet 0:50cedd586816 936 int16_t cc3100_socket::SL_FD_ISSET(int16_t fd, SlFdSet_t *fdset)
dflet 0:50cedd586816 937 {
dflet 0:50cedd586816 938 if( fdset->fd_array[0] & (1<< (fd & BSD_SOCKET_ID_MASK)) ) {
dflet 0:50cedd586816 939 return 1;
dflet 0:50cedd586816 940 }
dflet 0:50cedd586816 941 return 0;
dflet 0:50cedd586816 942 }
dflet 0:50cedd586816 943 /*******************************************************************************/
dflet 0:50cedd586816 944 /* SL_FD_ZERO */
dflet 0:50cedd586816 945 /*******************************************************************************/
dflet 0:50cedd586816 946 void cc3100_socket::SL_FD_ZERO(SlFdSet_t *fdset)
dflet 0:50cedd586816 947 {
dflet 0:50cedd586816 948 fdset->fd_array[0] = 0;
dflet 0:50cedd586816 949 }
dflet 0:50cedd586816 950
dflet 0:50cedd586816 951 #endif
dflet 0:50cedd586816 952 #endif
dflet 0:50cedd586816 953
dflet 0:50cedd586816 954 }//namespace mbed_cc3100
dflet 0:50cedd586816 955
dflet 0:50cedd586816 956
dflet 0:50cedd586816 957