Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: MaximInterface
xternal/simplelink/source/socket.c@17:5926077e5345, 2019-10-04 (annotated)
- Committer:
- IanBenzMaxim
- Date:
- Fri Oct 04 12:10:11 2019 -0500
- Revision:
- 17:5926077e5345
- Parent:
- 16:a004191a79ab
Set pin maps through the mbed configuration system. Added support for MAX32625MBED target. Updated mbed-os to version 5.7.7 for MAX32625 I2C fixes. Consolidated simplelink hook definitions.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| IanBenzMaxim | 0:33d4e66780c0 | 1 | /* |
| IanBenzMaxim | 0:33d4e66780c0 | 2 | * socket.c - CC31xx/CC32xx Host Driver Implementation |
| IanBenzMaxim | 0:33d4e66780c0 | 3 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 4 | * Copyright (C) 2015 Texas Instruments Incorporated - http://www.ti.com/ |
| IanBenzMaxim | 0:33d4e66780c0 | 5 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 6 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 7 | * Redistribution and use in source and binary forms, with or without |
| IanBenzMaxim | 0:33d4e66780c0 | 8 | * modification, are permitted provided that the following conditions |
| IanBenzMaxim | 0:33d4e66780c0 | 9 | * are met: |
| IanBenzMaxim | 0:33d4e66780c0 | 10 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 11 | * Redistributions of source code must retain the above copyright |
| IanBenzMaxim | 0:33d4e66780c0 | 12 | * notice, this list of conditions and the following disclaimer. |
| IanBenzMaxim | 0:33d4e66780c0 | 13 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 14 | * Redistributions in binary form must reproduce the above copyright |
| IanBenzMaxim | 0:33d4e66780c0 | 15 | * notice, this list of conditions and the following disclaimer in the |
| IanBenzMaxim | 0:33d4e66780c0 | 16 | * documentation and/or other materials provided with the |
| IanBenzMaxim | 0:33d4e66780c0 | 17 | * distribution. |
| IanBenzMaxim | 0:33d4e66780c0 | 18 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 19 | * Neither the name of Texas Instruments Incorporated nor the names of |
| IanBenzMaxim | 0:33d4e66780c0 | 20 | * its contributors may be used to endorse or promote products derived |
| IanBenzMaxim | 0:33d4e66780c0 | 21 | * from this software without specific prior written permission. |
| IanBenzMaxim | 0:33d4e66780c0 | 22 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 23 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| IanBenzMaxim | 0:33d4e66780c0 | 24 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| IanBenzMaxim | 0:33d4e66780c0 | 25 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
| IanBenzMaxim | 0:33d4e66780c0 | 26 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
| IanBenzMaxim | 0:33d4e66780c0 | 27 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
| IanBenzMaxim | 0:33d4e66780c0 | 28 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| IanBenzMaxim | 0:33d4e66780c0 | 29 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| IanBenzMaxim | 0:33d4e66780c0 | 30 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| IanBenzMaxim | 0:33d4e66780c0 | 31 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| IanBenzMaxim | 0:33d4e66780c0 | 32 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| IanBenzMaxim | 0:33d4e66780c0 | 33 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| IanBenzMaxim | 0:33d4e66780c0 | 34 | * |
| IanBenzMaxim | 0:33d4e66780c0 | 35 | */ |
| IanBenzMaxim | 0:33d4e66780c0 | 36 | |
| IanBenzMaxim | 0:33d4e66780c0 | 37 | |
| IanBenzMaxim | 0:33d4e66780c0 | 38 | |
| IanBenzMaxim | 0:33d4e66780c0 | 39 | |
| IanBenzMaxim | 0:33d4e66780c0 | 40 | /*****************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 41 | /* Include files */ |
| IanBenzMaxim | 0:33d4e66780c0 | 42 | /*****************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 43 | #include "simplelink.h" |
| IanBenzMaxim | 0:33d4e66780c0 | 44 | #include "protocol.h" |
| IanBenzMaxim | 0:33d4e66780c0 | 45 | #include "driver.h" |
| IanBenzMaxim | 0:33d4e66780c0 | 46 | |
| IanBenzMaxim | 0:33d4e66780c0 | 47 | |
| IanBenzMaxim | 0:33d4e66780c0 | 48 | static void _sl_BuildAddress(const SlSockAddr_t *addr, _SocketAddrCommand_u *pCmd); |
| IanBenzMaxim | 0:33d4e66780c0 | 49 | _SlReturnVal_t _sl_HandleAsync_Connect(void *pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 50 | |
| IanBenzMaxim | 0:33d4e66780c0 | 51 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 52 | void _sl_ParseAddress(_SocketAddrResponse_u *pRsp, SlSockAddr_t *addr, SlSocklen_t *addrlen); |
| IanBenzMaxim | 0:33d4e66780c0 | 53 | _SlReturnVal_t _sl_HandleAsync_Accept(void *pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 54 | _SlReturnVal_t _sl_HandleAsync_Select(void *pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 55 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 56 | static _u16 _sl_TruncatePayloadByProtocol(const _i16 pSd, const _u16 length); |
| IanBenzMaxim | 0:33d4e66780c0 | 57 | |
| IanBenzMaxim | 0:33d4e66780c0 | 58 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 59 | /* Functions */ |
| IanBenzMaxim | 0:33d4e66780c0 | 60 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 61 | |
| IanBenzMaxim | 0:33d4e66780c0 | 62 | |
| IanBenzMaxim | 0:33d4e66780c0 | 63 | /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 64 | /* is possible as _i32 as these parameters are in the same offset and size for these */ |
| IanBenzMaxim | 0:33d4e66780c0 | 65 | /* three families. */ |
| IanBenzMaxim | 0:33d4e66780c0 | 66 | #define SL_SOCKET_PAYLOAD_BASE (1350) |
| IanBenzMaxim | 0:33d4e66780c0 | 67 | |
| IanBenzMaxim | 0:33d4e66780c0 | 68 | static const _u8 _SlPayloadByProtocolLUT[16] = |
| IanBenzMaxim | 0:33d4e66780c0 | 69 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 70 | (1472 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV4 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 71 | (1460 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV4 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 72 | (1452 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV6 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 73 | (1440 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV6 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 74 | (1386 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV4_SECURE */ |
| IanBenzMaxim | 0:33d4e66780c0 | 75 | (1386 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV4_SECURE */ |
| IanBenzMaxim | 0:33d4e66780c0 | 76 | (1396 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_UDP_IPV6_SECURE */ |
| IanBenzMaxim | 0:33d4e66780c0 | 77 | (1396 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_TCP_IPV6_SECURE */ |
| IanBenzMaxim | 0:33d4e66780c0 | 78 | (1476 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_TRANCEIVER */ |
| IanBenzMaxim | 0:33d4e66780c0 | 79 | (1514 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_PACKET */ |
| IanBenzMaxim | 0:33d4e66780c0 | 80 | (1480 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_IP4 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 81 | (1480 - SL_SOCKET_PAYLOAD_BASE), /* SL_SOCKET_PAYLOAD_TYPE_RAW_IP6 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 82 | (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */ |
| IanBenzMaxim | 0:33d4e66780c0 | 83 | (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */ |
| IanBenzMaxim | 0:33d4e66780c0 | 84 | (1440 - SL_SOCKET_PAYLOAD_BASE), /* Default */ |
| IanBenzMaxim | 0:33d4e66780c0 | 85 | (1440 - SL_SOCKET_PAYLOAD_BASE) /* Default */ |
| IanBenzMaxim | 0:33d4e66780c0 | 86 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 87 | |
| IanBenzMaxim | 0:33d4e66780c0 | 88 | |
| IanBenzMaxim | 0:33d4e66780c0 | 89 | |
| IanBenzMaxim | 0:33d4e66780c0 | 90 | /* ******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 91 | /* _sl_BuildAddress */ |
| IanBenzMaxim | 0:33d4e66780c0 | 92 | /* ******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 93 | static void _sl_BuildAddress(const SlSockAddr_t *addr, _SocketAddrCommand_u *pCmd) |
| IanBenzMaxim | 0:33d4e66780c0 | 94 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 95 | |
| IanBenzMaxim | 0:33d4e66780c0 | 96 | /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48 |
| IanBenzMaxim | 0:33d4e66780c0 | 97 | is possible as long as these parameters are in the same offset and size for these |
| IanBenzMaxim | 0:33d4e66780c0 | 98 | three families. */ |
| IanBenzMaxim | 0:33d4e66780c0 | 99 | pCmd->IpV4.FamilyAndFlags = (_u8)((addr->sa_family << 4) & 0xF0); |
| IanBenzMaxim | 0:33d4e66780c0 | 100 | pCmd->IpV4.port = ((SlSockAddrIn_t *)addr)->sin_port; |
| IanBenzMaxim | 0:33d4e66780c0 | 101 | |
| IanBenzMaxim | 0:33d4e66780c0 | 102 | if(SL_AF_INET == addr->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 103 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 104 | pCmd->IpV4.address = ((SlSockAddrIn_t *)addr)->sin_addr.s_addr; |
| IanBenzMaxim | 0:33d4e66780c0 | 105 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 106 | else if (SL_AF_INET6_EUI_48 == addr->sa_family ) |
| IanBenzMaxim | 0:33d4e66780c0 | 107 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 108 | sl_Memcpy( pCmd->IpV6EUI48.address,((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, 6); |
| IanBenzMaxim | 0:33d4e66780c0 | 109 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 110 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 111 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 112 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 113 | sl_Memcpy(pCmd->IpV6.address, ((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, 16 ); |
| IanBenzMaxim | 0:33d4e66780c0 | 114 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 115 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 116 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 117 | |
| IanBenzMaxim | 0:33d4e66780c0 | 118 | |
| IanBenzMaxim | 0:33d4e66780c0 | 119 | /***************************************************************************** |
| IanBenzMaxim | 0:33d4e66780c0 | 120 | _sl_TruncatePayloadByProtocol |
| IanBenzMaxim | 0:33d4e66780c0 | 121 | *****************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 122 | static _u16 _sl_TruncatePayloadByProtocol(const _i16 sd, const _u16 length) |
| IanBenzMaxim | 0:33d4e66780c0 | 123 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 124 | _u16 maxLength; |
| IanBenzMaxim | 0:33d4e66780c0 | 125 | |
| IanBenzMaxim | 0:33d4e66780c0 | 126 | |
| IanBenzMaxim | 0:33d4e66780c0 | 127 | maxLength = (_u16)(SL_SOCKET_PAYLOAD_BASE + _SlPayloadByProtocolLUT[((sd & SL_SOCKET_PAYLOAD_TYPE_MASK) >> 4)]); |
| IanBenzMaxim | 0:33d4e66780c0 | 128 | |
| IanBenzMaxim | 0:33d4e66780c0 | 129 | |
| IanBenzMaxim | 0:33d4e66780c0 | 130 | |
| IanBenzMaxim | 0:33d4e66780c0 | 131 | if( length > maxLength ) |
| IanBenzMaxim | 0:33d4e66780c0 | 132 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 133 | return maxLength; |
| IanBenzMaxim | 0:33d4e66780c0 | 134 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 135 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 136 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 137 | return length; |
| IanBenzMaxim | 0:33d4e66780c0 | 138 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 139 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 140 | |
| IanBenzMaxim | 0:33d4e66780c0 | 141 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 142 | /* _sl_ParseAddress */ |
| IanBenzMaxim | 0:33d4e66780c0 | 143 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 144 | |
| IanBenzMaxim | 0:33d4e66780c0 | 145 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 146 | void _sl_ParseAddress(_SocketAddrResponse_u *pRsp, SlSockAddr_t *addr, SlSocklen_t *addrlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 147 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 148 | /* Note: parsing of family and port in the generic way for all IPV4, IPV6 and EUI48 */ |
| IanBenzMaxim | 0:33d4e66780c0 | 149 | /* is possible as long as these parameters are in the same offset and size for these */ |
| IanBenzMaxim | 0:33d4e66780c0 | 150 | /* three families. */ |
| IanBenzMaxim | 0:33d4e66780c0 | 151 | addr->sa_family = pRsp->IpV4.family; |
| IanBenzMaxim | 0:33d4e66780c0 | 152 | ((SlSockAddrIn_t *)addr)->sin_port = pRsp->IpV4.port; |
| IanBenzMaxim | 0:33d4e66780c0 | 153 | |
| IanBenzMaxim | 0:33d4e66780c0 | 154 | *addrlen = (SlSocklen_t)((SL_AF_INET == addr->sa_family) ? sizeof(SlSockAddrIn_t) : sizeof(SlSockAddrIn6_t)); |
| IanBenzMaxim | 0:33d4e66780c0 | 155 | |
| IanBenzMaxim | 0:33d4e66780c0 | 156 | if(SL_AF_INET == addr->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 157 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 158 | ((SlSockAddrIn_t *)addr)->sin_addr.s_addr = pRsp->IpV4.address; |
| IanBenzMaxim | 0:33d4e66780c0 | 159 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 160 | else if (SL_AF_INET6_EUI_48 == addr->sa_family ) |
| IanBenzMaxim | 0:33d4e66780c0 | 161 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 162 | sl_Memcpy(((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, pRsp->IpV6EUI48.address, 6); |
| IanBenzMaxim | 0:33d4e66780c0 | 163 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 164 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 165 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 166 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 167 | sl_Memcpy(((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, pRsp->IpV6.address, 16); |
| IanBenzMaxim | 0:33d4e66780c0 | 168 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 169 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 170 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 171 | |
| IanBenzMaxim | 0:33d4e66780c0 | 172 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 173 | |
| IanBenzMaxim | 0:33d4e66780c0 | 174 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 175 | /* sl_Socket */ |
| IanBenzMaxim | 0:33d4e66780c0 | 176 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 177 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 178 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 179 | _u32 Dummy; |
| IanBenzMaxim | 0:33d4e66780c0 | 180 | _SocketCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 181 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 182 | }_SlSockSocketMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 183 | |
| IanBenzMaxim | 0:33d4e66780c0 | 184 | |
| IanBenzMaxim | 0:33d4e66780c0 | 185 | |
| IanBenzMaxim | 0:33d4e66780c0 | 186 | #if _SL_INCLUDE_FUNC(sl_Socket) |
| IanBenzMaxim | 0:33d4e66780c0 | 187 | |
| IanBenzMaxim | 0:33d4e66780c0 | 188 | static const _SlCmdCtrl_t _SlSockSocketCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 189 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 190 | SL_OPCODE_SOCKET_SOCKET, |
| IanBenzMaxim | 0:33d4e66780c0 | 191 | (_SlArgSize_t)sizeof(_SocketCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 192 | (_SlArgSize_t)sizeof(_SocketResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 193 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 194 | |
| IanBenzMaxim | 0:33d4e66780c0 | 195 | _i16 sl_Socket(_i16 Domain, _i16 Type, _i16 Protocol) |
| IanBenzMaxim | 0:33d4e66780c0 | 196 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 197 | _SlSockSocketMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 198 | |
| IanBenzMaxim | 0:33d4e66780c0 | 199 | Msg.Cmd.Domain = (_u8)Domain; |
| IanBenzMaxim | 0:33d4e66780c0 | 200 | Msg.Cmd.Type = (_u8)Type; |
| IanBenzMaxim | 0:33d4e66780c0 | 201 | Msg.Cmd.Protocol = (_u8)Protocol; |
| IanBenzMaxim | 0:33d4e66780c0 | 202 | |
| IanBenzMaxim | 0:33d4e66780c0 | 203 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 204 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 205 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 206 | |
| IanBenzMaxim | 0:33d4e66780c0 | 207 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSockSocketCmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 208 | |
| IanBenzMaxim | 0:33d4e66780c0 | 209 | if( Msg.Rsp.statusOrLen < 0 ) |
| IanBenzMaxim | 0:33d4e66780c0 | 210 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 211 | return( Msg.Rsp.statusOrLen ); |
| IanBenzMaxim | 0:33d4e66780c0 | 212 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 213 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 214 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 215 | return (_i16)((_u8)Msg.Rsp.sd); |
| IanBenzMaxim | 0:33d4e66780c0 | 216 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 217 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 218 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 219 | |
| IanBenzMaxim | 0:33d4e66780c0 | 220 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 221 | /* sl_Close */ |
| IanBenzMaxim | 0:33d4e66780c0 | 222 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 223 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 224 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 225 | _CloseCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 226 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 227 | }_SlSockCloseMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 228 | |
| IanBenzMaxim | 0:33d4e66780c0 | 229 | |
| IanBenzMaxim | 0:33d4e66780c0 | 230 | #if _SL_INCLUDE_FUNC(sl_Close) |
| IanBenzMaxim | 0:33d4e66780c0 | 231 | |
| IanBenzMaxim | 0:33d4e66780c0 | 232 | static const _SlCmdCtrl_t _SlSockCloseCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 233 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 234 | SL_OPCODE_SOCKET_CLOSE, |
| IanBenzMaxim | 0:33d4e66780c0 | 235 | (_SlArgSize_t)sizeof(_CloseCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 236 | (_SlArgSize_t)sizeof(_SocketResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 237 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 238 | |
| IanBenzMaxim | 0:33d4e66780c0 | 239 | _i16 sl_Close(_i16 sd) |
| IanBenzMaxim | 0:33d4e66780c0 | 240 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 241 | _SlSockCloseMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 242 | |
| IanBenzMaxim | 0:33d4e66780c0 | 243 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 244 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 245 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 246 | |
| IanBenzMaxim | 0:33d4e66780c0 | 247 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 248 | |
| IanBenzMaxim | 0:33d4e66780c0 | 249 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSockCloseCmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 250 | |
| IanBenzMaxim | 0:33d4e66780c0 | 251 | return Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 252 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 253 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 254 | |
| IanBenzMaxim | 0:33d4e66780c0 | 255 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 256 | /* sl_Bind */ |
| IanBenzMaxim | 0:33d4e66780c0 | 257 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 258 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 259 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 260 | _SocketAddrCommand_u Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 261 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 262 | }_SlSockBindMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 263 | |
| IanBenzMaxim | 0:33d4e66780c0 | 264 | #if _SL_INCLUDE_FUNC(sl_Bind) |
| IanBenzMaxim | 0:33d4e66780c0 | 265 | _i16 sl_Bind(_i16 sd, const SlSockAddr_t *addr, _i16 addrlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 266 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 267 | _SlSockBindMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 268 | _SlCmdCtrl_t CmdCtrl = {0, 0, (_SlArgSize_t)sizeof(_SocketResponse_t)}; |
| IanBenzMaxim | 0:33d4e66780c0 | 269 | |
| IanBenzMaxim | 0:33d4e66780c0 | 270 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 271 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 272 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 273 | |
| IanBenzMaxim | 0:33d4e66780c0 | 274 | switch(addr->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 275 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 276 | case SL_AF_INET : |
| IanBenzMaxim | 0:33d4e66780c0 | 277 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND; |
| IanBenzMaxim | 0:33d4e66780c0 | 278 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv4Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 279 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 280 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 281 | case SL_AF_INET6_EUI_48: |
| IanBenzMaxim | 0:33d4e66780c0 | 282 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 283 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6EUI48Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 284 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 285 | |
| IanBenzMaxim | 0:33d4e66780c0 | 286 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 287 | case AF_INET6: |
| IanBenzMaxim | 0:33d4e66780c0 | 288 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 289 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 290 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 291 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 292 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 293 | |
| IanBenzMaxim | 0:33d4e66780c0 | 294 | |
| IanBenzMaxim | 0:33d4e66780c0 | 295 | case SL_AF_RF : |
| IanBenzMaxim | 0:33d4e66780c0 | 296 | default: |
| IanBenzMaxim | 0:33d4e66780c0 | 297 | return SL_RET_CODE_INVALID_INPUT; |
| IanBenzMaxim | 0:33d4e66780c0 | 298 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 299 | |
| IanBenzMaxim | 0:33d4e66780c0 | 300 | Msg.Cmd.IpV4.lenOrPadding = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 301 | Msg.Cmd.IpV4.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 302 | |
| IanBenzMaxim | 0:33d4e66780c0 | 303 | _sl_BuildAddress(addr, &Msg.Cmd); |
| IanBenzMaxim | 0:33d4e66780c0 | 304 | |
| IanBenzMaxim | 0:33d4e66780c0 | 305 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&CmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 306 | |
| IanBenzMaxim | 0:33d4e66780c0 | 307 | return Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 308 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 309 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 310 | |
| IanBenzMaxim | 0:33d4e66780c0 | 311 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 312 | /* sl_Sendto */ |
| IanBenzMaxim | 0:33d4e66780c0 | 313 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 314 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 315 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 316 | _SocketAddrCommand_u Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 317 | /* no response for 'sendto' commands*/ |
| IanBenzMaxim | 0:33d4e66780c0 | 318 | }_SlSendtoMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 319 | |
| IanBenzMaxim | 0:33d4e66780c0 | 320 | #if _SL_INCLUDE_FUNC(sl_SendTo) |
| IanBenzMaxim | 0:33d4e66780c0 | 321 | _i16 sl_SendTo(_i16 sd, const void *pBuf, _i16 Len, _i16 flags, const SlSockAddr_t *to, SlSocklen_t tolen) |
| IanBenzMaxim | 0:33d4e66780c0 | 322 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 323 | _SlSendtoMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 324 | _SlCmdCtrl_t CmdCtrl = {0, 0, 0}; |
| IanBenzMaxim | 0:33d4e66780c0 | 325 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 326 | _u16 ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 327 | _i16 RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 328 | |
| IanBenzMaxim | 0:33d4e66780c0 | 329 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 330 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 331 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 332 | |
| IanBenzMaxim | 0:33d4e66780c0 | 333 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 334 | CmdExt.TxPayloadLen = (_u16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 335 | CmdExt.pTxPayload = (_u8 *)pBuf; |
| IanBenzMaxim | 0:33d4e66780c0 | 336 | |
| IanBenzMaxim | 0:33d4e66780c0 | 337 | switch(to->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 338 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 339 | case SL_AF_INET: |
| IanBenzMaxim | 0:33d4e66780c0 | 340 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_SENDTO; |
| IanBenzMaxim | 0:33d4e66780c0 | 341 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv4Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 342 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 343 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 344 | case SL_AF_INET6_EUI_48: |
| IanBenzMaxim | 0:33d4e66780c0 | 345 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_BIND_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 346 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6EUI48Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 347 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 348 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 349 | case AF_INET6: |
| IanBenzMaxim | 0:33d4e66780c0 | 350 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_SENDTO_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 351 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 352 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 353 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 354 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 355 | case SL_AF_RF: |
| IanBenzMaxim | 0:33d4e66780c0 | 356 | default: |
| IanBenzMaxim | 0:33d4e66780c0 | 357 | return SL_RET_CODE_INVALID_INPUT; |
| IanBenzMaxim | 0:33d4e66780c0 | 358 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 359 | |
| IanBenzMaxim | 0:33d4e66780c0 | 360 | ChunkLen = _sl_TruncatePayloadByProtocol(sd,(_u16)Len); |
| IanBenzMaxim | 0:33d4e66780c0 | 361 | Msg.Cmd.IpV4.lenOrPadding = (_i16)ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 362 | CmdExt.TxPayloadLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 363 | |
| IanBenzMaxim | 0:33d4e66780c0 | 364 | Msg.Cmd.IpV4.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 365 | |
| IanBenzMaxim | 0:33d4e66780c0 | 366 | _sl_BuildAddress(to, &Msg.Cmd); |
| IanBenzMaxim | 0:33d4e66780c0 | 367 | |
| IanBenzMaxim | 0:33d4e66780c0 | 368 | Msg.Cmd.IpV4.FamilyAndFlags |= flags & 0x0F; |
| IanBenzMaxim | 0:33d4e66780c0 | 369 | |
| IanBenzMaxim | 0:33d4e66780c0 | 370 | do |
| IanBenzMaxim | 0:33d4e66780c0 | 371 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 372 | RetVal = _SlDrvDataWriteOp((_SlSd_t)sd, &CmdCtrl, &Msg, &CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 373 | |
| IanBenzMaxim | 0:33d4e66780c0 | 374 | if(SL_OS_RET_CODE_OK == RetVal) |
| IanBenzMaxim | 0:33d4e66780c0 | 375 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 376 | CmdExt.pTxPayload += ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 377 | ChunkLen = (_u16)((_u8 *)pBuf + Len - CmdExt.pTxPayload); |
| IanBenzMaxim | 0:33d4e66780c0 | 378 | ChunkLen = _sl_TruncatePayloadByProtocol(sd,ChunkLen); |
| IanBenzMaxim | 0:33d4e66780c0 | 379 | CmdExt.TxPayloadLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 380 | Msg.Cmd.IpV4.lenOrPadding = (_i16)ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 381 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 382 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 383 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 384 | return RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 385 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 386 | }while(ChunkLen > 0); |
| IanBenzMaxim | 0:33d4e66780c0 | 387 | |
| IanBenzMaxim | 0:33d4e66780c0 | 388 | return (_i16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 389 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 390 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 391 | |
| IanBenzMaxim | 0:33d4e66780c0 | 392 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 393 | /* sl_Recvfrom */ |
| IanBenzMaxim | 0:33d4e66780c0 | 394 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 395 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 396 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 397 | _sendRecvCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 398 | _SocketAddrResponse_u Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 399 | }_SlRecvfromMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 400 | |
| IanBenzMaxim | 0:33d4e66780c0 | 401 | static const _SlCmdCtrl_t _SlRecvfomCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 402 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 403 | SL_OPCODE_SOCKET_RECVFROM, |
| IanBenzMaxim | 0:33d4e66780c0 | 404 | (_SlArgSize_t)sizeof(_sendRecvCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 405 | (_SlArgSize_t)sizeof(_SocketAddrResponse_u) |
| IanBenzMaxim | 0:33d4e66780c0 | 406 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 407 | |
| IanBenzMaxim | 0:33d4e66780c0 | 408 | |
| IanBenzMaxim | 0:33d4e66780c0 | 409 | |
| IanBenzMaxim | 0:33d4e66780c0 | 410 | #if _SL_INCLUDE_FUNC(sl_RecvFrom) |
| IanBenzMaxim | 0:33d4e66780c0 | 411 | _i16 sl_RecvFrom(_i16 sd, void *buf, _i16 Len, _i16 flags, SlSockAddr_t *from, SlSocklen_t *fromlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 412 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 413 | _SlRecvfromMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 414 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 415 | _i16 RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 416 | |
| IanBenzMaxim | 0:33d4e66780c0 | 417 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 418 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 419 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 420 | |
| IanBenzMaxim | 0:33d4e66780c0 | 421 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 422 | CmdExt.RxPayloadLen = Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 423 | CmdExt.pRxPayload = (_u8 *)buf; |
| IanBenzMaxim | 0:33d4e66780c0 | 424 | |
| IanBenzMaxim | 0:33d4e66780c0 | 425 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 426 | Msg.Cmd.StatusOrLen = (_u16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 427 | |
| IanBenzMaxim | 0:33d4e66780c0 | 428 | /* no size truncation in recv path */ |
| IanBenzMaxim | 0:33d4e66780c0 | 429 | CmdExt.RxPayloadLen = (_i16)Msg.Cmd.StatusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 430 | |
| IanBenzMaxim | 0:33d4e66780c0 | 431 | |
| IanBenzMaxim | 0:33d4e66780c0 | 432 | Msg.Cmd.FamilyAndFlags = (_u8)(flags & 0x0F); |
| IanBenzMaxim | 0:33d4e66780c0 | 433 | |
| IanBenzMaxim | 0:33d4e66780c0 | 434 | |
| IanBenzMaxim | 0:33d4e66780c0 | 435 | if(sizeof(SlSockAddrIn_t) == *fromlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 436 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 437 | Msg.Cmd.FamilyAndFlags |= (SL_AF_INET << 4); |
| IanBenzMaxim | 0:33d4e66780c0 | 438 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 439 | else if (sizeof(SlSockAddrIn6_t) == *fromlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 440 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 441 | Msg.Cmd.FamilyAndFlags |= (SL_AF_INET6 << 4); |
| IanBenzMaxim | 0:33d4e66780c0 | 442 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 443 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 444 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 445 | return SL_RET_CODE_INVALID_INPUT; |
| IanBenzMaxim | 0:33d4e66780c0 | 446 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 447 | |
| IanBenzMaxim | 0:33d4e66780c0 | 448 | RetVal = _SlDrvDataReadOp((_SlSd_t)sd, (_SlCmdCtrl_t *)&_SlRecvfomCmdCtrl, &Msg, &CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 449 | if( RetVal != SL_OS_RET_CODE_OK ) |
| IanBenzMaxim | 0:33d4e66780c0 | 450 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 451 | return RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 452 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 453 | |
| IanBenzMaxim | 0:33d4e66780c0 | 454 | RetVal = Msg.Rsp.IpV4.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 455 | |
| IanBenzMaxim | 0:33d4e66780c0 | 456 | if(RetVal >= 0) |
| IanBenzMaxim | 0:33d4e66780c0 | 457 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 458 | VERIFY_PROTOCOL(sd == (_i16)Msg.Rsp.IpV4.sd); |
| IanBenzMaxim | 0:33d4e66780c0 | 459 | #if 0 |
| IanBenzMaxim | 0:33d4e66780c0 | 460 | _sl_ParseAddress(&Msg.Rsp, from, fromlen); |
| IanBenzMaxim | 0:33d4e66780c0 | 461 | #else |
| IanBenzMaxim | 0:33d4e66780c0 | 462 | from->sa_family = Msg.Rsp.IpV4.family; |
| IanBenzMaxim | 0:33d4e66780c0 | 463 | if(SL_AF_INET == from->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 464 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 465 | ((SlSockAddrIn_t *)from)->sin_port = Msg.Rsp.IpV4.port; |
| IanBenzMaxim | 0:33d4e66780c0 | 466 | ((SlSockAddrIn_t *)from)->sin_addr.s_addr = Msg.Rsp.IpV4.address; |
| IanBenzMaxim | 0:33d4e66780c0 | 467 | *fromlen = (SlSocklen_t)sizeof(SlSockAddrIn_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 468 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 469 | else if (SL_AF_INET6_EUI_48 == from->sa_family ) |
| IanBenzMaxim | 0:33d4e66780c0 | 470 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 471 | ((SlSockAddrIn6_t *)from)->sin6_port = Msg.Rsp.IpV6EUI48.port; |
| IanBenzMaxim | 0:33d4e66780c0 | 472 | sl_Memcpy(((SlSockAddrIn6_t *)from)->sin6_addr._S6_un._S6_u8, Msg.Rsp.IpV6EUI48.address, 6); |
| IanBenzMaxim | 0:33d4e66780c0 | 473 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 474 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 475 | else if(AF_INET6 == from->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 476 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 477 | VERIFY_PROTOCOL(*fromlen >= sizeof(sockaddr_in6)); |
| IanBenzMaxim | 0:33d4e66780c0 | 478 | |
| IanBenzMaxim | 0:33d4e66780c0 | 479 | ((sockaddr_in6 *)from)->sin6_port = Msg.Rsp.IpV6.port; |
| IanBenzMaxim | 0:33d4e66780c0 | 480 | sl_Memcpy(((sockaddr_in6 *)from)->sin6_addr._S6_un._S6_u32, Msg.Rsp.IpV6.address, 16); |
| IanBenzMaxim | 0:33d4e66780c0 | 481 | *fromlen = sizeof(sockaddr_in6); |
| IanBenzMaxim | 0:33d4e66780c0 | 482 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 483 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 484 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 485 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 486 | |
| IanBenzMaxim | 0:33d4e66780c0 | 487 | return (_i16)RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 488 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 489 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 490 | |
| IanBenzMaxim | 0:33d4e66780c0 | 491 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 492 | /* sl_Connect */ |
| IanBenzMaxim | 0:33d4e66780c0 | 493 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 494 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 495 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 496 | _SocketAddrCommand_u Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 497 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 498 | }_SlSockConnectMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 499 | |
| IanBenzMaxim | 0:33d4e66780c0 | 500 | #if _SL_INCLUDE_FUNC(sl_Connect) |
| IanBenzMaxim | 0:33d4e66780c0 | 501 | _i16 sl_Connect(_i16 sd, const SlSockAddr_t *addr, _i16 addrlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 502 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 503 | _SlSockConnectMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 504 | _SlReturnVal_t RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 505 | _SlCmdCtrl_t CmdCtrl = {0, (_SlArgSize_t)0, (_SlArgSize_t)sizeof(_SocketResponse_t)}; |
| IanBenzMaxim | 0:33d4e66780c0 | 506 | _SocketResponse_t AsyncRsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 507 | _u8 ObjIdx = MAX_CONCURRENT_ACTIONS; |
| IanBenzMaxim | 0:33d4e66780c0 | 508 | |
| IanBenzMaxim | 0:33d4e66780c0 | 509 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 510 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 511 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 512 | |
| IanBenzMaxim | 0:33d4e66780c0 | 513 | |
| IanBenzMaxim | 0:33d4e66780c0 | 514 | switch(addr->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 515 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 516 | case SL_AF_INET : |
| IanBenzMaxim | 0:33d4e66780c0 | 517 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT; |
| IanBenzMaxim | 0:33d4e66780c0 | 518 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv4Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 519 | /* Do nothing - cmd already initialized to this type */ |
| IanBenzMaxim | 0:33d4e66780c0 | 520 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 521 | case SL_AF_INET6_EUI_48: |
| IanBenzMaxim | 0:33d4e66780c0 | 522 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 523 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6EUI48Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 524 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 525 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 526 | case AF_INET6: |
| IanBenzMaxim | 0:33d4e66780c0 | 527 | CmdCtrl.Opcode = SL_OPCODE_SOCKET_CONNECT_V6; |
| IanBenzMaxim | 0:33d4e66780c0 | 528 | CmdCtrl.TxDescLen = (_SlArgSize_t)sizeof(_SocketAddrIPv6Command_t); |
| IanBenzMaxim | 0:33d4e66780c0 | 529 | break; |
| IanBenzMaxim | 0:33d4e66780c0 | 530 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 531 | case SL_AF_RF: |
| IanBenzMaxim | 0:33d4e66780c0 | 532 | default: |
| IanBenzMaxim | 0:33d4e66780c0 | 533 | return SL_RET_CODE_INVALID_INPUT; |
| IanBenzMaxim | 0:33d4e66780c0 | 534 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 535 | |
| IanBenzMaxim | 0:33d4e66780c0 | 536 | Msg.Cmd.IpV4.lenOrPadding = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 537 | Msg.Cmd.IpV4.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 538 | |
| IanBenzMaxim | 0:33d4e66780c0 | 539 | _sl_BuildAddress(addr, &Msg.Cmd); |
| IanBenzMaxim | 0:33d4e66780c0 | 540 | |
| IanBenzMaxim | 0:33d4e66780c0 | 541 | |
| IanBenzMaxim | 0:33d4e66780c0 | 542 | ObjIdx = _SlDrvProtectAsyncRespSetting((_u8*)&AsyncRsp, CONNECT_ID, (_u8)(sd & BSD_SOCKET_ID_MASK)); |
| IanBenzMaxim | 0:33d4e66780c0 | 543 | |
| IanBenzMaxim | 0:33d4e66780c0 | 544 | if (MAX_CONCURRENT_ACTIONS == ObjIdx) |
| IanBenzMaxim | 0:33d4e66780c0 | 545 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 546 | return SL_POOL_IS_EMPTY; |
| IanBenzMaxim | 0:33d4e66780c0 | 547 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 548 | |
| IanBenzMaxim | 0:33d4e66780c0 | 549 | /* send the command */ |
| IanBenzMaxim | 0:33d4e66780c0 | 550 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&CmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 551 | VERIFY_PROTOCOL(Msg.Rsp.sd == (_u8)sd) |
| IanBenzMaxim | 0:33d4e66780c0 | 552 | |
| IanBenzMaxim | 0:33d4e66780c0 | 553 | RetVal = Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 554 | |
| IanBenzMaxim | 0:33d4e66780c0 | 555 | if(SL_RET_CODE_OK == RetVal) |
| IanBenzMaxim | 0:33d4e66780c0 | 556 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 557 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 558 | /*In case socket is non-blocking one, the async event should be received immediately */ |
| IanBenzMaxim | 0:33d4e66780c0 | 559 | if( g_pCB->SocketNonBlocking >> (sd & BSD_SOCKET_ID_MASK)) |
| IanBenzMaxim | 0:33d4e66780c0 | 560 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 561 | SL_DRV_SYNC_OBJ_WAIT_TIMEOUT(&g_pCB->ObjPool[ObjIdx].SyncObj, |
| IanBenzMaxim | 0:33d4e66780c0 | 562 | SL_DRIVER_TIMEOUT_SHORT, |
| IanBenzMaxim | 0:33d4e66780c0 | 563 | SL_DRIVER_API_SOCKET_CONNECT |
| IanBenzMaxim | 0:33d4e66780c0 | 564 | ); |
| IanBenzMaxim | 0:33d4e66780c0 | 565 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 566 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 567 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 568 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 569 | /* wait for async and get Data Read parameters */ |
| IanBenzMaxim | 0:33d4e66780c0 | 570 | SL_DRV_SYNC_OBJ_WAIT_FOREVER(&g_pCB->ObjPool[ObjIdx].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 571 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 572 | |
| IanBenzMaxim | 0:33d4e66780c0 | 573 | VERIFY_PROTOCOL(AsyncRsp.sd == (_u8)sd); |
| IanBenzMaxim | 0:33d4e66780c0 | 574 | |
| IanBenzMaxim | 0:33d4e66780c0 | 575 | RetVal = AsyncRsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 576 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 577 | |
| IanBenzMaxim | 0:33d4e66780c0 | 578 | |
| IanBenzMaxim | 0:33d4e66780c0 | 579 | |
| IanBenzMaxim | 0:33d4e66780c0 | 580 | _SlDrvReleasePoolObj(ObjIdx); |
| IanBenzMaxim | 0:33d4e66780c0 | 581 | return RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 582 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 583 | |
| IanBenzMaxim | 0:33d4e66780c0 | 584 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 585 | |
| IanBenzMaxim | 0:33d4e66780c0 | 586 | |
| IanBenzMaxim | 0:33d4e66780c0 | 587 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 588 | /* _sl_HandleAsync_Connect */ |
| IanBenzMaxim | 0:33d4e66780c0 | 589 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 590 | _SlReturnVal_t _sl_HandleAsync_Connect(void *pVoidBuf) |
| IanBenzMaxim | 0:33d4e66780c0 | 591 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 592 | _SocketResponse_t *pMsgArgs = (_SocketResponse_t *)_SL_RESP_ARGS_START(pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 593 | |
| IanBenzMaxim | 0:33d4e66780c0 | 594 | SL_DRV_PROTECTION_OBJ_LOCK_FOREVER(); |
| IanBenzMaxim | 0:33d4e66780c0 | 595 | |
| IanBenzMaxim | 0:33d4e66780c0 | 596 | VERIFY_PROTOCOL((pMsgArgs->sd & BSD_SOCKET_ID_MASK) <= SL_MAX_SOCKETS); |
| IanBenzMaxim | 0:33d4e66780c0 | 597 | VERIFY_SOCKET_CB(NULL != g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs); |
| IanBenzMaxim | 0:33d4e66780c0 | 598 | |
| IanBenzMaxim | 0:33d4e66780c0 | 599 | |
| IanBenzMaxim | 0:33d4e66780c0 | 600 | ((_SocketResponse_t *)(g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs))->sd = pMsgArgs->sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 601 | ((_SocketResponse_t *)(g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs))->statusOrLen = pMsgArgs->statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 602 | |
| IanBenzMaxim | 0:33d4e66780c0 | 603 | |
| IanBenzMaxim | 0:33d4e66780c0 | 604 | SL_DRV_SYNC_OBJ_SIGNAL(&g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 605 | SL_DRV_PROTECTION_OBJ_UNLOCK(); |
| IanBenzMaxim | 0:33d4e66780c0 | 606 | |
| IanBenzMaxim | 0:33d4e66780c0 | 607 | return SL_RET_CODE_OK; |
| IanBenzMaxim | 0:33d4e66780c0 | 608 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 609 | |
| IanBenzMaxim | 0:33d4e66780c0 | 610 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 611 | /* sl_Send */ |
| IanBenzMaxim | 0:33d4e66780c0 | 612 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 613 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 614 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 615 | _sendRecvCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 616 | /* no response for 'sendto' commands*/ |
| IanBenzMaxim | 0:33d4e66780c0 | 617 | }_SlSendMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 618 | |
| IanBenzMaxim | 0:33d4e66780c0 | 619 | static const _SlCmdCtrl_t _SlSendCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 620 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 621 | SL_OPCODE_SOCKET_SEND, |
| IanBenzMaxim | 0:33d4e66780c0 | 622 | (_SlArgSize_t)sizeof(_sendRecvCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 623 | (_SlArgSize_t)0 |
| IanBenzMaxim | 0:33d4e66780c0 | 624 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 625 | |
| IanBenzMaxim | 0:33d4e66780c0 | 626 | #if _SL_INCLUDE_FUNC(sl_Send) |
| IanBenzMaxim | 0:33d4e66780c0 | 627 | _i16 sl_Send(_i16 sd, const void *pBuf, _i16 Len, _i16 flags) |
| IanBenzMaxim | 0:33d4e66780c0 | 628 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 629 | _SlSendMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 630 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 631 | _u16 ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 632 | _i16 RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 633 | _u32 tempVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 634 | _u8 runSingleChunk = FALSE; |
| IanBenzMaxim | 0:33d4e66780c0 | 635 | |
| IanBenzMaxim | 0:33d4e66780c0 | 636 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 637 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 638 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 639 | |
| IanBenzMaxim | 0:33d4e66780c0 | 640 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 641 | CmdExt.TxPayloadLen = (_u16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 642 | CmdExt.pTxPayload = (_u8 *)pBuf; |
| IanBenzMaxim | 0:33d4e66780c0 | 643 | |
| IanBenzMaxim | 0:33d4e66780c0 | 644 | /* Only for RAW transceiver type socket, relay the flags parameter in the 2 bytes (4 byte aligned) before the actual payload */ |
| IanBenzMaxim | 0:33d4e66780c0 | 645 | if ((sd & SL_SOCKET_PAYLOAD_TYPE_MASK) == SL_SOCKET_PAYLOAD_TYPE_RAW_TRANCEIVER) |
| IanBenzMaxim | 0:33d4e66780c0 | 646 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 647 | tempVal = (_u32)flags; |
| IanBenzMaxim | 0:33d4e66780c0 | 648 | CmdExt.pRxPayload = (_u8 *)&tempVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 649 | CmdExt.RxPayloadLen = -4; /* mark as Rx data to send */ |
| IanBenzMaxim | 0:33d4e66780c0 | 650 | runSingleChunk = TRUE; |
| IanBenzMaxim | 0:33d4e66780c0 | 651 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 652 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 653 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 654 | CmdExt.pRxPayload = NULL; |
| IanBenzMaxim | 0:33d4e66780c0 | 655 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 656 | |
| IanBenzMaxim | 0:33d4e66780c0 | 657 | ChunkLen = _sl_TruncatePayloadByProtocol(sd,(_u16)Len); |
| IanBenzMaxim | 0:33d4e66780c0 | 658 | CmdExt.TxPayloadLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 659 | Msg.Cmd.StatusOrLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 660 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 661 | Msg.Cmd.FamilyAndFlags |= flags & 0x0F; |
| IanBenzMaxim | 0:33d4e66780c0 | 662 | |
| IanBenzMaxim | 0:33d4e66780c0 | 663 | do |
| IanBenzMaxim | 0:33d4e66780c0 | 664 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 665 | RetVal = _SlDrvDataWriteOp((_u8)sd, (_SlCmdCtrl_t *)&_SlSendCmdCtrl, &Msg, &CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 666 | if(SL_OS_RET_CODE_OK == RetVal) |
| IanBenzMaxim | 0:33d4e66780c0 | 667 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 668 | CmdExt.pTxPayload += ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 669 | ChunkLen = (_u16)((_u8 *)pBuf + Len - CmdExt.pTxPayload); |
| IanBenzMaxim | 0:33d4e66780c0 | 670 | ChunkLen = _sl_TruncatePayloadByProtocol(sd, ChunkLen); |
| IanBenzMaxim | 0:33d4e66780c0 | 671 | CmdExt.TxPayloadLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 672 | Msg.Cmd.StatusOrLen = ChunkLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 673 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 674 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 675 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 676 | return RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 677 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 678 | }while((ChunkLen > 0) && (runSingleChunk==FALSE)); |
| IanBenzMaxim | 0:33d4e66780c0 | 679 | |
| IanBenzMaxim | 0:33d4e66780c0 | 680 | return (_i16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 681 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 682 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 683 | |
| IanBenzMaxim | 0:33d4e66780c0 | 684 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 685 | /* sl_Listen */ |
| IanBenzMaxim | 0:33d4e66780c0 | 686 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 687 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 688 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 689 | _ListenCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 690 | _BasicResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 691 | }_SlListenMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 692 | |
| IanBenzMaxim | 0:33d4e66780c0 | 693 | |
| IanBenzMaxim | 0:33d4e66780c0 | 694 | |
| IanBenzMaxim | 0:33d4e66780c0 | 695 | #if _SL_INCLUDE_FUNC(sl_Listen) |
| IanBenzMaxim | 0:33d4e66780c0 | 696 | |
| IanBenzMaxim | 0:33d4e66780c0 | 697 | static const _SlCmdCtrl_t _SlListenCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 698 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 699 | SL_OPCODE_SOCKET_LISTEN, |
| IanBenzMaxim | 0:33d4e66780c0 | 700 | (_SlArgSize_t)sizeof(_ListenCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 701 | (_SlArgSize_t)sizeof(_BasicResponse_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 702 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 703 | |
| IanBenzMaxim | 0:33d4e66780c0 | 704 | _i16 sl_Listen(_i16 sd, _i16 backlog) |
| IanBenzMaxim | 0:33d4e66780c0 | 705 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 706 | _SlListenMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 707 | |
| IanBenzMaxim | 0:33d4e66780c0 | 708 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 709 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 710 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 711 | |
| IanBenzMaxim | 0:33d4e66780c0 | 712 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 713 | Msg.Cmd.backlog = (_u8)backlog; |
| IanBenzMaxim | 0:33d4e66780c0 | 714 | |
| IanBenzMaxim | 0:33d4e66780c0 | 715 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlListenCmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 716 | |
| IanBenzMaxim | 0:33d4e66780c0 | 717 | return (_i16)Msg.Rsp.status; |
| IanBenzMaxim | 0:33d4e66780c0 | 718 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 719 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 720 | |
| IanBenzMaxim | 0:33d4e66780c0 | 721 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 722 | /* sl_Accept */ |
| IanBenzMaxim | 0:33d4e66780c0 | 723 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 724 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 725 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 726 | _AcceptCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 727 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 728 | }_SlSockAcceptMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 729 | |
| IanBenzMaxim | 0:33d4e66780c0 | 730 | |
| IanBenzMaxim | 0:33d4e66780c0 | 731 | |
| IanBenzMaxim | 0:33d4e66780c0 | 732 | #if _SL_INCLUDE_FUNC(sl_Accept) |
| IanBenzMaxim | 0:33d4e66780c0 | 733 | |
| IanBenzMaxim | 0:33d4e66780c0 | 734 | static const _SlCmdCtrl_t _SlAcceptCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 735 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 736 | SL_OPCODE_SOCKET_ACCEPT, |
| IanBenzMaxim | 0:33d4e66780c0 | 737 | (_SlArgSize_t)sizeof(_AcceptCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 738 | (_SlArgSize_t)sizeof(_BasicResponse_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 739 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 740 | |
| IanBenzMaxim | 0:33d4e66780c0 | 741 | _i16 sl_Accept(_i16 sd, SlSockAddr_t *addr, SlSocklen_t *addrlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 742 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 743 | _SlSockAcceptMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 744 | _SlReturnVal_t RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 745 | _SocketAddrResponse_u AsyncRsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 746 | |
| IanBenzMaxim | 0:33d4e66780c0 | 747 | _u8 ObjIdx = MAX_CONCURRENT_ACTIONS; |
| IanBenzMaxim | 0:33d4e66780c0 | 748 | |
| IanBenzMaxim | 0:33d4e66780c0 | 749 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 750 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 751 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 752 | |
| IanBenzMaxim | 0:33d4e66780c0 | 753 | |
| IanBenzMaxim | 0:33d4e66780c0 | 754 | |
| IanBenzMaxim | 0:33d4e66780c0 | 755 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 756 | Msg.Cmd.family = (_u8)((sizeof(SlSockAddrIn_t) == *addrlen) ? SL_AF_INET : SL_AF_INET6); |
| IanBenzMaxim | 0:33d4e66780c0 | 757 | |
| IanBenzMaxim | 0:33d4e66780c0 | 758 | |
| IanBenzMaxim | 0:33d4e66780c0 | 759 | ObjIdx = _SlDrvProtectAsyncRespSetting((_u8*)&AsyncRsp, ACCEPT_ID, (_u8)sd & BSD_SOCKET_ID_MASK ); |
| IanBenzMaxim | 0:33d4e66780c0 | 760 | |
| IanBenzMaxim | 0:33d4e66780c0 | 761 | if (MAX_CONCURRENT_ACTIONS == ObjIdx) |
| IanBenzMaxim | 0:33d4e66780c0 | 762 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 763 | return SL_POOL_IS_EMPTY; |
| IanBenzMaxim | 0:33d4e66780c0 | 764 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 765 | |
| IanBenzMaxim | 0:33d4e66780c0 | 766 | /* send the command */ |
| IanBenzMaxim | 0:33d4e66780c0 | 767 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlAcceptCmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 768 | VERIFY_PROTOCOL(Msg.Rsp.sd == (_u8)sd); |
| IanBenzMaxim | 0:33d4e66780c0 | 769 | |
| IanBenzMaxim | 0:33d4e66780c0 | 770 | RetVal = Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 771 | |
| IanBenzMaxim | 0:33d4e66780c0 | 772 | if(SL_OS_RET_CODE_OK == RetVal) |
| IanBenzMaxim | 0:33d4e66780c0 | 773 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 774 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 775 | /* in case socket is non-blocking one, the async event should be received immediately */ |
| IanBenzMaxim | 0:33d4e66780c0 | 776 | if( g_pCB->SocketNonBlocking & (1<<(sd & BSD_SOCKET_ID_MASK) )) |
| IanBenzMaxim | 0:33d4e66780c0 | 777 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 778 | SL_DRV_SYNC_OBJ_WAIT_TIMEOUT(&g_pCB->ObjPool[ObjIdx].SyncObj, |
| IanBenzMaxim | 0:33d4e66780c0 | 779 | SL_DRIVER_TIMEOUT_SHORT, |
| IanBenzMaxim | 0:33d4e66780c0 | 780 | SL_DRIVER_API_SOCKET_ACCEPT |
| IanBenzMaxim | 0:33d4e66780c0 | 781 | ); |
| IanBenzMaxim | 0:33d4e66780c0 | 782 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 783 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 784 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 785 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 786 | /* wait for async and get Data Read parameters */ |
| IanBenzMaxim | 0:33d4e66780c0 | 787 | SL_DRV_SYNC_OBJ_WAIT_FOREVER(&g_pCB->ObjPool[ObjIdx].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 788 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 789 | |
| IanBenzMaxim | 0:33d4e66780c0 | 790 | VERIFY_PROTOCOL(AsyncRsp.IpV4.sd == (_u8)sd); |
| IanBenzMaxim | 0:33d4e66780c0 | 791 | |
| IanBenzMaxim | 0:33d4e66780c0 | 792 | RetVal = AsyncRsp.IpV4.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 793 | if( (NULL != addr) && (NULL != addrlen) ) |
| IanBenzMaxim | 0:33d4e66780c0 | 794 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 795 | #if 0 /* Kept for backup */ |
| IanBenzMaxim | 0:33d4e66780c0 | 796 | _sl_ParseAddress(&AsyncRsp, addr, addrlen); |
| IanBenzMaxim | 0:33d4e66780c0 | 797 | #else |
| IanBenzMaxim | 0:33d4e66780c0 | 798 | addr->sa_family = AsyncRsp.IpV4.family; |
| IanBenzMaxim | 0:33d4e66780c0 | 799 | |
| IanBenzMaxim | 0:33d4e66780c0 | 800 | if(SL_AF_INET == addr->sa_family) |
| IanBenzMaxim | 0:33d4e66780c0 | 801 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 802 | if( *addrlen == (SlSocklen_t)sizeof( SlSockAddrIn_t ) ) |
| IanBenzMaxim | 0:33d4e66780c0 | 803 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 804 | ((SlSockAddrIn_t *)addr)->sin_port = AsyncRsp.IpV4.port; |
| IanBenzMaxim | 0:33d4e66780c0 | 805 | ((SlSockAddrIn_t *)addr)->sin_addr.s_addr = AsyncRsp.IpV4.address; |
| IanBenzMaxim | 0:33d4e66780c0 | 806 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 807 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 808 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 809 | *addrlen = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 810 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 811 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 812 | else if (SL_AF_INET6_EUI_48 == addr->sa_family ) |
| IanBenzMaxim | 0:33d4e66780c0 | 813 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 814 | if( *addrlen == (SlSocklen_t)sizeof( SlSockAddrIn6_t ) ) |
| IanBenzMaxim | 0:33d4e66780c0 | 815 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 816 | ((SlSockAddrIn6_t *)addr)->sin6_port = AsyncRsp.IpV6EUI48.port ; |
| IanBenzMaxim | 0:33d4e66780c0 | 817 | /* will be called from here and from _sl_BuildAddress*/ |
| IanBenzMaxim | 0:33d4e66780c0 | 818 | sl_Memcpy(((SlSockAddrIn6_t *)addr)->sin6_addr._S6_un._S6_u8, AsyncRsp.IpV6EUI48.address, 6); |
| IanBenzMaxim | 0:33d4e66780c0 | 819 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 820 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 821 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 822 | *addrlen = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 823 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 824 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 825 | #ifdef SL_SUPPORT_IPV6 |
| IanBenzMaxim | 0:33d4e66780c0 | 826 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 827 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 828 | if( *addrlen == sizeof( sockaddr_in6 ) ) |
| IanBenzMaxim | 0:33d4e66780c0 | 829 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 830 | ((sockaddr_in6 *)addr)->sin6_port = AsyncRsp.IpV6.port ; |
| IanBenzMaxim | 0:33d4e66780c0 | 831 | sl_Memcpy(((sockaddr_in6 *)addr)->sin6_addr._S6_un._S6_u32, AsyncRsp.IpV6.address, 16); |
| IanBenzMaxim | 0:33d4e66780c0 | 832 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 833 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 834 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 835 | *addrlen = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 836 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 837 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 838 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 839 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 840 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 841 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 842 | |
| IanBenzMaxim | 0:33d4e66780c0 | 843 | _SlDrvReleasePoolObj(ObjIdx); |
| IanBenzMaxim | 0:33d4e66780c0 | 844 | return (_i16)RetVal; |
| IanBenzMaxim | 0:33d4e66780c0 | 845 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 846 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 847 | |
| IanBenzMaxim | 0:33d4e66780c0 | 848 | |
| IanBenzMaxim | 0:33d4e66780c0 | 849 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 850 | /* sl_Htonl */ |
| IanBenzMaxim | 0:33d4e66780c0 | 851 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 852 | _u32 sl_Htonl( _u32 val ) |
| IanBenzMaxim | 0:33d4e66780c0 | 853 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 854 | _u32 i = 1; |
| IanBenzMaxim | 0:33d4e66780c0 | 855 | _i8 *p = (_i8 *)&i; |
| IanBenzMaxim | 0:33d4e66780c0 | 856 | if (p[0] == 1) /* little endian */ |
| IanBenzMaxim | 0:33d4e66780c0 | 857 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 858 | p[0] = ((_i8* )&val)[3]; |
| IanBenzMaxim | 0:33d4e66780c0 | 859 | p[1] = ((_i8* )&val)[2]; |
| IanBenzMaxim | 0:33d4e66780c0 | 860 | p[2] = ((_i8* )&val)[1]; |
| IanBenzMaxim | 0:33d4e66780c0 | 861 | p[3] = ((_i8* )&val)[0]; |
| IanBenzMaxim | 0:33d4e66780c0 | 862 | return i; |
| IanBenzMaxim | 0:33d4e66780c0 | 863 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 864 | else /* big endian */ |
| IanBenzMaxim | 0:33d4e66780c0 | 865 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 866 | return val; |
| IanBenzMaxim | 0:33d4e66780c0 | 867 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 868 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 869 | |
| IanBenzMaxim | 0:33d4e66780c0 | 870 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 871 | /* sl_Htonl */ |
| IanBenzMaxim | 0:33d4e66780c0 | 872 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 873 | _u16 sl_Htons( _u16 val ) |
| IanBenzMaxim | 0:33d4e66780c0 | 874 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 875 | _i16 i = 1; |
| IanBenzMaxim | 0:33d4e66780c0 | 876 | _i8 *p = (_i8 *)&i; |
| IanBenzMaxim | 0:33d4e66780c0 | 877 | if (p[0] == 1) /* little endian */ |
| IanBenzMaxim | 0:33d4e66780c0 | 878 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 879 | p[0] = ((_i8* )&val)[1]; |
| IanBenzMaxim | 0:33d4e66780c0 | 880 | p[1] = ((_i8* )&val)[0]; |
| IanBenzMaxim | 0:33d4e66780c0 | 881 | return (_u16)i; |
| IanBenzMaxim | 0:33d4e66780c0 | 882 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 883 | else /* big endian */ |
| IanBenzMaxim | 0:33d4e66780c0 | 884 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 885 | return val; |
| IanBenzMaxim | 0:33d4e66780c0 | 886 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 887 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 888 | |
| IanBenzMaxim | 0:33d4e66780c0 | 889 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 890 | /* _sl_HandleAsync_Accept */ |
| IanBenzMaxim | 0:33d4e66780c0 | 891 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 892 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 893 | _SlReturnVal_t _sl_HandleAsync_Accept(void *pVoidBuf) |
| IanBenzMaxim | 0:33d4e66780c0 | 894 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 895 | _SocketAddrResponse_u *pMsgArgs = (_SocketAddrResponse_u *)_SL_RESP_ARGS_START(pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 896 | |
| IanBenzMaxim | 0:33d4e66780c0 | 897 | SL_DRV_PROTECTION_OBJ_LOCK_FOREVER(); |
| IanBenzMaxim | 0:33d4e66780c0 | 898 | |
| IanBenzMaxim | 0:33d4e66780c0 | 899 | VERIFY_PROTOCOL(( pMsgArgs->IpV4.sd & BSD_SOCKET_ID_MASK) <= SL_MAX_SOCKETS); |
| IanBenzMaxim | 0:33d4e66780c0 | 900 | VERIFY_SOCKET_CB(NULL != g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs); |
| IanBenzMaxim | 0:33d4e66780c0 | 901 | |
| IanBenzMaxim | 0:33d4e66780c0 | 902 | sl_Memcpy(g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs, pMsgArgs,sizeof(_SocketAddrResponse_u)); |
| IanBenzMaxim | 0:33d4e66780c0 | 903 | SL_DRV_SYNC_OBJ_SIGNAL(&g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 904 | |
| IanBenzMaxim | 0:33d4e66780c0 | 905 | SL_DRV_PROTECTION_OBJ_UNLOCK(); |
| IanBenzMaxim | 0:33d4e66780c0 | 906 | return SL_RET_CODE_OK; |
| IanBenzMaxim | 0:33d4e66780c0 | 907 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 908 | |
| IanBenzMaxim | 0:33d4e66780c0 | 909 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 910 | /* _sl_HandleAsync_Select */ |
| IanBenzMaxim | 0:33d4e66780c0 | 911 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 912 | _SlReturnVal_t _sl_HandleAsync_Select(void *pVoidBuf) |
| IanBenzMaxim | 0:33d4e66780c0 | 913 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 914 | _SelectAsyncResponse_t *pMsgArgs = (_SelectAsyncResponse_t *)_SL_RESP_ARGS_START(pVoidBuf); |
| IanBenzMaxim | 0:33d4e66780c0 | 915 | |
| IanBenzMaxim | 0:33d4e66780c0 | 916 | SL_DRV_PROTECTION_OBJ_LOCK_FOREVER(); |
| IanBenzMaxim | 0:33d4e66780c0 | 917 | |
| IanBenzMaxim | 0:33d4e66780c0 | 918 | VERIFY_SOCKET_CB(NULL != g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs); |
| IanBenzMaxim | 0:33d4e66780c0 | 919 | |
| IanBenzMaxim | 0:33d4e66780c0 | 920 | sl_Memcpy(g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].pRespArgs, pMsgArgs, sizeof(_SelectAsyncResponse_t)); |
| IanBenzMaxim | 0:33d4e66780c0 | 921 | |
| IanBenzMaxim | 0:33d4e66780c0 | 922 | SL_DRV_SYNC_OBJ_SIGNAL(&g_pCB->ObjPool[g_pCB->FunctionParams.AsyncExt.ActionIndex].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 923 | |
| IanBenzMaxim | 0:33d4e66780c0 | 924 | SL_DRV_PROTECTION_OBJ_UNLOCK(); |
| IanBenzMaxim | 0:33d4e66780c0 | 925 | |
| IanBenzMaxim | 0:33d4e66780c0 | 926 | return SL_RET_CODE_OK; |
| IanBenzMaxim | 0:33d4e66780c0 | 927 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 928 | |
| IanBenzMaxim | 0:33d4e66780c0 | 929 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 930 | |
| IanBenzMaxim | 0:33d4e66780c0 | 931 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 932 | /* sl_Recv */ |
| IanBenzMaxim | 0:33d4e66780c0 | 933 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 934 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 935 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 936 | _sendRecvCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 937 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 938 | }_SlRecvMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 939 | |
| IanBenzMaxim | 0:33d4e66780c0 | 940 | |
| IanBenzMaxim | 0:33d4e66780c0 | 941 | #if _SL_INCLUDE_FUNC(sl_Recv) |
| IanBenzMaxim | 0:33d4e66780c0 | 942 | |
| IanBenzMaxim | 0:33d4e66780c0 | 943 | static const _SlCmdCtrl_t _SlRecvCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 944 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 945 | SL_OPCODE_SOCKET_RECV, |
| IanBenzMaxim | 0:33d4e66780c0 | 946 | (_SlArgSize_t)sizeof(_sendRecvCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 947 | (_SlArgSize_t)sizeof(_SocketResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 948 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 949 | |
| IanBenzMaxim | 0:33d4e66780c0 | 950 | |
| IanBenzMaxim | 0:33d4e66780c0 | 951 | _i16 sl_Recv(_i16 sd, void *pBuf, _i16 Len, _i16 flags) |
| IanBenzMaxim | 0:33d4e66780c0 | 952 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 953 | _SlRecvMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 954 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 955 | _SlReturnVal_t status; |
| IanBenzMaxim | 0:33d4e66780c0 | 956 | |
| IanBenzMaxim | 0:33d4e66780c0 | 957 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 958 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 959 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 960 | |
| IanBenzMaxim | 0:33d4e66780c0 | 961 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 962 | CmdExt.RxPayloadLen = Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 963 | CmdExt.pRxPayload = (_u8 *)pBuf; |
| IanBenzMaxim | 0:33d4e66780c0 | 964 | |
| IanBenzMaxim | 0:33d4e66780c0 | 965 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 966 | Msg.Cmd.StatusOrLen = (_u16)Len; |
| IanBenzMaxim | 0:33d4e66780c0 | 967 | |
| IanBenzMaxim | 0:33d4e66780c0 | 968 | /* no size truncation in recv path */ |
| IanBenzMaxim | 0:33d4e66780c0 | 969 | CmdExt.RxPayloadLen = (_i16)Msg.Cmd.StatusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 970 | |
| IanBenzMaxim | 0:33d4e66780c0 | 971 | Msg.Cmd.FamilyAndFlags = (_u8)(flags & 0x0F); |
| IanBenzMaxim | 0:33d4e66780c0 | 972 | |
| IanBenzMaxim | 0:33d4e66780c0 | 973 | status = _SlDrvDataReadOp((_SlSd_t)sd, (_SlCmdCtrl_t *)&_SlRecvCmdCtrl, &Msg, &CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 974 | if( status != SL_OS_RET_CODE_OK ) |
| IanBenzMaxim | 0:33d4e66780c0 | 975 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 976 | return status; |
| IanBenzMaxim | 0:33d4e66780c0 | 977 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 978 | |
| IanBenzMaxim | 0:33d4e66780c0 | 979 | /* if the Device side sends less than expected it is not the Driver's role */ |
| IanBenzMaxim | 0:33d4e66780c0 | 980 | /* the returned value could be smaller than the requested size */ |
| IanBenzMaxim | 0:33d4e66780c0 | 981 | return (_i16)Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 982 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 983 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 984 | |
| IanBenzMaxim | 0:33d4e66780c0 | 985 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 986 | /* sl_SetSockOpt */ |
| IanBenzMaxim | 0:33d4e66780c0 | 987 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 988 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 989 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 990 | _setSockOptCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 991 | _SocketResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 992 | }_SlSetSockOptMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 993 | |
| IanBenzMaxim | 0:33d4e66780c0 | 994 | static const _SlCmdCtrl_t _SlSetSockOptCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 995 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 996 | SL_OPCODE_SOCKET_SETSOCKOPT, |
| IanBenzMaxim | 0:33d4e66780c0 | 997 | (_SlArgSize_t)sizeof(_setSockOptCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 998 | (_SlArgSize_t)sizeof(_SocketResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 999 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 1000 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1001 | #if _SL_INCLUDE_FUNC(sl_SetSockOpt) |
| IanBenzMaxim | 0:33d4e66780c0 | 1002 | _i16 sl_SetSockOpt(_i16 sd, _i16 level, _i16 optname, const void *optval, SlSocklen_t optlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 1003 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1004 | _SlSetSockOptMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 1005 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 1006 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1007 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 1008 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1009 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 1010 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1011 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 1012 | CmdExt.TxPayloadLen = optlen; |
| IanBenzMaxim | 0:33d4e66780c0 | 1013 | CmdExt.pTxPayload = (_u8 *)optval; |
| IanBenzMaxim | 0:33d4e66780c0 | 1014 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1015 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 1016 | Msg.Cmd.level = (_u8)level; |
| IanBenzMaxim | 0:33d4e66780c0 | 1017 | Msg.Cmd.optionLen = (_u8)optlen; |
| IanBenzMaxim | 0:33d4e66780c0 | 1018 | Msg.Cmd.optionName = (_u8)optname; |
| IanBenzMaxim | 0:33d4e66780c0 | 1019 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1020 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSetSockOptCmdCtrl, &Msg, &CmdExt)); |
| IanBenzMaxim | 0:33d4e66780c0 | 1021 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1022 | return (_i16)Msg.Rsp.statusOrLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 1023 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1024 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 1025 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1026 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1027 | /* sl_GetSockOpt */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1028 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1029 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 1030 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1031 | _getSockOptCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 1032 | _getSockOptResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 1033 | }_SlGetSockOptMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 1034 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1035 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1036 | #if _SL_INCLUDE_FUNC(sl_GetSockOpt) |
| IanBenzMaxim | 0:33d4e66780c0 | 1037 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1038 | static const _SlCmdCtrl_t _SlGetSockOptCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 1039 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1040 | SL_OPCODE_SOCKET_GETSOCKOPT, |
| IanBenzMaxim | 0:33d4e66780c0 | 1041 | (_SlArgSize_t)sizeof(_getSockOptCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 1042 | (_SlArgSize_t)sizeof(_getSockOptResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 1043 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 1044 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1045 | _i16 sl_GetSockOpt(_i16 sd, _i16 level, _i16 optname, void *optval, SlSocklen_t *optlen) |
| IanBenzMaxim | 0:33d4e66780c0 | 1046 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1047 | _SlGetSockOptMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 1048 | _SlCmdExt_t CmdExt; |
| IanBenzMaxim | 0:33d4e66780c0 | 1049 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1050 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 1051 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1052 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 1053 | if (*optlen == 0) |
| IanBenzMaxim | 0:33d4e66780c0 | 1054 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1055 | return SL_EZEROLEN; |
| IanBenzMaxim | 0:33d4e66780c0 | 1056 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1057 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1058 | _SlDrvResetCmdExt(&CmdExt); |
| IanBenzMaxim | 0:33d4e66780c0 | 1059 | CmdExt.RxPayloadLen = (_i16)(*optlen); |
| IanBenzMaxim | 0:33d4e66780c0 | 1060 | CmdExt.pRxPayload = optval; |
| IanBenzMaxim | 0:33d4e66780c0 | 1061 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1062 | Msg.Cmd.sd = (_u8)sd; |
| IanBenzMaxim | 0:33d4e66780c0 | 1063 | Msg.Cmd.level = (_u8)level; |
| IanBenzMaxim | 0:33d4e66780c0 | 1064 | Msg.Cmd.optionLen = (_u8)(*optlen); |
| IanBenzMaxim | 0:33d4e66780c0 | 1065 | Msg.Cmd.optionName = (_u8)optname; |
| IanBenzMaxim | 0:33d4e66780c0 | 1066 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1067 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlGetSockOptCmdCtrl, &Msg, &CmdExt)); |
| IanBenzMaxim | 0:33d4e66780c0 | 1068 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1069 | if (CmdExt.RxPayloadLen < CmdExt.ActualRxPayloadLen) |
| IanBenzMaxim | 0:33d4e66780c0 | 1070 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1071 | *optlen = Msg.Rsp.optionLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 1072 | return SL_ESMALLBUF; |
| IanBenzMaxim | 0:33d4e66780c0 | 1073 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1074 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 1075 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1076 | *optlen = (_u8)CmdExt.ActualRxPayloadLen; |
| IanBenzMaxim | 0:33d4e66780c0 | 1077 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1078 | return (_i16)Msg.Rsp.status; |
| IanBenzMaxim | 0:33d4e66780c0 | 1079 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1080 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 1081 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1082 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1083 | /* sl_Select */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1084 | /* ******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1085 | typedef union |
| IanBenzMaxim | 0:33d4e66780c0 | 1086 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1087 | _SelectCommand_t Cmd; |
| IanBenzMaxim | 0:33d4e66780c0 | 1088 | _BasicResponse_t Rsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 1089 | }_SlSelectMsg_u; |
| IanBenzMaxim | 0:33d4e66780c0 | 1090 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1091 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1092 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1093 | #ifndef SL_TINY_EXT |
| IanBenzMaxim | 0:33d4e66780c0 | 1094 | #if _SL_INCLUDE_FUNC(sl_Select) |
| IanBenzMaxim | 0:33d4e66780c0 | 1095 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1096 | static const _SlCmdCtrl_t _SlSelectCmdCtrl = |
| IanBenzMaxim | 0:33d4e66780c0 | 1097 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1098 | SL_OPCODE_SOCKET_SELECT, |
| IanBenzMaxim | 0:33d4e66780c0 | 1099 | (_SlArgSize_t)sizeof(_SelectCommand_t), |
| IanBenzMaxim | 0:33d4e66780c0 | 1100 | (_SlArgSize_t)sizeof(_BasicResponse_t) |
| IanBenzMaxim | 0:33d4e66780c0 | 1101 | }; |
| IanBenzMaxim | 0:33d4e66780c0 | 1102 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1103 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1104 | _i16 sl_Select(_i16 nfds, SlFdSet_t *readsds, SlFdSet_t *writesds, SlFdSet_t *exceptsds, struct SlTimeval_t *timeout) |
| IanBenzMaxim | 0:33d4e66780c0 | 1105 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1106 | _SlSelectMsg_u Msg; |
| IanBenzMaxim | 0:33d4e66780c0 | 1107 | _SelectAsyncResponse_t AsyncRsp; |
| IanBenzMaxim | 0:33d4e66780c0 | 1108 | _u8 ObjIdx = MAX_CONCURRENT_ACTIONS; |
| IanBenzMaxim | 0:33d4e66780c0 | 1109 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1110 | /* verify no erorr handling in progress. if in progress than |
| IanBenzMaxim | 0:33d4e66780c0 | 1111 | ignore the API execution and return immediately with an error */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1112 | VERIFY_NO_ERROR_HANDLING_IN_PROGRESS(); |
| IanBenzMaxim | 0:33d4e66780c0 | 1113 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1114 | Msg.Cmd.nfds = (_u8)nfds; |
| IanBenzMaxim | 0:33d4e66780c0 | 1115 | Msg.Cmd.readFdsCount = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1116 | Msg.Cmd.writeFdsCount = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1117 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1118 | Msg.Cmd.readFds = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1119 | Msg.Cmd.writeFds = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1120 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1121 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1122 | if( readsds ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1123 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1124 | Msg.Cmd.readFds = (_u16)readsds->fd_array[0]; |
| IanBenzMaxim | 0:33d4e66780c0 | 1125 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1126 | if( writesds ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1127 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1128 | Msg.Cmd.writeFds = (_u16)writesds->fd_array[0]; |
| IanBenzMaxim | 0:33d4e66780c0 | 1129 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1130 | if( NULL == timeout ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1131 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1132 | Msg.Cmd.tv_sec = 0xffff; |
| IanBenzMaxim | 0:33d4e66780c0 | 1133 | Msg.Cmd.tv_usec = 0xffff; |
| IanBenzMaxim | 0:33d4e66780c0 | 1134 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1135 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 1136 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1137 | if( 0xffff <= timeout->tv_sec ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1138 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1139 | Msg.Cmd.tv_sec = 0xffff; |
| IanBenzMaxim | 0:33d4e66780c0 | 1140 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1141 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 1142 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1143 | Msg.Cmd.tv_sec = (_u16)timeout->tv_sec; |
| IanBenzMaxim | 0:33d4e66780c0 | 1144 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1145 | timeout->tv_usec = timeout->tv_usec >> 10; /* convert to milliseconds */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1146 | if( 0xffff <= timeout->tv_usec ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1147 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1148 | Msg.Cmd.tv_usec = 0xffff; |
| IanBenzMaxim | 0:33d4e66780c0 | 1149 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1150 | else |
| IanBenzMaxim | 0:33d4e66780c0 | 1151 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1152 | Msg.Cmd.tv_usec = (_u16)timeout->tv_usec; |
| IanBenzMaxim | 0:33d4e66780c0 | 1153 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1154 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1155 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1156 | /* Use Obj to issue the command, if not available try later */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1157 | ObjIdx = _SlDrvProtectAsyncRespSetting((_u8*)&AsyncRsp, SELECT_ID, SL_MAX_SOCKETS); |
| IanBenzMaxim | 0:33d4e66780c0 | 1158 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1159 | if (MAX_CONCURRENT_ACTIONS == ObjIdx) |
| IanBenzMaxim | 0:33d4e66780c0 | 1160 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1161 | return SL_POOL_IS_EMPTY; |
| IanBenzMaxim | 0:33d4e66780c0 | 1162 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1163 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1164 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1165 | /* send the command */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1166 | VERIFY_RET_OK(_SlDrvCmdOp((_SlCmdCtrl_t *)&_SlSelectCmdCtrl, &Msg, NULL)); |
| IanBenzMaxim | 0:33d4e66780c0 | 1167 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1168 | if(SL_OS_RET_CODE_OK == (_i16)Msg.Rsp.status) |
| IanBenzMaxim | 0:33d4e66780c0 | 1169 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1170 | SL_DRV_SYNC_OBJ_WAIT_FOREVER(&g_pCB->ObjPool[ObjIdx].SyncObj); |
| IanBenzMaxim | 0:33d4e66780c0 | 1171 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1172 | Msg.Rsp.status = (_i16)AsyncRsp.status; |
| IanBenzMaxim | 0:33d4e66780c0 | 1173 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1174 | if( ((_i16)Msg.Rsp.status) >= 0 ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1175 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1176 | if( readsds ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1177 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1178 | readsds->fd_array[0] = AsyncRsp.readFds; |
| IanBenzMaxim | 0:33d4e66780c0 | 1179 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1180 | if( writesds ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1181 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1182 | writesds->fd_array[0] = AsyncRsp.writeFds; |
| IanBenzMaxim | 0:33d4e66780c0 | 1183 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1184 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1185 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1186 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1187 | _SlDrvReleasePoolObj(ObjIdx); |
| IanBenzMaxim | 0:33d4e66780c0 | 1188 | return (_i16)Msg.Rsp.status; |
| IanBenzMaxim | 0:33d4e66780c0 | 1189 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1190 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1191 | /* Select helper functions */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1192 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1193 | /* SL_FD_SET */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1194 | /* ******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1195 | void SL_FD_SET(_i16 fd, SlFdSet_t *fdset) |
| IanBenzMaxim | 0:33d4e66780c0 | 1196 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1197 | fdset->fd_array[0] |= (1<< (fd & BSD_SOCKET_ID_MASK)); |
| IanBenzMaxim | 0:33d4e66780c0 | 1198 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1199 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1200 | /* SL_FD_CLR */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1201 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1202 | void SL_FD_CLR(_i16 fd, SlFdSet_t *fdset) |
| IanBenzMaxim | 0:33d4e66780c0 | 1203 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1204 | fdset->fd_array[0] &= ~(1<< (fd & BSD_SOCKET_ID_MASK)); |
| IanBenzMaxim | 0:33d4e66780c0 | 1205 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1206 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1207 | /* SL_FD_ISSET */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1208 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1209 | _i16 SL_FD_ISSET(_i16 fd, SlFdSet_t *fdset) |
| IanBenzMaxim | 0:33d4e66780c0 | 1210 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1211 | if( fdset->fd_array[0] & (1<< (fd & BSD_SOCKET_ID_MASK)) ) |
| IanBenzMaxim | 0:33d4e66780c0 | 1212 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1213 | return 1; |
| IanBenzMaxim | 0:33d4e66780c0 | 1214 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1215 | return 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1216 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1217 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1218 | /* SL_FD_ZERO */ |
| IanBenzMaxim | 0:33d4e66780c0 | 1219 | /*******************************************************************************/ |
| IanBenzMaxim | 0:33d4e66780c0 | 1220 | void SL_FD_ZERO(SlFdSet_t *fdset) |
| IanBenzMaxim | 0:33d4e66780c0 | 1221 | { |
| IanBenzMaxim | 0:33d4e66780c0 | 1222 | fdset->fd_array[0] = 0; |
| IanBenzMaxim | 0:33d4e66780c0 | 1223 | } |
| IanBenzMaxim | 0:33d4e66780c0 | 1224 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1225 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 1226 | #endif |
| IanBenzMaxim | 0:33d4e66780c0 | 1227 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1228 | |
| IanBenzMaxim | 0:33d4e66780c0 | 1229 |