aboutsummaryrefslogtreecommitdiffstats
path: root/plugins
diff options
context:
space:
mode:
Diffstat (limited to 'plugins')
-rw-r--r--plugins/CMakeLists.txt2
-rw-r--r--plugins/builtin.cpp83
-rw-r--r--plugins/gps.c54
-rw-r--r--plugins/gps.cpp70
4 files changed, 71 insertions, 138 deletions
diff --git a/plugins/CMakeLists.txt b/plugins/CMakeLists.txt
index b6eec08..0d437d5 100644
--- a/plugins/CMakeLists.txt
+++ b/plugins/CMakeLists.txt
@@ -63,7 +63,7 @@ PROJECT_TARGET_ADD(low-can)
PROJECT_TARGET_ADD(gps)
# Define targets
- ADD_LIBRARY(${TARGET_NAME} MODULE ${TARGET_NAME}.c)
+ ADD_LIBRARY(${TARGET_NAME} MODULE ${TARGET_NAME}.cpp)
# Alsa Plugin properties
SET_TARGET_PROPERTIES(${TARGET_NAME} PROPERTIES
diff --git a/plugins/builtin.cpp b/plugins/builtin.cpp
deleted file mode 100644
index 5eccc24..0000000
--- a/plugins/builtin.cpp
+++ /dev/null
@@ -1,83 +0,0 @@
-/*
- * Copyright (C) 2016 "IoT.bzh"
- * Author Romain Forlot <romain.forlot@iot.bzh>
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- *
-*/
-
-#define AFB_BINDING_VERSION 2
-#include <afb/afb-binding.h>
-#include <systemd/sd-event.h>
-#include <json-c/json_object.h>
-#include <stdbool.h>
-#include <string.h>
-
-#include "signal-composer.hpp"
-#include "wrap-json.h"
-
-extern "C"
-{
-CTLP_LUA_REGISTER("builtin");
-
-CTLP_CAPI (defaultOnReceived, source, argsJ, eventJ)
-{
- struct signalCBT* ctx = (struct signalCBT*)source->context;
- AFB_NOTICE("source: %s argj: %s, eventJ %s", source->uid,
- json_object_to_json_string(argsJ),
- json_object_to_json_string(eventJ));
-
- json_object* valueJ = nullptr;
- json_object* timestampJ = nullptr;
- double value = 0;
- uint64_t timestamp = 0;
- if(json_object_object_get_ex(eventJ, "value", &valueJ))
- {value = json_object_get_double(valueJ);}
- if(json_object_object_get_ex(eventJ, "timestamp", &timestampJ))
- {timestamp = json_object_get_int64(timestampJ);}
-
- struct signalValue v = value;
- ctx->setSignalValue(ctx->aSignal, timestamp, v);
- return 0;
-}
-
-CTLP_LUA2C (setSignalValueWrap, source, argsJ, responseJ)
-{
- const char* name = nullptr;
- double resultNum;
- uint64_t timestamp;
-
- struct signalCBT* ctx = (struct signalCBT*)source->context;
-
- if(! wrap_json_unpack(argsJ, "{ss, sF, sI? !}",
- "name", &name,
- "value", &resultNum,
- "timestamp", &timestamp))
- {
- *responseJ = json_object_new_string("Fail to unpack JSON arguments value");
- return -1;
- }
- *responseJ = json_object_new_string(json_object_to_json_string(argsJ));
-
- struct signalValue result = resultNum;
-
- if(ctx->aSignal)
- {ctx->setSignalValue(ctx->aSignal, timestamp*MICRO, result);}
- else
- {ctx->searchNsetSignalValue(name, timestamp*MICRO, result);}
-
- return 0;
-}
-
-// extern "C" closure
-}
diff --git a/plugins/gps.c b/plugins/gps.c
deleted file mode 100644
index af594fa..0000000
--- a/plugins/gps.c
+++ /dev/null
@@ -1,54 +0,0 @@
-/*
- * Copyright (C) 2016 "IoT.bzh"
- * Author Romain Forlot <romain.forlot@iot.bzh>
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- *
-*/
-
-#define _GNU_SOURCE // needed for vasprintf
-
-#define AFB_BINDING_VERSION 2
-#include <afb/afb-binding.h>
-#include <systemd/sd-event.h>
-#include <json-c/json_object.h>
-#include <stdbool.h>
-#include <string.h>
-
-#include "ctl-plugin.h"
-#include "wrap-json.h"
-
-CTLP_CAPI_REGISTER("gps");
-
-// Call at initialisation time
-/*CTLP_ONLOAD(plugin, api) {
- AFB_NOTICE ("GPS plugin: uid='%s' 'info='%s'", plugin->uid, plugin->info);
- return api;
-}*/
-
-CTLP_CAPI (subscribeToLow, source, argsJ, eventJ) {
- json_object* subscribeArgsJ = NULL, *responseJ = NULL;
-
- int err = 0;
- wrap_json_pack(&subscribeArgsJ, "{ss}", "value", "location");
-
- AFB_DEBUG("Calling subscribe with %s", json_object_to_json_string_ext(subscribeArgsJ, JSON_C_TO_STRING_PRETTY));
- err = afb_service_call_sync("gps", "subscribe", subscribeArgsJ, &responseJ);
- if(err)
- {
- AFB_ERROR("Can't find api 'gpsd'");
- return err;
- }
-
- return err;
-}
diff --git a/plugins/gps.cpp b/plugins/gps.cpp
new file mode 100644
index 0000000..60aa80a
--- /dev/null
+++ b/plugins/gps.cpp
@@ -0,0 +1,70 @@
+/*
+ * Copyright (C) 2016 "IoT.bzh"
+ * Author Romain Forlot <romain.forlot@iot.bzh>
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+*/
+
+#define CTL_PLUGIN_MAGIC 1286576532
+
+#define AFB_BINDING_VERSION 2
+#include <afb/afb-binding.h>
+#include <systemd/sd-event.h>
+#include <json-c/json_object.h>
+#include <math.h>
+
+#include "signal-composer.hpp"
+
+extern "C"
+{
+CTLP_CAPI_REGISTER("gps");
+
+CTLP_CAPI (getHeading, source, argsJ, eventJ) {
+
+ static bool coordUpdated = true;
+ static double prvLat = 0, prvLon = 0, curLat = 0, curLon = 0, heading = 0;
+ double r2d = 180.0 / M_PI;
+ double d2r = M_PI / 180.0;
+ int err = 0;
+
+ struct signalCBT* ctx = (struct signalCBT*)source->context;
+ json_object *val = NULL, *lastSignal = NULL, *id = NULL;
+
+ lastSignal = json_object_array_get_idx(eventJ, json_object_array_length(eventJ) -1);
+
+ if(json_object_object_get_ex(lastSignal, "uid", &id) && std::string(json_object_get_string(id)) == "latitude" &&
+ json_object_object_get_ex(lastSignal, "value", &val)) {
+ prvLat = curLat;
+ curLat = json_object_get_double(val);
+ coordUpdated = !coordUpdated;
+ }
+
+ if(json_object_object_get_ex(lastSignal, "uid", &id) &&
+ std::string(json_object_get_string(id)) == "longitude" &&
+ json_object_object_get_ex(lastSignal, "value", &val)) {
+ prvLon = curLon;
+ curLon = json_object_get_double(val);
+ coordUpdated = !coordUpdated;
+ }
+
+ if(coordUpdated) {
+ heading = round(r2d * atan2((curLon - prvLon) * cos(d2r * curLat), curLat - prvLat));
+ ctx->setSignalValue(ctx->aSignal, 0, heading);
+ }
+
+ AFB_NOTICE("======== Heading: %f", heading);
+ return err;
+}
+// extern "C" closure
+}