mirror of git://git.sysmocom.de/ofono
xmm7modem: implemnetation of coexistence functionality
Added coex implementation in xmm7modem plugin
This commit is contained in:
parent
1749018577
commit
06d16faeda
|
@ -57,16 +57,911 @@
|
|||
#include <drivers/atmodem/atutil.h>
|
||||
#include <drivers/atmodem/vendor.h>
|
||||
|
||||
#include "ofono.h"
|
||||
#include "gdbus.h"
|
||||
|
||||
#define OFONO_COEX_INTERFACE OFONO_SERVICE ".intel.LteCoexistence"
|
||||
#define OFONO_COEX_AGENT_INTERFACE OFONO_SERVICE ".intel.LteCoexistenceAgent"
|
||||
|
||||
#define NET_BAND_LTE_INVALID 0
|
||||
#define NET_BAND_LTE_1 101
|
||||
#define NET_BAND_LTE_43 143
|
||||
#define BAND_LEN 20
|
||||
#define MAX_BT_SAFE_VECTOR 15
|
||||
#define MAX_WL_SAFE_VECTOR 13
|
||||
|
||||
static const char *none_prefix[] = { NULL };
|
||||
static const char *xsimstate_prefix[] = { "+XSIMSTATE:", NULL };
|
||||
static const char *xnvmplmn_prefix[] = { "+XNVMPLMN:", NULL };
|
||||
|
||||
struct bt_coex_info {
|
||||
int safe_tx_min;
|
||||
int safe_tx_max;
|
||||
int safe_rx_min;
|
||||
int safe_rx_max;
|
||||
int safe_vector[MAX_BT_SAFE_VECTOR];
|
||||
int num_safe_vector;
|
||||
};
|
||||
|
||||
struct wl_coex_info {
|
||||
int safe_tx_min;
|
||||
int safe_tx_max;
|
||||
int safe_rx_min;
|
||||
int safe_rx_max;
|
||||
int safe_vector[MAX_BT_SAFE_VECTOR];
|
||||
int num_safe_vector;
|
||||
};
|
||||
|
||||
struct coex_agent {
|
||||
char *path;
|
||||
char *bus;
|
||||
guint disconnect_watch;
|
||||
ofono_bool_t remove_on_terminate;
|
||||
ofono_destroy_func removed_cb;
|
||||
void *removed_data;
|
||||
DBusMessage *msg;
|
||||
};
|
||||
|
||||
struct xmm7xxx_data {
|
||||
GAtChat *chat; /* AT chat */
|
||||
struct ofono_sim *sim;
|
||||
ofono_bool_t have_sim;
|
||||
ofono_bool_t sms_phonebook_added;
|
||||
unsigned int netreg_watch;
|
||||
};
|
||||
|
||||
/* Coex Implementation */
|
||||
enum wlan_bw {
|
||||
WLAN_BW_UNSUPPORTED = -1,
|
||||
WLAN_BW_20MHZ = 0,
|
||||
WLAN_BW_40MHZ = 1,
|
||||
WLAN_BW_80MHZ = 2,
|
||||
};
|
||||
|
||||
struct plmn_hist {
|
||||
unsigned short mnc;
|
||||
unsigned short mcc;
|
||||
unsigned long tdd;
|
||||
unsigned long fdd;
|
||||
unsigned char bw;
|
||||
};
|
||||
|
||||
struct xmm7xxx_coex {
|
||||
GAtChat *chat;
|
||||
struct ofono_modem *modem;
|
||||
|
||||
DBusMessage *pending;
|
||||
ofono_bool_t bt_active;
|
||||
ofono_bool_t wlan_active;
|
||||
enum wlan_bw wlan_bw;
|
||||
char *lte_band;
|
||||
|
||||
ofono_bool_t pending_bt_active;
|
||||
ofono_bool_t pending_wlan_active;
|
||||
enum wlan_bw pending_wlan_bw;
|
||||
|
||||
struct coex_agent *session_agent;
|
||||
};
|
||||
|
||||
static ofono_bool_t coex_agent_matches(struct coex_agent *agent,
|
||||
const char *path, const char *sender)
|
||||
{
|
||||
return !strcmp(agent->path, path) && !strcmp(agent->bus, sender);
|
||||
}
|
||||
|
||||
static void coex_agent_set_removed_notify(struct coex_agent *agent,
|
||||
ofono_destroy_func destroy,
|
||||
void *user_data)
|
||||
{
|
||||
agent->removed_cb = destroy;
|
||||
agent->removed_data = user_data;
|
||||
}
|
||||
|
||||
static void coex_agent_send_noreply(struct coex_agent *agent, const char *method)
|
||||
{
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
DBusMessage *message;
|
||||
|
||||
message = dbus_message_new_method_call(agent->bus, agent->path,
|
||||
OFONO_COEX_INTERFACE,
|
||||
method);
|
||||
if (message == NULL)
|
||||
return;
|
||||
|
||||
dbus_message_set_no_reply(message, TRUE);
|
||||
|
||||
g_dbus_send_message(conn, message);
|
||||
}
|
||||
|
||||
static void coex_agent_send_release(struct coex_agent *agent)
|
||||
{
|
||||
coex_agent_send_noreply(agent, "Release");
|
||||
}
|
||||
|
||||
static void coex_agent_free(struct coex_agent *agent)
|
||||
{
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
|
||||
if (agent->disconnect_watch) {
|
||||
coex_agent_send_release(agent);
|
||||
|
||||
g_dbus_remove_watch(conn, agent->disconnect_watch);
|
||||
agent->disconnect_watch = 0;
|
||||
}
|
||||
|
||||
if (agent->removed_cb)
|
||||
agent->removed_cb(agent->removed_data);
|
||||
|
||||
g_free(agent->path);
|
||||
g_free(agent->bus);
|
||||
g_free(agent);
|
||||
}
|
||||
|
||||
static void coex_agent_disconnect_cb(DBusConnection *conn, void *user_data)
|
||||
{
|
||||
struct coex_agent *agent = user_data;
|
||||
|
||||
ofono_debug("Agent exited without calling Unregister");
|
||||
|
||||
agent->disconnect_watch = 0;
|
||||
|
||||
coex_agent_free(agent);
|
||||
}
|
||||
|
||||
static struct coex_agent *coex_agent_new(const char *path, const char *sender,
|
||||
ofono_bool_t remove_on_terminate)
|
||||
{
|
||||
struct coex_agent *agent = g_try_new0(struct coex_agent, 1);
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
|
||||
DBG("");
|
||||
if (agent == NULL)
|
||||
return NULL;
|
||||
|
||||
agent->path = g_strdup(path);
|
||||
agent->bus = g_strdup(sender);
|
||||
|
||||
agent->remove_on_terminate = remove_on_terminate;
|
||||
|
||||
agent->disconnect_watch = g_dbus_add_disconnect_watch(conn, sender,
|
||||
coex_agent_disconnect_cb,
|
||||
agent, NULL);
|
||||
|
||||
return agent;
|
||||
}
|
||||
|
||||
static int coex_agent_coex_wlan_notify(struct coex_agent *agent,
|
||||
const struct wl_coex_info wlan_info)
|
||||
{
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
DBusMessageIter wl_args, wl_dict, wl_array;
|
||||
const dbus_int32_t *pwl_array = wlan_info.safe_vector;
|
||||
dbus_int32_t value;
|
||||
|
||||
agent->msg = dbus_message_new_method_call(agent->bus, agent->path,
|
||||
OFONO_COEX_AGENT_INTERFACE,
|
||||
"ReceiveWiFiNotification");
|
||||
if (agent->msg == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
dbus_message_iter_init_append(agent->msg, &wl_args);
|
||||
|
||||
dbus_message_iter_open_container(&wl_args, DBUS_TYPE_ARRAY,
|
||||
DBUS_TYPE_INT32_AS_STRING, &wl_array);
|
||||
dbus_message_iter_append_fixed_array(&wl_array, DBUS_TYPE_INT32,
|
||||
&pwl_array, MAX_WL_SAFE_VECTOR);
|
||||
|
||||
dbus_message_iter_close_container(&wl_args, &wl_array);
|
||||
|
||||
dbus_message_iter_open_container(&wl_args, DBUS_TYPE_ARRAY,
|
||||
"{sv}", &wl_dict);
|
||||
|
||||
value = wlan_info.safe_tx_min;
|
||||
ofono_dbus_dict_append(&wl_dict, "SafeTxMin",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = wlan_info.safe_tx_max;
|
||||
ofono_dbus_dict_append(&wl_dict, "SafeTxMax",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = wlan_info.safe_rx_min;
|
||||
ofono_dbus_dict_append(&wl_dict, "SafeRxMin",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = wlan_info.safe_rx_max;
|
||||
ofono_dbus_dict_append(&wl_dict, "SafeRxMax",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = wlan_info.num_safe_vector;
|
||||
ofono_dbus_dict_append(&wl_dict, "NumSafeVector",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
|
||||
dbus_message_iter_close_container(&wl_args, &wl_dict);
|
||||
dbus_message_set_no_reply(agent->msg, TRUE);
|
||||
|
||||
if (dbus_connection_send(conn, agent->msg, NULL) == FALSE)
|
||||
return -EIO;
|
||||
|
||||
dbus_message_unref(agent->msg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int coex_agent_coex_bt_notify(struct coex_agent *agent,
|
||||
const struct bt_coex_info bt_info)
|
||||
{
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
DBusMessageIter bt_args, bt_dict, bt_array;
|
||||
const dbus_int32_t *pbt_array = bt_info.safe_vector;
|
||||
int len = MAX_BT_SAFE_VECTOR;
|
||||
dbus_int32_t value;
|
||||
|
||||
agent->msg = dbus_message_new_method_call(agent->bus, agent->path,
|
||||
OFONO_COEX_AGENT_INTERFACE,
|
||||
"ReceiveBTNotification");
|
||||
|
||||
if (agent->msg == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
pbt_array = bt_info.safe_vector;
|
||||
|
||||
dbus_message_iter_init_append(agent->msg, &bt_args);
|
||||
|
||||
dbus_message_iter_open_container(&bt_args, DBUS_TYPE_ARRAY,
|
||||
DBUS_TYPE_INT32_AS_STRING, &bt_array);
|
||||
|
||||
dbus_message_iter_append_fixed_array(&bt_array, DBUS_TYPE_INT32,
|
||||
&pbt_array, len);
|
||||
|
||||
dbus_message_iter_close_container(&bt_args, &bt_array);
|
||||
|
||||
dbus_message_iter_open_container(&bt_args,
|
||||
DBUS_TYPE_ARRAY, "{sv}", &bt_dict);
|
||||
|
||||
value = bt_info.safe_tx_min;
|
||||
DBG("value = %d", value);
|
||||
ofono_dbus_dict_append(&bt_dict, "SafeTxMin",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = bt_info.safe_tx_max;
|
||||
DBG("value = %d", value);
|
||||
ofono_dbus_dict_append(&bt_dict, "SafeTxMax",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = bt_info.safe_rx_min;
|
||||
DBG("value = %d", value);
|
||||
ofono_dbus_dict_append(&bt_dict, "SafeRxMin",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = bt_info.safe_rx_max;
|
||||
DBG("value = %d", value);
|
||||
ofono_dbus_dict_append(&bt_dict, "SafeRxMax",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
value = bt_info.num_safe_vector;
|
||||
DBG("value = %d", value);
|
||||
ofono_dbus_dict_append(&bt_dict, "NumSafeVector",
|
||||
DBUS_TYPE_UINT32, &value);
|
||||
|
||||
dbus_message_iter_close_container(&bt_args, &bt_dict);
|
||||
|
||||
if (dbus_connection_send(conn, agent->msg, NULL) == FALSE)
|
||||
return -EIO;
|
||||
|
||||
dbus_message_unref(agent->msg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static gboolean coex_wlan_bw_from_string(const char *str,
|
||||
enum wlan_bw *band)
|
||||
{
|
||||
if (g_str_equal(str, "20")) {
|
||||
*band = WLAN_BW_20MHZ;
|
||||
return TRUE;
|
||||
} else if (g_str_equal(str, "40")) {
|
||||
*band = WLAN_BW_40MHZ;
|
||||
return TRUE;
|
||||
} else if (g_str_equal(str, "80")) {
|
||||
*band = WLAN_BW_80MHZ;
|
||||
return TRUE;
|
||||
} else
|
||||
*band = WLAN_BW_UNSUPPORTED;
|
||||
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
static const char *wlan_bw_to_string(int band)
|
||||
{
|
||||
switch (band) {
|
||||
case WLAN_BW_20MHZ:
|
||||
return "20MHz";
|
||||
case WLAN_BW_40MHZ:
|
||||
return "40MHz";
|
||||
case WLAN_BW_80MHZ:
|
||||
return "80MHz";
|
||||
case WLAN_BW_UNSUPPORTED:
|
||||
return "UnSupported";
|
||||
}
|
||||
|
||||
return "";
|
||||
}
|
||||
|
||||
static void xmm_get_band_string(int lte_band, char *band)
|
||||
{
|
||||
int band_lte;
|
||||
|
||||
band_lte = lte_band-NET_BAND_LTE_1+1;
|
||||
|
||||
if (lte_band >= NET_BAND_LTE_1 && lte_band <= NET_BAND_LTE_43)
|
||||
sprintf(band, "BAND_LTE_%d", band_lte);
|
||||
else
|
||||
sprintf(band, "INVALID");
|
||||
}
|
||||
|
||||
static DBusMessage *coex_get_properties(DBusConnection *conn,
|
||||
DBusMessage *msg, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
DBusMessage *reply;
|
||||
DBusMessageIter iter;
|
||||
DBusMessageIter dict;
|
||||
dbus_bool_t value;
|
||||
const char *band = NULL;
|
||||
|
||||
reply = dbus_message_new_method_return(msg);
|
||||
if (reply == NULL)
|
||||
return NULL;
|
||||
|
||||
dbus_message_iter_init_append(reply, &iter);
|
||||
|
||||
dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
|
||||
OFONO_PROPERTIES_ARRAY_SIGNATURE,
|
||||
&dict);
|
||||
|
||||
value = coex->bt_active;
|
||||
ofono_dbus_dict_append(&dict, "BTActive",
|
||||
DBUS_TYPE_BOOLEAN, &value);
|
||||
|
||||
value = coex->wlan_active;
|
||||
ofono_dbus_dict_append(&dict, "WLANActive",
|
||||
DBUS_TYPE_BOOLEAN, &value);
|
||||
|
||||
band = wlan_bw_to_string(coex->wlan_bw);
|
||||
ofono_dbus_dict_append(&dict, "WLANBandwidth",
|
||||
DBUS_TYPE_STRING, &band);
|
||||
|
||||
band = coex->lte_band;
|
||||
ofono_dbus_dict_append(&dict, "Band", DBUS_TYPE_STRING, &band);
|
||||
|
||||
dbus_message_iter_close_container(&iter, &dict);
|
||||
|
||||
return reply;
|
||||
}
|
||||
|
||||
static void coex_set_params_cb(gboolean ok, GAtResult *result,
|
||||
gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
DBusMessage *reply;
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
const char *path = ofono_modem_get_path(coex->modem);
|
||||
|
||||
DBG("ok %d", ok);
|
||||
|
||||
if (!ok) {
|
||||
coex->pending_bt_active = coex->bt_active;
|
||||
coex->pending_wlan_active = coex->wlan_active;
|
||||
coex->pending_wlan_bw = coex->wlan_bw;
|
||||
reply = __ofono_error_failed(coex->pending);
|
||||
__ofono_dbus_pending_reply(&coex->pending, reply);
|
||||
return;
|
||||
}
|
||||
|
||||
reply = dbus_message_new_method_return(coex->pending);
|
||||
__ofono_dbus_pending_reply(&coex->pending, reply);
|
||||
|
||||
if (coex->bt_active != coex->pending_bt_active) {
|
||||
coex->bt_active = coex->pending_bt_active;
|
||||
ofono_dbus_signal_property_changed(conn, path,
|
||||
OFONO_COEX_INTERFACE, "BTActive",
|
||||
DBUS_TYPE_BOOLEAN, &coex->bt_active);
|
||||
}
|
||||
|
||||
if (coex->wlan_active != coex->pending_wlan_active) {
|
||||
coex->wlan_active = coex->pending_wlan_active;
|
||||
ofono_dbus_signal_property_changed(conn, path,
|
||||
OFONO_COEX_INTERFACE, "WLANActive",
|
||||
DBUS_TYPE_BOOLEAN, &coex->wlan_active);
|
||||
}
|
||||
|
||||
if (coex->wlan_bw != coex->pending_wlan_bw) {
|
||||
const char *str_band = wlan_bw_to_string(coex->wlan_bw);
|
||||
coex->wlan_bw = coex->pending_wlan_bw;
|
||||
|
||||
ofono_dbus_signal_property_changed(conn, path,
|
||||
OFONO_COEX_INTERFACE, "WLANBandwidth",
|
||||
DBUS_TYPE_STRING, &str_band);
|
||||
}
|
||||
}
|
||||
|
||||
static void coex_set_params(struct xmm7xxx_coex *coex, ofono_bool_t bt_active,
|
||||
ofono_bool_t wlan_active, int wlan_bw)
|
||||
{
|
||||
char buf[64];
|
||||
DBusMessage *reply;
|
||||
|
||||
DBG("");
|
||||
sprintf(buf, "AT+XNRTCWS=65535,%u,%u,%u", (int)wlan_active,
|
||||
wlan_bw, bt_active);
|
||||
|
||||
if (g_at_chat_send(coex->chat, buf, none_prefix,
|
||||
coex_set_params_cb, coex, NULL) > 0)
|
||||
return;
|
||||
|
||||
coex->pending_bt_active = coex->bt_active;
|
||||
coex->pending_wlan_active = coex->wlan_active;
|
||||
coex->pending_wlan_bw = coex->wlan_bw;
|
||||
reply = __ofono_error_failed(coex->pending);
|
||||
__ofono_dbus_pending_reply(&coex->pending, reply);
|
||||
}
|
||||
|
||||
static DBusMessage *coex_set_property(DBusConnection *conn,
|
||||
DBusMessage *msg, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
DBusMessageIter iter;
|
||||
DBusMessageIter var;
|
||||
const char *property;
|
||||
dbus_bool_t value;
|
||||
|
||||
if (coex->pending)
|
||||
return __ofono_error_busy(msg);
|
||||
|
||||
if (!dbus_message_iter_init(msg, &iter))
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_STRING)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
dbus_message_iter_get_basic(&iter, &property);
|
||||
dbus_message_iter_next(&iter);
|
||||
|
||||
if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_VARIANT)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
dbus_message_iter_recurse(&iter, &var);
|
||||
|
||||
if (!strcmp(property, "BTActive")) {
|
||||
if (dbus_message_iter_get_arg_type(&var) != DBUS_TYPE_BOOLEAN)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
dbus_message_iter_get_basic(&var, &value);
|
||||
|
||||
if (coex->bt_active == (ofono_bool_t) value)
|
||||
return dbus_message_new_method_return(msg);
|
||||
|
||||
coex->pending_bt_active = value;
|
||||
coex->pending = dbus_message_ref(msg);
|
||||
|
||||
coex_set_params(coex, value, coex->wlan_active, coex->wlan_bw);
|
||||
return NULL;
|
||||
} else if (!strcmp(property, "WLANActive")) {
|
||||
if (dbus_message_iter_get_arg_type(&var) != DBUS_TYPE_BOOLEAN)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
dbus_message_iter_get_basic(&var, &value);
|
||||
|
||||
if (coex->wlan_active == (ofono_bool_t) value)
|
||||
return dbus_message_new_method_return(msg);
|
||||
|
||||
coex->pending_wlan_active = value;
|
||||
coex->pending = dbus_message_ref(msg);
|
||||
|
||||
coex_set_params(coex, coex->bt_active, value, coex->wlan_bw);
|
||||
return NULL;
|
||||
} else if (g_strcmp0(property, "WLANBandwidth") == 0) {
|
||||
const char *value;
|
||||
enum wlan_bw band;
|
||||
|
||||
if (dbus_message_iter_get_arg_type(&var) != DBUS_TYPE_STRING)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
dbus_message_iter_get_basic(&var, &value);
|
||||
if (coex_wlan_bw_from_string(value, &band) == FALSE)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
if (coex->wlan_bw == band)
|
||||
return dbus_message_new_method_return(msg);
|
||||
|
||||
coex->pending_wlan_bw = band;
|
||||
coex->pending = dbus_message_ref(msg);
|
||||
|
||||
coex_set_params(coex, coex->bt_active, coex->wlan_active, band);
|
||||
return NULL;
|
||||
} else {
|
||||
return __ofono_error_invalid_args(msg);
|
||||
}
|
||||
|
||||
return dbus_message_new_method_return(msg);
|
||||
}
|
||||
|
||||
static void coex_default_agent_notify(gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
|
||||
g_at_chat_send(coex->chat, "AT+XNRTCWS=0", none_prefix,
|
||||
NULL, NULL, NULL);
|
||||
|
||||
coex->session_agent = NULL;
|
||||
}
|
||||
|
||||
static DBusMessage *coex_register_agent(DBusConnection *conn,
|
||||
DBusMessage *msg, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
const char *agent_path;
|
||||
|
||||
if (coex->session_agent) {
|
||||
DBG("Coexistence agent already registered");
|
||||
return __ofono_error_busy(msg);
|
||||
}
|
||||
|
||||
if (dbus_message_get_args(msg, NULL,
|
||||
DBUS_TYPE_OBJECT_PATH, &agent_path,
|
||||
DBUS_TYPE_INVALID) == FALSE)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
if (!dbus_validate_path(agent_path, NULL))
|
||||
return __ofono_error_invalid_format(msg);
|
||||
|
||||
coex->session_agent = coex_agent_new(agent_path,
|
||||
dbus_message_get_sender(msg),
|
||||
FALSE);
|
||||
|
||||
if (coex->session_agent == NULL)
|
||||
return __ofono_error_failed(msg);
|
||||
|
||||
coex_agent_set_removed_notify(coex->session_agent,
|
||||
coex_default_agent_notify, coex);
|
||||
|
||||
return dbus_message_new_method_return(msg);
|
||||
}
|
||||
|
||||
static DBusMessage *coex_unregister_agent(DBusConnection *conn,
|
||||
DBusMessage *msg, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
const char *agent_path;
|
||||
const char *agent_bus = dbus_message_get_sender(msg);
|
||||
|
||||
if (dbus_message_get_args(msg, NULL,
|
||||
DBUS_TYPE_OBJECT_PATH, &agent_path,
|
||||
DBUS_TYPE_INVALID) == FALSE)
|
||||
return __ofono_error_invalid_args(msg);
|
||||
|
||||
if (coex->session_agent == NULL)
|
||||
return __ofono_error_failed(msg);
|
||||
|
||||
if (!coex_agent_matches(coex->session_agent, agent_path, agent_bus))
|
||||
return __ofono_error_failed(msg);
|
||||
|
||||
coex_agent_send_release(coex->session_agent);
|
||||
coex_agent_free(coex->session_agent);
|
||||
|
||||
g_at_chat_send(coex->chat, "AT+XNRTCWS=0", none_prefix,
|
||||
NULL, NULL, NULL);
|
||||
|
||||
return dbus_message_new_method_return(msg);
|
||||
}
|
||||
|
||||
static void append_plmn_properties(struct plmn_hist *list,
|
||||
DBusMessageIter *dict)
|
||||
{
|
||||
ofono_dbus_dict_append(dict, "MobileCountryCode",
|
||||
DBUS_TYPE_UINT16, &list->mcc);
|
||||
ofono_dbus_dict_append(dict, "MobileNetworkCode",
|
||||
DBUS_TYPE_UINT16, &list->mnc);
|
||||
ofono_dbus_dict_append(dict, "LteBandsFDD",
|
||||
DBUS_TYPE_UINT32, &list->fdd);
|
||||
ofono_dbus_dict_append(dict, "LteBandsTDD",
|
||||
DBUS_TYPE_UINT32, &list->tdd);
|
||||
ofono_dbus_dict_append(dict, "ChannelBandwidth",
|
||||
DBUS_TYPE_UINT32, &list->bw);
|
||||
}
|
||||
|
||||
static void append_plmn_history_struct_list(struct plmn_hist *list,
|
||||
DBusMessageIter *arr)
|
||||
{
|
||||
DBusMessageIter iter;
|
||||
DBusMessageIter dict;
|
||||
|
||||
dbus_message_iter_open_container(arr, DBUS_TYPE_STRUCT, NULL, &iter);
|
||||
|
||||
dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
|
||||
OFONO_PROPERTIES_ARRAY_SIGNATURE,
|
||||
&dict);
|
||||
|
||||
append_plmn_properties(list, &dict);
|
||||
|
||||
dbus_message_iter_close_container(&iter, &dict);
|
||||
|
||||
dbus_message_iter_close_container(arr, &iter);
|
||||
}
|
||||
|
||||
static void coex_get_plmn_history_cb(gboolean ok, GAtResult *result,
|
||||
gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
struct plmn_hist *list = NULL;
|
||||
GAtResultIter iter;
|
||||
int list_size = 0, count;
|
||||
DBusMessage *reply;
|
||||
DBusMessageIter itr, arr;
|
||||
int value;
|
||||
|
||||
DBG("ok %d", ok);
|
||||
|
||||
if (!ok) {
|
||||
__ofono_dbus_pending_reply(&coex->pending,
|
||||
__ofono_error_failed(coex->pending));
|
||||
return;
|
||||
}
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
while (g_at_result_iter_next(&iter, "+XNVMPLMN:")) {
|
||||
if (!list_size)
|
||||
list = g_new0(struct plmn_hist, ++list_size);
|
||||
else
|
||||
list = g_renew(struct plmn_hist, list, ++list_size);
|
||||
|
||||
g_at_result_iter_next_number(&iter, &value);
|
||||
list[list_size - 1].mcc = value;
|
||||
g_at_result_iter_next_number(&iter, &value);
|
||||
list[list_size - 1].mnc = value;
|
||||
g_at_result_iter_next_number(&iter, &value);
|
||||
list[list_size - 1].fdd = value;
|
||||
g_at_result_iter_next_number(&iter, &value);
|
||||
list[list_size - 1].tdd = value;
|
||||
g_at_result_iter_next_number(&iter, &value);
|
||||
list[list_size - 1].bw = value;
|
||||
|
||||
DBG("list_size = %d", list_size);
|
||||
}
|
||||
|
||||
reply = dbus_message_new_method_return(coex->pending);
|
||||
dbus_message_iter_init_append(reply, &itr);
|
||||
|
||||
dbus_message_iter_open_container(&itr, DBUS_TYPE_ARRAY,
|
||||
DBUS_STRUCT_BEGIN_CHAR_AS_STRING
|
||||
DBUS_TYPE_ARRAY_AS_STRING
|
||||
DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
|
||||
DBUS_TYPE_STRING_AS_STRING
|
||||
DBUS_TYPE_VARIANT_AS_STRING
|
||||
DBUS_DICT_ENTRY_END_CHAR_AS_STRING
|
||||
DBUS_STRUCT_END_CHAR_AS_STRING,
|
||||
&arr);
|
||||
|
||||
for (count = 0; count < list_size; count++)
|
||||
append_plmn_history_struct_list(list, &arr);
|
||||
|
||||
dbus_message_iter_close_container(&itr, &arr);
|
||||
|
||||
reply = dbus_message_new_method_return(coex->pending);
|
||||
__ofono_dbus_pending_reply(&coex->pending, reply);
|
||||
|
||||
g_free(list);
|
||||
}
|
||||
|
||||
static DBusMessage *coex_get_plmn_history(DBusConnection *conn,
|
||||
DBusMessage *msg, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
|
||||
if (coex->pending)
|
||||
return __ofono_error_busy(msg);
|
||||
|
||||
if (!g_at_chat_send(coex->chat, "AT+XNVMPLMN=2,2", xnvmplmn_prefix,
|
||||
coex_get_plmn_history_cb, coex, NULL))
|
||||
return __ofono_error_failed(msg);
|
||||
|
||||
coex->pending = dbus_message_ref(msg);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
static const GDBusMethodTable coex_methods[] = {
|
||||
{ GDBUS_METHOD("GetProperties",
|
||||
NULL, GDBUS_ARGS({ "properties", "a{sv}" }),
|
||||
coex_get_properties) },
|
||||
{ GDBUS_METHOD("SetProperty",
|
||||
GDBUS_ARGS({ "property", "s" }, { "value", "v" }),
|
||||
NULL, coex_set_property) },
|
||||
{ GDBUS_METHOD("RegisterAgent",
|
||||
GDBUS_ARGS({ "path", "o" }), NULL,
|
||||
coex_register_agent) },
|
||||
{ GDBUS_METHOD("UnregisterAgent",
|
||||
GDBUS_ARGS({ "path", "o" }), NULL,
|
||||
coex_unregister_agent) },
|
||||
{ GDBUS_ASYNC_METHOD("GetPlmnHistory",
|
||||
NULL, GDBUS_ARGS({ "plmnhistory", "a(a{sv})" }),
|
||||
coex_get_plmn_history) },
|
||||
{ }
|
||||
};
|
||||
|
||||
static const GDBusSignalTable coex_signals[] = {
|
||||
{ GDBUS_SIGNAL("PropertyChanged",
|
||||
GDBUS_ARGS({ "name", "s" }, { "value", "v" })) },
|
||||
{ }
|
||||
};
|
||||
|
||||
static void xmm_coex_w_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
GAtResultIter iter;
|
||||
int count;
|
||||
struct wl_coex_info wlan;
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "+XNRTCWSW:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &wlan.safe_rx_min);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_next_number(&iter, &wlan.safe_rx_max);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_next_number(&iter, &wlan.safe_tx_min);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_next_number(&iter, &wlan.safe_tx_max);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_next_number(&iter, &wlan.num_safe_vector);
|
||||
|
||||
for (count = 0; count < wlan.num_safe_vector; count++) {
|
||||
g_at_result_iter_next_number(&iter, &wlan.safe_vector[count]);
|
||||
}
|
||||
|
||||
DBG("WLAN notification");
|
||||
|
||||
if (coex->session_agent)
|
||||
coex_agent_coex_wlan_notify(coex->session_agent, wlan);
|
||||
}
|
||||
|
||||
static void xmm_coex_b_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
GAtResultIter iter;
|
||||
struct bt_coex_info bt;
|
||||
int count;
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "+XNRTCWSB:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &bt.safe_rx_min);
|
||||
g_at_result_iter_next_number(&iter, &bt.safe_rx_max);
|
||||
g_at_result_iter_next_number(&iter, &bt.safe_tx_min);
|
||||
g_at_result_iter_next_number(&iter, &bt.safe_tx_max);
|
||||
g_at_result_iter_next_number(&iter, &bt.num_safe_vector);
|
||||
|
||||
for (count = 0; count < bt.num_safe_vector; count++) {
|
||||
g_at_result_iter_next_number(&iter, &bt.safe_vector[count]);
|
||||
}
|
||||
|
||||
DBG("BT notification");
|
||||
|
||||
if (coex->session_agent)
|
||||
coex_agent_coex_bt_notify(coex->session_agent, bt);
|
||||
}
|
||||
|
||||
static void xmm_lte_band_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = user_data;
|
||||
GAtResultIter iter;
|
||||
int lte_band;
|
||||
char band[BAND_LEN];
|
||||
const char *path = ofono_modem_get_path(coex->modem);
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "+XCCINFO:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
g_at_result_iter_skip_next(&iter);
|
||||
|
||||
if (!g_at_result_iter_next_number(&iter, <e_band))
|
||||
return;
|
||||
|
||||
xmm_get_band_string(lte_band, band);
|
||||
DBG("band %s", band);
|
||||
|
||||
if (!strcmp(band, coex->lte_band))
|
||||
return;
|
||||
|
||||
g_free(coex->lte_band);
|
||||
coex->lte_band = g_strdup(band);
|
||||
|
||||
if (coex->lte_band == NULL)
|
||||
return;
|
||||
|
||||
ofono_dbus_signal_property_changed(conn, path,
|
||||
OFONO_COEX_INTERFACE,
|
||||
"Band", DBUS_TYPE_STRING, &coex->lte_band);
|
||||
}
|
||||
|
||||
static void coex_cleanup(void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex = data;
|
||||
|
||||
if (coex->pending)
|
||||
__ofono_dbus_pending_reply(&coex->pending,
|
||||
__ofono_error_canceled(coex->pending));
|
||||
|
||||
if (coex->session_agent) {
|
||||
coex_agent_free(coex->session_agent);
|
||||
|
||||
g_at_chat_send(coex->chat, "AT+XNRTCWS=0", none_prefix,
|
||||
NULL, NULL, NULL);
|
||||
}
|
||||
|
||||
g_free(coex->lte_band);
|
||||
g_free(coex);
|
||||
}
|
||||
|
||||
static int xmm_coex_enable(struct ofono_modem *modem, void *data)
|
||||
{
|
||||
struct xmm7xxx_coex *coex;
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
const char *path = ofono_modem_get_path(modem);
|
||||
coex = g_new0(struct xmm7xxx_coex, 1);
|
||||
|
||||
DBG("coex enable");
|
||||
|
||||
coex->chat = data;
|
||||
coex->modem = modem;
|
||||
coex->bt_active = 0;
|
||||
coex->wlan_active = 0;
|
||||
coex->wlan_bw = WLAN_BW_20MHZ;
|
||||
coex->lte_band = g_strdup("INVALID");
|
||||
coex->session_agent = NULL;
|
||||
|
||||
if (!g_at_chat_send(coex->chat, "AT+XCCINFO=1", none_prefix,
|
||||
NULL, NULL, NULL))
|
||||
goto out;
|
||||
|
||||
if (!g_at_chat_send(coex->chat, "AT+XNRTCWS=7", none_prefix,
|
||||
NULL, NULL, NULL))
|
||||
goto out;
|
||||
|
||||
if (!g_dbus_register_interface(conn, path, OFONO_COEX_INTERFACE,
|
||||
coex_methods,
|
||||
coex_signals,
|
||||
NULL, coex, coex_cleanup)) {
|
||||
ofono_error("Could not register %s interface under %s",
|
||||
OFONO_COEX_INTERFACE, path);
|
||||
goto out;
|
||||
}
|
||||
|
||||
ofono_modem_add_interface(modem, OFONO_COEX_INTERFACE);
|
||||
|
||||
g_at_chat_register(coex->chat, "+XNRTCWSW:", xmm_coex_w_notify,
|
||||
FALSE, coex, NULL);
|
||||
g_at_chat_register(coex->chat, "+XNRTCWSB:", xmm_coex_b_notify,
|
||||
FALSE, coex, NULL);
|
||||
g_at_chat_register(coex->chat, "+XCCINFO:", xmm_lte_band_notify,
|
||||
FALSE, coex, NULL);
|
||||
return 0;
|
||||
|
||||
out:
|
||||
g_free(coex->lte_band);
|
||||
g_free(coex);
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
/* Coex Implementation Ends*/
|
||||
|
||||
static void xmm7xxx_debug(const char *str, void *user_data)
|
||||
{
|
||||
const char *prefix = user_data;
|
||||
|
@ -242,6 +1137,29 @@ static void cfun_enable_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
|||
xsimstate_query_cb, modem, NULL);
|
||||
}
|
||||
|
||||
static void netreg_watch(struct ofono_atom *atom,
|
||||
enum ofono_atom_watch_condition cond,
|
||||
void *data)
|
||||
{
|
||||
struct ofono_modem *modem = data;
|
||||
struct xmm7xxx_data *modem_data = ofono_modem_get_data(modem);
|
||||
DBusConnection *conn = ofono_dbus_get_connection();
|
||||
const char *path = ofono_modem_get_path(modem);
|
||||
|
||||
if (cond == OFONO_ATOM_WATCH_CONDITION_UNREGISTERED) {
|
||||
if (g_dbus_unregister_interface(conn, path,
|
||||
OFONO_COEX_INTERFACE))
|
||||
ofono_modem_remove_interface(modem,
|
||||
OFONO_COEX_INTERFACE);
|
||||
return;
|
||||
}
|
||||
|
||||
if (cond == OFONO_ATOM_WATCH_CONDITION_REGISTERED) {
|
||||
xmm_coex_enable(modem, modem_data->chat);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
static int xmm7xxx_enable(struct ofono_modem *modem)
|
||||
{
|
||||
struct xmm7xxx_data *data = ofono_modem_get_data(modem);
|
||||
|
@ -263,6 +1181,10 @@ static int xmm7xxx_enable(struct ofono_modem *modem)
|
|||
g_at_chat_send(data->chat, "AT+CFUN=4", none_prefix,
|
||||
cfun_enable_cb, modem, NULL);
|
||||
|
||||
data->netreg_watch = __ofono_modem_add_atom_watch(modem,
|
||||
OFONO_ATOM_TYPE_NETREG,
|
||||
netreg_watch, modem, NULL);
|
||||
|
||||
return -EINPROGRESS;
|
||||
}
|
||||
|
||||
|
@ -293,6 +1215,11 @@ static int xmm7xxx_disable(struct ofono_modem *modem)
|
|||
g_at_chat_send(data->chat, "AT+CFUN=0", none_prefix,
|
||||
cfun_disable_cb, modem, NULL);
|
||||
|
||||
if (data->netreg_watch) {
|
||||
__ofono_modem_remove_atom_watch(modem, data->netreg_watch);
|
||||
data->netreg_watch = 0;
|
||||
}
|
||||
|
||||
return -EINPROGRESS;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue