mirror of git://git.sysmocom.de/ofono
emulator: Add example TCP based emulator
This commit is contained in:
parent
3e69defe86
commit
f07ad65af4
|
@ -336,6 +336,9 @@ builtin_sources += examples/nettime.c
|
|||
|
||||
builtin_modules += example_provision
|
||||
builtin_sources += examples/provision.c
|
||||
|
||||
builtin_modules += example_emulator
|
||||
builtin_sources += examples/emulator.c
|
||||
endif
|
||||
|
||||
builtin_modules += smart_messaging
|
||||
|
|
|
@ -0,0 +1,193 @@
|
|||
/*
|
||||
*
|
||||
* oFono - Open Source Telephony
|
||||
*
|
||||
* Copyright (C) 2008-2011 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 <string.h>
|
||||
#include <errno.h>
|
||||
#include <sys/socket.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include <glib.h>
|
||||
|
||||
#define OFONO_API_SUBJECT_TO_CHANGE
|
||||
#include <ofono/plugin.h>
|
||||
#include <ofono/log.h>
|
||||
#include <ofono/modem.h>
|
||||
#include <ofono/emulator.h>
|
||||
|
||||
#include "ofono.h"
|
||||
|
||||
#define TCP_PORT 12346
|
||||
|
||||
static unsigned int modemwatch_id;
|
||||
guint server_watch;
|
||||
static GList *modems;
|
||||
|
||||
static gboolean on_socket_connected(GIOChannel *chan, GIOCondition cond,
|
||||
gpointer user)
|
||||
{
|
||||
struct sockaddr saddr;
|
||||
unsigned int len = sizeof(saddr);
|
||||
int fd;
|
||||
struct ofono_emulator *em;
|
||||
struct ofono_modem *modem;
|
||||
|
||||
if (cond != G_IO_IN)
|
||||
return FALSE;
|
||||
|
||||
fd = accept(g_io_channel_unix_get_fd(chan), &saddr, &len);
|
||||
if (fd == -1)
|
||||
return FALSE;
|
||||
|
||||
/* Pick the first powered modem */
|
||||
modem = modems->data;
|
||||
DBG("Picked modem %p for emulator", modem);
|
||||
|
||||
em = ofono_emulator_create(modem, OFONO_EMULATOR_TYPE_DUN);
|
||||
if (em == NULL)
|
||||
close(fd);
|
||||
else
|
||||
ofono_emulator_register(em, fd);
|
||||
|
||||
return TRUE;
|
||||
}
|
||||
|
||||
static gboolean create_tcp(void)
|
||||
{
|
||||
struct sockaddr_in addr;
|
||||
int sk;
|
||||
int reuseaddr = 1;
|
||||
GIOChannel *server;
|
||||
|
||||
sk = socket(PF_INET, SOCK_STREAM, 0);
|
||||
if (sk < 0)
|
||||
return FALSE;
|
||||
|
||||
memset(&addr, 0, sizeof(addr));
|
||||
|
||||
addr.sin_family = AF_INET;
|
||||
addr.sin_addr.s_addr = INADDR_ANY;
|
||||
addr.sin_port = htons(TCP_PORT);
|
||||
|
||||
setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &reuseaddr, sizeof(reuseaddr));
|
||||
|
||||
if (bind(sk, (struct sockaddr *) &addr, sizeof(struct sockaddr)) < 0)
|
||||
goto err;
|
||||
|
||||
if (listen(sk, 1) < 0)
|
||||
goto err;
|
||||
|
||||
server = g_io_channel_unix_new(sk);
|
||||
g_io_channel_set_close_on_unref(server, TRUE);
|
||||
|
||||
server_watch = g_io_add_watch_full(server, G_PRIORITY_DEFAULT,
|
||||
G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
|
||||
on_socket_connected, NULL, NULL);
|
||||
|
||||
g_io_channel_unref(server);
|
||||
|
||||
DBG("Created server_watch: %u", server_watch);
|
||||
|
||||
return TRUE;
|
||||
|
||||
err:
|
||||
close(sk);
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
static void powered_watch(struct ofono_modem *modem, gboolean powered,
|
||||
void *user)
|
||||
{
|
||||
if (powered == FALSE) {
|
||||
DBG("Removing modem %p from the list", modem);
|
||||
modems = g_list_remove(modems, modem);
|
||||
|
||||
if (modems == NULL && server_watch > 0) {
|
||||
DBG("Removing server watch: %u", server_watch);
|
||||
g_source_remove(server_watch);
|
||||
server_watch = 0;
|
||||
}
|
||||
} else {
|
||||
DBG("Adding modem %p to the list", modem);
|
||||
modems = g_list_append(modems, modem);
|
||||
|
||||
if (modems->next == NULL)
|
||||
create_tcp();
|
||||
}
|
||||
}
|
||||
|
||||
static void modem_watch(struct ofono_modem *modem, gboolean added, void *user)
|
||||
{
|
||||
DBG("modem: %p, added: %d", modem, added);
|
||||
|
||||
if (added == FALSE) {
|
||||
DBG("Removing modem %p from the list", modem);
|
||||
modems = g_list_remove(modems, modem);
|
||||
return;
|
||||
}
|
||||
|
||||
if (ofono_modem_get_powered(modem) == TRUE) {
|
||||
DBG("Adding modem %p to the list", modem);
|
||||
modems = g_list_append(modems, modem);
|
||||
|
||||
if (modems->next == NULL)
|
||||
create_tcp();
|
||||
}
|
||||
|
||||
__ofono_modem_add_powered_watch(modem, powered_watch, NULL, NULL);
|
||||
}
|
||||
|
||||
static void call_modemwatch(struct ofono_modem *modem, void *user)
|
||||
{
|
||||
modem_watch(modem, TRUE, user);
|
||||
}
|
||||
|
||||
static int example_emulator_init(void)
|
||||
{
|
||||
DBG("");
|
||||
|
||||
modemwatch_id = __ofono_modemwatch_add(modem_watch, NULL, NULL);
|
||||
|
||||
__ofono_modem_foreach(call_modemwatch, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void example_emulator_exit(void)
|
||||
{
|
||||
DBG("");
|
||||
|
||||
__ofono_modemwatch_remove(modemwatch_id);
|
||||
|
||||
g_list_free(modems);
|
||||
|
||||
if (server_watch)
|
||||
g_source_remove(server_watch);
|
||||
}
|
||||
|
||||
OFONO_PLUGIN_DEFINE(example_emulator, "Example AT Modem Emulator Plugin",
|
||||
VERSION, OFONO_PLUGIN_PRIORITY_DEFAULT,
|
||||
example_emulator_init, example_emulator_exit)
|
Loading…
Reference in New Issue