Blame libteamdctl/cli_usock.c

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
}