|
Packit |
cac203 |
/*
|
|
Packit |
cac203 |
* cli_usock.c - Teamd daemon control library teamd Unix Domain socket client
|
|
Packit |
cac203 |
* Copyright (C) 2013-2015 Jiri Pirko <jiri@resnulli.us>
|
|
Packit |
cac203 |
*
|
|
Packit |
cac203 |
* This library is free software; you can redistribute it and/or
|
|
Packit |
cac203 |
* modify it under the terms of the GNU Lesser General Public
|
|
Packit |
cac203 |
* License as published by the Free Software Foundation; either
|
|
Packit |
cac203 |
* version 2.1 of the License, or (at your option) any later version.
|
|
Packit |
cac203 |
*
|
|
Packit |
cac203 |
* This library is distributed in the hope that it will be useful,
|
|
Packit |
cac203 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
cac203 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit |
cac203 |
* Lesser General Public License for more details.
|
|
Packit |
cac203 |
*
|
|
Packit |
cac203 |
* You should have received a copy of the GNU Lesser General Public
|
|
Packit |
cac203 |
* License along with this library; if not, write to the Free Software
|
|
Packit |
cac203 |
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
Packit |
cac203 |
*/
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
#include <stdio.h>
|
|
Packit |
cac203 |
#include <stdlib.h>
|
|
Packit |
cac203 |
#include <string.h>
|
|
Packit |
cac203 |
#include <stdarg.h>
|
|
Packit |
cac203 |
#include <sys/types.h>
|
|
Packit |
cac203 |
#include <sys/socket.h>
|
|
Packit |
cac203 |
#include <unistd.h>
|
|
Packit |
cac203 |
#include <teamdctl.h>
|
|
Packit |
cac203 |
#include "teamdctl_private.h"
|
|
Packit |
cac203 |
#include "../teamd/teamd_usock_common.h"
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
/* \cond HIDDEN_SYMBOLS */
|
|
Packit |
cac203 |
struct cli_usock_priv {
|
|
Packit |
cac203 |
int sock;
|
|
Packit |
cac203 |
};
|
|
Packit |
cac203 |
/* \endcond */
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int cli_usock_process_msg(struct teamdctl *tdc, char *msg,
|
|
Packit |
cac203 |
char **p_replystr)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
char *str;
|
|
Packit |
cac203 |
char *rest = msg;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
str = teamd_usock_msg_getline(&rest);
|
|
Packit |
cac203 |
if (!str) {
|
|
Packit |
cac203 |
err(tdc, "usock: Incomplete message.\n");
|
|
Packit |
cac203 |
return -EINVAL;;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
if (!strcmp(TEAMD_USOCK_REPLY_SUCC_PREFIX, str)) {
|
|
Packit |
cac203 |
*p_replystr = rest;
|
|
Packit |
cac203 |
} else if (!strcmp(TEAMD_USOCK_REPLY_ERR_PREFIX, str)) {
|
|
Packit |
cac203 |
str = teamd_usock_msg_getline(&rest);
|
|
Packit |
cac203 |
if (!str) {
|
|
Packit |
cac203 |
err(tdc, "usock: Incomplete message.\n");
|
|
Packit |
cac203 |
return -EINVAL;;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
err(tdc, "usock: Error message received: \"%s\"", str);
|
|
Packit |
cac203 |
str = teamd_usock_msg_getline(&rest);
|
|
Packit |
cac203 |
if (!str) {
|
|
Packit |
cac203 |
err(tdc, "usock: Incomplete message.\n");
|
|
Packit |
cac203 |
return -EINVAL;;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
err(tdc, "usock: Error message content: \"%s\"", str);
|
|
Packit |
cac203 |
return -EINVAL;;
|
|
Packit |
cac203 |
} else {
|
|
Packit |
cac203 |
err(tdc, "usock: Unsupported message type.\n");
|
|
Packit |
cac203 |
return -EINVAL;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
return 0;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int cli_usock_send(int sock, char *msg)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
int err;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = send(sock, msg, strlen(msg), MSG_NOSIGNAL);
|
|
Packit |
cac203 |
if (err == -1)
|
|
Packit |
cac203 |
return -errno;
|
|
Packit |
cac203 |
return 0;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
#define WAIT_SEC (TEAMDCTL_REPLY_TIMEOUT / 1000)
|
|
Packit |
cac203 |
#define WAIT_USEC (TEAMDCTL_REPLY_TIMEOUT % 1000 * 1000)
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int cli_usock_wait_recv(int sock)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
fd_set rfds;
|
|
Packit |
cac203 |
int fdmax;
|
|
Packit |
cac203 |
int ret;
|
|
Packit |
cac203 |
struct timeval tv;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
tv.tv_sec = WAIT_SEC;
|
|
Packit |
cac203 |
tv.tv_usec = WAIT_USEC;
|
|
Packit |
cac203 |
FD_ZERO(&rfds);
|
|
Packit |
cac203 |
FD_SET(sock, &rfds);
|
|
Packit |
cac203 |
fdmax = sock + 1;
|
|
Packit |
cac203 |
ret = select(fdmax, &rfds, NULL, NULL, &tv;;
|
|
Packit |
cac203 |
if (ret == -1)
|
|
Packit |
cac203 |
return -errno;
|
|
Packit |
cac203 |
if (!FD_ISSET(sock, &rfds))
|
|
Packit |
cac203 |
return -ETIMEDOUT;
|
|
Packit |
cac203 |
return 0;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int myasprintf(char **p_str, const char *fmt, ...)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
char *newstr;
|
|
Packit |
cac203 |
va_list ap;
|
|
Packit |
cac203 |
int ret;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
va_start(ap, fmt);
|
|
Packit |
cac203 |
ret = vasprintf(&newstr, fmt, ap);
|
|
Packit |
cac203 |
va_end(ap);
|
|
Packit |
cac203 |
if (ret == -1)
|
|
Packit |
cac203 |
return -ENOMEM;
|
|
Packit |
cac203 |
free(*p_str);
|
|
Packit |
cac203 |
*p_str = newstr;
|
|
Packit |
cac203 |
return 0;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
char *__strencode(char *str)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
char *newstr;
|
|
Packit |
cac203 |
int i, j;
|
|
Packit |
cac203 |
size_t len = strlen(str);
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
for (i = 0; i < strlen(str); i++) {
|
|
Packit |
cac203 |
switch (str[i]) {
|
|
Packit |
cac203 |
case '\n':
|
|
Packit |
cac203 |
case '\\':
|
|
Packit |
cac203 |
len++;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
newstr = malloc(sizeof(char) * (len + 1));
|
|
Packit |
cac203 |
if (!newstr)
|
|
Packit |
cac203 |
return NULL;
|
|
Packit |
cac203 |
j = 0;
|
|
Packit |
cac203 |
for (i = 0; i <= strlen(str); i++) {
|
|
Packit |
cac203 |
switch (str[i]) {
|
|
Packit |
cac203 |
case '\n':
|
|
Packit |
cac203 |
newstr[j++] = '\\';
|
|
Packit |
cac203 |
newstr[j++] = 'n';
|
|
Packit |
cac203 |
break;
|
|
Packit |
cac203 |
case '\\':
|
|
Packit |
cac203 |
newstr[j++] = '\\';
|
|
Packit |
cac203 |
newstr[j++] = '\\';
|
|
Packit |
cac203 |
break;
|
|
Packit |
cac203 |
default:
|
|
Packit |
cac203 |
newstr[j++] = str[i];
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
return newstr;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int cli_usock_method_call(struct teamdctl *tdc, const char *method_name,
|
|
Packit |
cac203 |
char **p_reply, void *priv,
|
|
Packit |
cac203 |
const char *fmt, va_list ap)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
struct cli_usock_priv *cli_usock = priv;
|
|
Packit |
cac203 |
char *str;
|
|
Packit |
cac203 |
char *msg = NULL;
|
|
Packit |
cac203 |
char *recv_message = NULL; /* gcc needs this initialized */
|
|
Packit |
cac203 |
char *replystr;
|
|
Packit |
cac203 |
int err;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
dbg(tdc, "usock: Calling method \"%s\"", method_name);
|
|
Packit |
cac203 |
err= myasprintf(&msg, "%s\n%s\n", TEAMD_USOCK_REQUEST_PREFIX,
|
|
Packit |
cac203 |
method_name);
|
|
Packit |
cac203 |
if (err)
|
|
Packit |
cac203 |
return err;
|
|
Packit |
cac203 |
while (*fmt) {
|
|
Packit |
cac203 |
switch (*fmt++) {
|
|
Packit |
cac203 |
case 's': /* string */
|
|
Packit |
cac203 |
str = __strencode(va_arg(ap, char *));
|
|
Packit |
cac203 |
if (!str) {
|
|
Packit |
cac203 |
err = -ENOMEM;
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
err = myasprintf(&msg, "%s%s\n", msg, str);
|
|
Packit |
cac203 |
free(str);
|
|
Packit |
cac203 |
if (err)
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
break;
|
|
Packit |
cac203 |
default:
|
|
Packit |
cac203 |
err(tdc, "usock: Unknown argument type requested.");
|
|
Packit |
cac203 |
err = -EINVAL;
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = cli_usock_send(cli_usock->sock, msg);
|
|
Packit |
cac203 |
if (err)
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = cli_usock_wait_recv(cli_usock->sock);
|
|
Packit |
cac203 |
if (err) {
|
|
Packit |
cac203 |
if (err == -ETIMEDOUT)
|
|
Packit |
cac203 |
dbg(tdc, "usock: Wait for reply timed-out.");
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = teamd_usock_recv_msg(cli_usock->sock, &recv_message);
|
|
Packit |
cac203 |
if (err)
|
|
Packit |
cac203 |
goto free_msg;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = cli_usock_process_msg(tdc, recv_message, &replystr);
|
|
Packit |
cac203 |
if (err)
|
|
Packit |
cac203 |
goto free_recv_message;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
if (p_reply) {
|
|
Packit |
cac203 |
replystr = strdup(replystr);
|
|
Packit |
cac203 |
if (!replystr) {
|
|
Packit |
cac203 |
err = -ENOMEM;
|
|
Packit |
cac203 |
goto free_recv_message;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
*p_reply = replystr;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
free_recv_message:
|
|
Packit |
cac203 |
free(recv_message);
|
|
Packit |
cac203 |
free_msg:
|
|
Packit |
cac203 |
free(msg);
|
|
Packit |
cac203 |
return err;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static int cli_usock_init(struct teamdctl *tdc, const char *team_name,
|
|
Packit |
cac203 |
void *priv)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
struct cli_usock_priv *cli_usock = priv;
|
|
Packit |
cac203 |
struct sockaddr_un addr;
|
|
Packit |
cac203 |
int err;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
memset(&addr, 0, sizeof(addr));
|
|
Packit |
cac203 |
addr.sun_family = AF_UNIX;
|
|
Packit |
cac203 |
teamd_usock_get_sockpath(addr.sun_path, sizeof(addr.sun_path),
|
|
Packit |
cac203 |
team_name);
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
cli_usock->sock = socket(AF_UNIX, SOCK_SEQPACKET, 0);
|
|
Packit |
cac203 |
if (cli_usock->sock == -1) {
|
|
Packit |
cac203 |
err(tdc, "usock: Failed to create socket.");
|
|
Packit |
cac203 |
return -errno;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
err = connect(cli_usock->sock, (struct sockaddr *) &addr,
|
|
Packit |
cac203 |
strlen(addr.sun_path) + sizeof(addr.sun_family));
|
|
Packit |
cac203 |
if (err == -1) {
|
|
Packit |
cac203 |
err(tdc, "usock: Failed to connect socket (%s).",
|
|
Packit |
cac203 |
addr.sun_path);
|
|
Packit |
cac203 |
close(cli_usock->sock);
|
|
Packit |
cac203 |
return -errno;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
return 0;
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
void cli_usock_fini(struct teamdctl *tdc, void *priv)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
struct cli_usock_priv *cli_usock = priv;
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
close(cli_usock->sock);
|
|
Packit |
cac203 |
}
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
static const struct teamdctl_cli cli_usock = {
|
|
Packit |
cac203 |
.name = "usock",
|
|
Packit |
cac203 |
.init = cli_usock_init,
|
|
Packit |
cac203 |
.fini = cli_usock_fini,
|
|
Packit |
cac203 |
.method_call = cli_usock_method_call,
|
|
Packit |
cac203 |
.priv_size = sizeof(struct cli_usock_priv),
|
|
Packit |
cac203 |
};
|
|
Packit |
cac203 |
|
|
Packit |
cac203 |
const struct teamdctl_cli *teamdctl_cli_usock_get(void)
|
|
Packit |
cac203 |
{
|
|
Packit |
cac203 |
return &cli_usock;
|
|
Packit |
cac203 |
}
|