net/usrsock: add send multi-elements support
Signed-off-by: chao.an <anchao@xiaomi.com>
This commit is contained in:
parent
083a11a3c3
commit
03f899f302
|
@ -148,24 +148,18 @@ static uint16_t sendto_event(FAR struct net_driver_s *dev, FAR void *pvconn,
|
|||
****************************************************************************/
|
||||
|
||||
static int do_sendto_request(FAR struct usrsock_conn_s *conn,
|
||||
FAR const void *buf, size_t buflen,
|
||||
FAR const struct sockaddr *addr,
|
||||
socklen_t addrlen, int32_t flags)
|
||||
FAR struct msghdr *msg, int flags)
|
||||
{
|
||||
struct usrsock_request_sendto_s req =
|
||||
{
|
||||
};
|
||||
|
||||
struct iovec bufs[3];
|
||||
struct iovec bufs[2 + msg->msg_iovlen];
|
||||
int i;
|
||||
|
||||
if (addrlen > UINT16_MAX)
|
||||
if (msg->msg_namelen > UINT16_MAX)
|
||||
{
|
||||
addrlen = UINT16_MAX;
|
||||
}
|
||||
|
||||
if (buflen > UINT16_MAX)
|
||||
{
|
||||
buflen = UINT16_MAX;
|
||||
msg->msg_namelen = UINT16_MAX;
|
||||
}
|
||||
|
||||
/* Prepare request for daemon to read. */
|
||||
|
@ -173,15 +167,24 @@ static int do_sendto_request(FAR struct usrsock_conn_s *conn,
|
|||
req.head.reqid = USRSOCK_REQUEST_SENDTO;
|
||||
req.usockid = conn->usockid;
|
||||
req.flags = flags;
|
||||
req.addrlen = addrlen;
|
||||
req.buflen = buflen;
|
||||
req.addrlen = msg->msg_namelen;
|
||||
|
||||
for (i = 0; i < msg->msg_iovlen; i++)
|
||||
{
|
||||
req.buflen += msg->msg_iov[i].iov_len;
|
||||
}
|
||||
|
||||
if (req.buflen > UINT16_MAX)
|
||||
{
|
||||
req.buflen = UINT16_MAX;
|
||||
}
|
||||
|
||||
bufs[0].iov_base = (FAR void *)&req;
|
||||
bufs[0].iov_len = sizeof(req);
|
||||
bufs[1].iov_base = (FAR void *)addr;
|
||||
bufs[1].iov_len = addrlen;
|
||||
bufs[2].iov_base = (FAR void *)buf;
|
||||
bufs[2].iov_len = buflen;
|
||||
bufs[1].iov_base = msg->msg_name;
|
||||
bufs[1].iov_len = msg->msg_namelen;
|
||||
|
||||
memcpy(&bufs[2], msg->msg_iov, sizeof(struct iovec) * msg->msg_iovlen);
|
||||
|
||||
return usrsockdev_do_request(conn, bufs, ARRAY_SIZE(bufs));
|
||||
}
|
||||
|
@ -210,13 +213,9 @@ static int do_sendto_request(FAR struct usrsock_conn_s *conn,
|
|||
*
|
||||
****************************************************************************/
|
||||
|
||||
ssize_t usrsock_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg,
|
||||
int flags)
|
||||
ssize_t usrsock_sendmsg(FAR struct socket *psock,
|
||||
FAR struct msghdr *msg, int flags)
|
||||
{
|
||||
FAR const void *buf = msg->msg_iov->iov_base;
|
||||
size_t len = msg->msg_iov->iov_len;
|
||||
FAR const struct sockaddr *to = msg->msg_name;
|
||||
socklen_t tolen = msg->msg_namelen;
|
||||
FAR struct usrsock_conn_s *conn = psock->s_conn;
|
||||
struct usrsock_reqstate_s state =
|
||||
{
|
||||
|
@ -226,13 +225,6 @@ ssize_t usrsock_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg,
|
|||
|
||||
DEBUGASSERT(conn);
|
||||
|
||||
/* Validity check, only single iov supported */
|
||||
|
||||
if (msg->msg_iovlen != 1)
|
||||
{
|
||||
return -ENOTSUP;
|
||||
}
|
||||
|
||||
net_lock();
|
||||
|
||||
if (conn->state == USRSOCK_CONN_STATE_UNINITIALIZED ||
|
||||
|
@ -271,7 +263,7 @@ ssize_t usrsock_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg,
|
|||
}
|
||||
}
|
||||
|
||||
if (to || tolen)
|
||||
if (msg->msg_name || msg->msg_namelen)
|
||||
{
|
||||
/* Address provided for connection-mode socket */
|
||||
|
||||
|
@ -394,15 +386,13 @@ ssize_t usrsock_sendmsg(FAR struct socket *psock, FAR struct msghdr *msg,
|
|||
|
||||
/* Request user-space daemon to close socket. */
|
||||
|
||||
ret = do_sendto_request(conn, buf, len, to, tolen, flags);
|
||||
ret = do_sendto_request(conn, msg, flags);
|
||||
if (ret >= 0)
|
||||
{
|
||||
/* Wait for completion of request. */
|
||||
|
||||
net_lockedwait_uninterruptible(&state.recvsem);
|
||||
ret = state.result;
|
||||
|
||||
DEBUGASSERT(ret <= (ssize_t)len);
|
||||
}
|
||||
|
||||
usrsock_teardown_request_callback(&state);
|
||||
|
|
Loading…
Reference in New Issue