diff options
Diffstat (limited to 'plugins')
| -rw-r--r-- | plugins/CMakeLists.txt | 2 | ||||
| -rw-r--r-- | plugins/builtin.cpp | 83 | ||||
| -rw-r--r-- | plugins/gps.c | 54 | ||||
| -rw-r--r-- | plugins/gps.cpp | 70 |
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", ×tampJ)) - {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", ×tamp)) - { - *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 +} |