mirror of git://git.sysmocom.de/ofono
IP support for PPP
Adds IPCP support, and creates a TUN interface for sending/receiving IP packets.
This commit is contained in:
parent
6cb22fe096
commit
a84fc350b4
|
@ -59,7 +59,7 @@ gatchat_sources = gatchat/gatchat.h gatchat/gatchat.c \
|
||||||
gatchat/gatppp.c gatchat/gatppp.h \
|
gatchat/gatppp.c gatchat/gatppp.h \
|
||||||
gatchat/ppp.c gatchat/ppp.h gatchat/ppp_cp.h \
|
gatchat/ppp.c gatchat/ppp.h gatchat/ppp_cp.h \
|
||||||
gatchat/ppp_cp.c gatchat/ppp_lcp.c \
|
gatchat/ppp_cp.c gatchat/ppp_lcp.c \
|
||||||
gatchat/ppp_auth.c
|
gatchat/ppp_auth.c gatchat/ppp_net.c
|
||||||
|
|
||||||
udev_files = plugins/ofono.rules
|
udev_files = plugins/ofono.rules
|
||||||
|
|
||||||
|
|
|
@ -136,6 +136,7 @@ GAtPPP *g_at_ppp_new(GIOChannel *modem)
|
||||||
ppp->auth = auth_new(ppp);
|
ppp->auth = auth_new(ppp);
|
||||||
|
|
||||||
/* intialize the network state */
|
/* intialize the network state */
|
||||||
|
ppp->net = ppp_net_new(ppp);
|
||||||
|
|
||||||
/* start listening for packets from the modem */
|
/* start listening for packets from the modem */
|
||||||
ppp->modem_watch = g_io_add_watch(modem,
|
ppp->modem_watch = g_io_add_watch(modem,
|
||||||
|
|
|
@ -381,6 +381,7 @@ static void ppp_dead(GAtPPP *ppp)
|
||||||
static void ppp_network(GAtPPP *ppp)
|
static void ppp_network(GAtPPP *ppp)
|
||||||
{
|
{
|
||||||
/* bring network phase up */
|
/* bring network phase up */
|
||||||
|
ppp_net_open(ppp->net);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ppp_transition_phase(GAtPPP *ppp, enum ppp_phase phase)
|
static void ppp_transition_phase(GAtPPP *ppp, enum ppp_phase phase)
|
||||||
|
|
|
@ -104,11 +104,19 @@ struct auth_data {
|
||||||
GAtPPP *ppp;
|
GAtPPP *ppp;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
struct ppp_net_data {
|
||||||
|
GAtPPP *ppp;
|
||||||
|
char *if_name;
|
||||||
|
GIOChannel *channel;
|
||||||
|
struct pppcp_data *ipcp;
|
||||||
|
};
|
||||||
|
|
||||||
struct _GAtPPP {
|
struct _GAtPPP {
|
||||||
gint ref_count;
|
gint ref_count;
|
||||||
enum ppp_phase phase;
|
enum ppp_phase phase;
|
||||||
struct pppcp_data *lcp;
|
struct pppcp_data *lcp;
|
||||||
struct auth_data *auth;
|
struct auth_data *auth;
|
||||||
|
struct ppp_net_data *net;
|
||||||
guint8 buffer[BUFFERSZ];
|
guint8 buffer[BUFFERSZ];
|
||||||
int index;
|
int index;
|
||||||
gint mru;
|
gint mru;
|
||||||
|
@ -152,3 +160,7 @@ void auth_set_credentials(struct auth_data *data, const char *username,
|
||||||
void auth_set_proto(struct auth_data *data, guint16 proto, guint8 method);
|
void auth_set_proto(struct auth_data *data, guint16 proto, guint8 method);
|
||||||
struct auth_data *auth_new(GAtPPP *ppp);
|
struct auth_data *auth_new(GAtPPP *ppp);
|
||||||
void auth_free(struct auth_data *auth);
|
void auth_free(struct auth_data *auth);
|
||||||
|
struct ppp_net_data *ppp_net_new(GAtPPP *ppp);
|
||||||
|
void ppp_net_open(struct ppp_net_data *data);
|
||||||
|
void ppp_net_free(struct ppp_net_data *data);
|
||||||
|
void ppp_net_close(struct ppp_net_data *data);
|
||||||
|
|
|
@ -0,0 +1,356 @@
|
||||||
|
/*
|
||||||
|
*
|
||||||
|
* PPP library with GLib integration
|
||||||
|
*
|
||||||
|
* Copyright (C) 2009-2010 Intel Corporation. All rights reserved.
|
||||||
|
*
|
||||||
|
* 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 <stdio.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <termios.h>
|
||||||
|
#include <arpa/inet.h>
|
||||||
|
#include <net/if.h>
|
||||||
|
#include <linux/if_tun.h>
|
||||||
|
#include <sys/ioctl.h>
|
||||||
|
#include <glib.h>
|
||||||
|
|
||||||
|
#include "gatutil.h"
|
||||||
|
#include "gatppp.h"
|
||||||
|
#include "ppp.h"
|
||||||
|
|
||||||
|
static void ipcp_free(struct pppcp_data *data);
|
||||||
|
|
||||||
|
/* XXX should be maximum IP Packet size */
|
||||||
|
#define MAX_PACKET 1500
|
||||||
|
#define PPP_IP_PROTO 0x0021
|
||||||
|
|
||||||
|
struct ipcp_data {
|
||||||
|
guint8 ip_address[4];
|
||||||
|
guint8 primary_dns[4];
|
||||||
|
guint8 secondary_dns[4];
|
||||||
|
struct pppcp_data *pppcp;
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct pppcp_data *ipcp_new(GAtPPP *ppp);
|
||||||
|
static void ipcp_option_process(gpointer data, gpointer user);
|
||||||
|
static guint ipcp_option_scan(struct ppp_option *option, gpointer user);
|
||||||
|
|
||||||
|
static void ip_process_packet(gpointer priv, guint8 *packet)
|
||||||
|
{
|
||||||
|
struct ppp_net_data *data = priv;
|
||||||
|
GError *error = NULL;
|
||||||
|
GIOStatus status;
|
||||||
|
gsize bytes_written;
|
||||||
|
guint16 len;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* since ppp_net_open can fail, we need to make sure
|
||||||
|
* channel is valid
|
||||||
|
*/
|
||||||
|
if (data->channel == NULL)
|
||||||
|
return;
|
||||||
|
|
||||||
|
/* find the length of the packet to transmit */
|
||||||
|
len = get_host_short(&packet[2]);
|
||||||
|
status = g_io_channel_write_chars(data->channel, (gchar *) packet,
|
||||||
|
len, &bytes_written, &error);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* packets received by the tun interface need to be written to
|
||||||
|
* the modem. So, just read a packet, write out to the modem
|
||||||
|
*
|
||||||
|
* TBD - how do we know we have a full packet? Do we care?
|
||||||
|
*/
|
||||||
|
static gboolean ppp_net_callback(GIOChannel *channel, GIOCondition cond,
|
||||||
|
gpointer userdata)
|
||||||
|
{
|
||||||
|
GIOStatus status;
|
||||||
|
gchar buf[MAX_PACKET + 2];
|
||||||
|
gsize bytes_read;
|
||||||
|
GError *error = NULL;
|
||||||
|
struct ppp_header *ppp = (struct ppp_header *) buf;
|
||||||
|
struct ppp_net_data *data = (struct ppp_net_data *) userdata;
|
||||||
|
|
||||||
|
if (cond & G_IO_IN) {
|
||||||
|
/* leave space to add PPP protocol field */
|
||||||
|
status = g_io_channel_read_chars(channel, buf + 2, MAX_PACKET,
|
||||||
|
&bytes_read, &error);
|
||||||
|
if (bytes_read > 0) {
|
||||||
|
ppp->proto = htons(PPP_IP_PROTO);
|
||||||
|
ppp_transmit(data->ppp, (guint8 *) buf, bytes_read);
|
||||||
|
}
|
||||||
|
if (status != G_IO_STATUS_NORMAL && status != G_IO_STATUS_AGAIN)
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ppp_net_close(struct ppp_net_data *data)
|
||||||
|
{
|
||||||
|
/* Not Implemented Yet */
|
||||||
|
}
|
||||||
|
|
||||||
|
void ppp_net_open(struct ppp_net_data *data)
|
||||||
|
{
|
||||||
|
int fd;
|
||||||
|
struct ifreq ifr;
|
||||||
|
GIOChannel *channel;
|
||||||
|
int signal_source;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
if (data == NULL)
|
||||||
|
return;
|
||||||
|
|
||||||
|
/* open a tun interface */
|
||||||
|
fd = open("/dev/net/tun", O_RDWR);
|
||||||
|
if (fd < 0) {
|
||||||
|
g_printerr("error opening tun\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
memset(&ifr, 0, sizeof(ifr));
|
||||||
|
ifr.ifr_flags = IFF_TUN | IFF_NO_PI;
|
||||||
|
err = ioctl(fd, TUNSETIFF, (void *)&ifr);
|
||||||
|
if (err < 0) {
|
||||||
|
g_printerr("error %d setting ifr\n", err);
|
||||||
|
close(fd);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
data->if_name = strdup(ifr.ifr_name);
|
||||||
|
|
||||||
|
/* create a channel for reading and writing to this interface */
|
||||||
|
channel = g_io_channel_unix_new(fd);
|
||||||
|
if (!channel) {
|
||||||
|
g_printerr("Error creating I/O Channel to TUN device\n");
|
||||||
|
close(fd);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (!g_at_util_setup_io(channel, G_IO_FLAG_NONBLOCK)) {
|
||||||
|
g_io_channel_unref(channel);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
data->channel = channel;
|
||||||
|
g_io_channel_set_buffered(channel, FALSE);
|
||||||
|
signal_source = g_io_add_watch(channel,
|
||||||
|
G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
|
||||||
|
ppp_net_callback, (gpointer) data);
|
||||||
|
|
||||||
|
pppcp_generate_event(data->ipcp, OPEN, NULL, 0);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
struct ppp_packet_handler ip_packet_handler = {
|
||||||
|
.proto = PPP_IP_PROTO,
|
||||||
|
.handler = ip_process_packet,
|
||||||
|
};
|
||||||
|
|
||||||
|
void ppp_net_free(struct ppp_net_data *data)
|
||||||
|
{
|
||||||
|
/* TBD unregister packet handler */
|
||||||
|
|
||||||
|
/* cleanup tun interface */
|
||||||
|
ppp_net_close(data);
|
||||||
|
|
||||||
|
/* free ipcp data */
|
||||||
|
ipcp_free(data->ipcp);
|
||||||
|
|
||||||
|
/* free self */
|
||||||
|
g_free(data);
|
||||||
|
}
|
||||||
|
|
||||||
|
struct ppp_net_data *ppp_net_new(GAtPPP *ppp)
|
||||||
|
{
|
||||||
|
struct ppp_net_data *data;
|
||||||
|
|
||||||
|
data = g_try_malloc0(sizeof(*data));
|
||||||
|
if (!data)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
data->ppp = ppp;
|
||||||
|
data->ipcp = ipcp_new(ppp);
|
||||||
|
|
||||||
|
/* register packet handler for IP protocol */
|
||||||
|
ip_packet_handler.priv = data;
|
||||||
|
ppp_register_packet_handler(&ip_packet_handler);
|
||||||
|
return data;
|
||||||
|
}
|
||||||
|
|
||||||
|
/****** IPCP support ****************/
|
||||||
|
#define IPCP_SUPPORTED_CODES ((1 << CONFIGURE_REQUEST) | \
|
||||||
|
(1 << CONFIGURE_ACK) | \
|
||||||
|
(1 << CONFIGURE_NAK) | \
|
||||||
|
(1 << CONFIGURE_REJECT) | \
|
||||||
|
(1 << TERMINATE_REQUEST) | \
|
||||||
|
(1 << TERMINATE_ACK) | \
|
||||||
|
(1 << CODE_REJECT))
|
||||||
|
|
||||||
|
#define IPCP_PROTO 0x8021
|
||||||
|
|
||||||
|
enum ipcp_option_types {
|
||||||
|
IP_ADDRESSES = 1,
|
||||||
|
IP_COMPRESSION_PROTO = 2,
|
||||||
|
IP_ADDRESS = 3,
|
||||||
|
PRIMARY_DNS_SERVER = 129,
|
||||||
|
SECONDARY_DNS_SERVER = 131,
|
||||||
|
};
|
||||||
|
|
||||||
|
static void ipcp_up(struct pppcp_data *pppcp)
|
||||||
|
{
|
||||||
|
struct ipcp_data *data = pppcp->priv;
|
||||||
|
GAtPPP *ppp = pppcp->ppp;
|
||||||
|
|
||||||
|
/* call the connect function */
|
||||||
|
if (ppp->connect_cb)
|
||||||
|
ppp->connect_cb(ppp, G_AT_PPP_CONNECT_SUCCESS,
|
||||||
|
__get_unaligned_long(data->ip_address),
|
||||||
|
__get_unaligned_long(data->primary_dns),
|
||||||
|
__get_unaligned_long(data->secondary_dns),
|
||||||
|
ppp->connect_data);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ipcp_down(struct pppcp_data *data)
|
||||||
|
{
|
||||||
|
g_print("ipcp down\n");
|
||||||
|
|
||||||
|
/* re-add what default config options we want negotiated */
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Tell the protocol to start the handshake
|
||||||
|
*/
|
||||||
|
static void ipcp_started(struct pppcp_data *data)
|
||||||
|
{
|
||||||
|
pppcp_generate_event(data, UP, NULL, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ipcp_finished(struct pppcp_data *data)
|
||||||
|
{
|
||||||
|
g_print("ipcp finished\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
struct pppcp_action ipcp_action = {
|
||||||
|
.this_layer_up = ipcp_up,
|
||||||
|
.this_layer_down = ipcp_down,
|
||||||
|
.this_layer_started = ipcp_started,
|
||||||
|
.this_layer_finished = ipcp_finished,
|
||||||
|
.option_scan = ipcp_option_scan,
|
||||||
|
.option_process = ipcp_option_process,
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ppp_packet_handler ipcp_packet_handler = {
|
||||||
|
.proto = IPCP_PROTO,
|
||||||
|
.handler = pppcp_process_packet,
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Scan the option to see if it is acceptable, unacceptable, or rejected
|
||||||
|
*/
|
||||||
|
static guint ipcp_option_scan(struct ppp_option *option, gpointer user)
|
||||||
|
{
|
||||||
|
switch (option->type) {
|
||||||
|
case IP_ADDRESS:
|
||||||
|
case PRIMARY_DNS_SERVER:
|
||||||
|
case SECONDARY_DNS_SERVER:
|
||||||
|
return OPTION_ACCEPT;
|
||||||
|
default:
|
||||||
|
g_printerr("Unknown ipcp option type %d\n", option->type);
|
||||||
|
return OPTION_REJECT;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* act on an acceptable option
|
||||||
|
*/
|
||||||
|
static void ipcp_option_process(gpointer data, gpointer user)
|
||||||
|
{
|
||||||
|
struct ppp_option *option = data;
|
||||||
|
struct ipcp_data *ipcp = user;
|
||||||
|
|
||||||
|
switch (option->type) {
|
||||||
|
case IP_ADDRESS:
|
||||||
|
memcpy(ipcp->ip_address, option->data, 4);
|
||||||
|
break;
|
||||||
|
case PRIMARY_DNS_SERVER:
|
||||||
|
memcpy(ipcp->primary_dns, option->data, 4);
|
||||||
|
break;
|
||||||
|
case SECONDARY_DNS_SERVER:
|
||||||
|
memcpy(ipcp->secondary_dns, option->data, 4);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
g_printerr("Unable to process unknown option %d\n", option->type);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ipcp_free(struct pppcp_data *data)
|
||||||
|
{
|
||||||
|
struct ipcp_data *ipcp = data->priv;
|
||||||
|
|
||||||
|
/* TBD unregister IPCP packet handler */
|
||||||
|
|
||||||
|
/* free ipcp */
|
||||||
|
g_free(ipcp);
|
||||||
|
|
||||||
|
/* free pppcp */
|
||||||
|
pppcp_free(data);
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct pppcp_data * ipcp_new(GAtPPP *ppp)
|
||||||
|
{
|
||||||
|
struct ipcp_data *data;
|
||||||
|
struct pppcp_data *pppcp;
|
||||||
|
struct ppp_option *ipcp_option;
|
||||||
|
|
||||||
|
data = g_try_malloc0(sizeof(*data));
|
||||||
|
if (!data)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
pppcp = pppcp_new(ppp, IPCP_PROTO, data);
|
||||||
|
if (!pppcp) {
|
||||||
|
g_printerr("Failed to allocate PPPCP struct\n");
|
||||||
|
g_free(data);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
pppcp_set_valid_codes(pppcp, IPCP_SUPPORTED_CODES);
|
||||||
|
pppcp->priv = data;
|
||||||
|
|
||||||
|
/* set the actions */
|
||||||
|
pppcp->action = &ipcp_action;
|
||||||
|
|
||||||
|
/* add the default config options */
|
||||||
|
ipcp_option = g_try_malloc0(6);
|
||||||
|
if (!ipcp_option) {
|
||||||
|
pppcp_free(pppcp);
|
||||||
|
g_free(data);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
ipcp_option->type = IP_ADDRESS;
|
||||||
|
ipcp_option->length= 6;
|
||||||
|
pppcp_add_config_option(pppcp, ipcp_option);
|
||||||
|
|
||||||
|
/* register packet handler for IPCP protocol */
|
||||||
|
ipcp_packet_handler.priv = pppcp;
|
||||||
|
ppp_register_packet_handler(&ipcp_packet_handler);
|
||||||
|
return pppcp;
|
||||||
|
}
|
Loading…
Reference in New Issue