colin/ModemManager
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

quectel,shared: port GPS enabling to use AT sequence

Browse Source
This commit is contained in:
Aleksander Morgado
2020-06-28 14:57:49 +02:00
parent 41ba7d667a
commit 78d19c10ba
1 changed files with 38 additions and 63 deletions
Download Patch File Download Diff File Expand all files Collapse all files

79
plugins/quectel/mm-shared-quectel.c
View File

@@ -320,21 +320,17 @@ mm_shared_quectel_location_load_capabilities (MMIfaceModemLocation *_self,
/*****************************************************************************/
/* Enable location gathering (Location interface) */
static const gchar *gps_startup[] = {
/* NOTES:
/* NOTES:
* 1) "+QGPSCFG=\"nmeasrc\",1" will be necessary for getting location data
* without the nmea port.
* 2) may be necessary to set "+QGPSCFG=\"gpsnmeatype\".
*/
"+QGPSCFG=\"outport\",\"usbnmea\"",
"+QGPS=1",
static const MMBaseModemAtCommand gps_startup[] = {
{ "+QGPSCFG=\"outport\",\"usbnmea\"", 3, FALSE, mm_base_modem_response_processor_no_result_continue },
{ "+QGPS=1", 3, FALSE, mm_base_modem_response_processor_no_result_continue },
{ NULL }
};
typedef struct {
MMModemLocationSource source;
guint idx;
} LocationGatheringContext;
gboolean
mm_shared_quectel_enable_location_gathering_finish (MMIfaceModemLocation *self,
GAsyncResult *res,
@@ -343,48 +339,25 @@ mm_shared_quectel_enable_location_gathering_finish (MMIfaceModemLocation *self,
return g_task_propagate_boolean (G_TASK (res), error);
}
static void run_gps_startup (GTask *task);
static void
gps_startup_command_ready (MMBaseModem *self,
gps_startup_ready (MMBaseModem *self,
GAsyncResult *res,
GTask *task)
{
MMModemLocationSource source;
GError *error = NULL;
if (!mm_base_modem_at_command_full_finish (self, res, &error)) {
mm_base_modem_at_sequence_finish (self, res, NULL, &error);
if (error) {
g_task_return_error (task, error);
g_object_unref (task);
return;
}
/* continue with next command */
run_gps_startup (task);
}
static void
run_gps_startup (GTask *task)
{
MMSharedQuectel *self;
LocationGatheringContext *ctx;
self = g_task_get_source_object (task);
ctx = g_task_get_task_data (task);
/* If there are more commands run them */
if (ctx->idx < G_N_ELEMENTS (gps_startup)) {
mm_base_modem_at_command (MM_BASE_MODEM (self),
gps_startup[ctx->idx++],
3,
FALSE,
(GAsyncReadyCallback)gps_startup_command_ready,
task);
return;
}
source = GPOINTER_TO_UINT (g_task_get_task_data (task));
/* Check if the nmea/raw gps port exists and is available */
if (ctx->source & (MM_MODEM_LOCATION_SOURCE_GPS_NMEA | MM_MODEM_LOCATION_SOURCE_GPS_RAW)) {
GError *error = NULL;
if (source & (MM_MODEM_LOCATION_SOURCE_GPS_NMEA | MM_MODEM_LOCATION_SOURCE_GPS_RAW)) {
MMPortSerialGps *gps_port;
gps_port = mm_base_modem_peek_port_gps (MM_BASE_MODEM (self));
@@ -425,7 +398,6 @@ mm_shared_quectel_enable_location_gathering (MMIfaceModemLocation *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
LocationGatheringContext *ctx;
GTask *task;
Private *priv;
gboolean start_gps = FALSE;
@@ -436,6 +408,7 @@ mm_shared_quectel_enable_location_gathering (MMIfaceModemLocation *self,
g_assert (priv->iface_modem_location_parent->enable_location_gathering_finish);
task = g_task_new (self, NULL, callback, user_data);
g_task_set_task_data (task, GUINT_TO_POINTER (source), NULL);
/* Check if the source is provided by the parent */
if (!(priv->provided_sources & source)) {
@@ -447,26 +420,28 @@ mm_shared_quectel_enable_location_gathering (MMIfaceModemLocation *self,
return;
}
ctx = g_new0 (LocationGatheringContext, 1);
ctx->source = source;
g_task_set_task_data (task, ctx, g_free);
/* RAW, NMEA and UNMANAGED are all enabled in the same way */
if (ctx->source & (MM_MODEM_LOCATION_SOURCE_GPS_NMEA |
/* Only start GPS engine if not done already */
start_gps = ((source & (MM_MODEM_LOCATION_SOURCE_GPS_NMEA |
MM_MODEM_LOCATION_SOURCE_GPS_RAW |
MM_MODEM_LOCATION_SOURCE_GPS_UNMANAGED)) {
if (priv->enabled_sources == MM_MODEM_LOCATION_SOURCE_NONE)
start_gps = TRUE;
MM_MODEM_LOCATION_SOURCE_GPS_UNMANAGED)) &&
!(priv->enabled_sources & (MM_MODEM_LOCATION_SOURCE_GPS_NMEA |
MM_MODEM_LOCATION_SOURCE_GPS_RAW |
MM_MODEM_LOCATION_SOURCE_GPS_UNMANAGED)));
priv->enabled_sources |= ctx->source;
}
priv->enabled_sources |= source;
if (start_gps) {
run_gps_startup (task);
mm_base_modem_at_sequence (
MM_BASE_MODEM (self),
gps_startup,
NULL, /* response_processor_context */
NULL, /* response_processor_context_free */
(GAsyncReadyCallback)gps_startup_ready,
task);
return;
}
/* For any other location (e.g. 3GPP), or if the GPS is already running just return */
/* If the GPS is already running just return */
g_task_return_boolean (task, TRUE);
g_object_unref (task);
}