From 3e45dda1b12578c9d84b7a4f479e2a9fbaaa5d3b Mon Sep 17 00:00:00 2001 From: Romain Forlot Date: Thu, 5 Jul 2018 15:36:17 +0200 Subject: Change, clean plugins. Improve GPS plugin to be able to calculate the heading also remove the builtin plugin that was an error. We need to pass GPS plugin in C++ to be able to use the context. Handle "double" and "int" signal's value. Change-Id: I6d902e4ac76a0e933326c0b4c43922645c9c5a4c Signed-off-by: Romain Forlot --- plugins/gps.cpp | 70 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 70 insertions(+) create mode 100644 plugins/gps.cpp (limited to 'plugins/gps.cpp') 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 + * + * 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 +#include +#include +#include + +#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 +} -- cgit 1.2.3-korg