~awe/phablet-extras/ofono-nettime-plugin

/*

 *

 *  oFono - Open Source Telephony

 *

 *  Copyright (C) 2009-2010  Nokia Corporation and/or its subsidiary(-ies).

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License version 2 as

 *  published by the Free Software Foundation.

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

 *

 */

#ifdef HAVE_CONFIG_H

#include <config.h>

#endif

#include <stdint.h>

#include <sys/ioctl.h>

#include <net/if.h>

#include <fcntl.h>

#include <unistd.h>

#include <glib.h>

#include "phonet.h"

#include "socket.h"

#include "pep.h"

struct _GIsiPEP {

	GIsiPEPCallback ready;

	void *opaque;

	int gprs_fd;

	guint source;

	uint16_t handle;

};

static gboolean g_isi_pep_callback(GIOChannel *channel, GIOCondition cond,

					gpointer data)

{

	GIsiPEP *pep = data;

	int fd = g_io_channel_unix_get_fd(channel);

	int encap = PNPIPE_ENCAP_IP;

	if (cond & (G_IO_HUP|G_IO_NVAL))

		return FALSE;

	fd = accept(fd, NULL, NULL);

	if (fd == -1)

		return TRUE;

	fcntl(fd, F_SETFD, FD_CLOEXEC);

	if (setsockopt(fd, SOL_PNPIPE, PNPIPE_ENCAP, &encap, sizeof(encap))) {

		close(fd);

		return TRUE;

	}

	pep->gprs_fd = fd;

	if (pep->ready != NULL)

		pep->ready(pep, pep->opaque);

	return FALSE;

}

GIsiPEP *g_isi_pep_create(GIsiModem *modem, GIsiPEPCallback cb, void *opaque)

{

	unsigned ifi = g_isi_modem_index(modem);

	GIsiPEP *pep = NULL;

	GIOChannel *channel;

	int fd;

	char buf[IF_NAMESIZE];

	fd = socket(PF_PHONET, SOCK_SEQPACKET, 0);

	if (fd == -1)

		return NULL;

	fcntl(fd, F_SETFD, FD_CLOEXEC);

	fcntl(fd, F_SETFL, O_NONBLOCK|fcntl(fd, F_GETFL));

	if (if_indextoname(ifi, buf) == NULL)

		goto error;

	if (setsockopt(fd, SOL_SOCKET, SO_BINDTODEVICE, buf, IF_NAMESIZE) != 0)

		goto error;

	pep = g_try_malloc(sizeof(GIsiPEP));

	if (pep == NULL)

		goto error;

	pep->ready = cb;

	pep->opaque = opaque;

	pep->gprs_fd = -1;

	pep->handle = 0;

	if (listen(fd, 1) || ioctl(fd, SIOCPNGETOBJECT, &pep->handle))

		goto error;

	channel = g_io_channel_unix_new(fd);

	g_io_channel_set_close_on_unref(channel, TRUE);

	g_io_channel_set_encoding(channel, NULL, NULL);

	g_io_channel_set_buffered(channel, FALSE);

	pep->source = g_io_add_watch(channel,

					G_IO_IN|G_IO_ERR|G_IO_HUP|G_IO_NVAL,

					g_isi_pep_callback, pep);

	g_io_channel_unref(channel);

	return pep;

error:

	close(fd);

	g_free(pep);

	return NULL;

}

uint16_t g_isi_pep_get_object(const GIsiPEP *pep)

{

	return pep->handle;

}

void g_isi_pep_destroy(GIsiPEP *pep)

{

	if (pep->gprs_fd != -1)

		close(pep->gprs_fd);

	else

		g_source_remove(pep->source);

	g_free(pep);

}

unsigned g_isi_pep_get_ifindex(const GIsiPEP *pep)

{

	unsigned ifi;

	socklen_t len = sizeof(ifi);

	g_assert(pep->gprs_fd != -1);

	getsockopt(pep->gprs_fd, SOL_PNPIPE, PNPIPE_IFINDEX, &ifi, &len);

	return ifi;

}

char *g_isi_pep_get_ifname(const GIsiPEP *pep, char *ifname)

{

	if (pep->gprs_fd == -1)

		return NULL;

	return if_indextoname(g_isi_pep_get_ifindex(pep), ifname);

}