41 lines
940 B
C
41 lines
940 B
C
/*
|
|
* Copyright (c) 2023 Trackunit Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr/drivers/gnss/gnss_publish.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/sys/iterable_sections.h>
|
|
|
|
static K_SEM_DEFINE(semlock, 1, 1);
|
|
|
|
void gnss_publish_data(const struct device *dev, const struct gnss_data *data)
|
|
{
|
|
(void)k_sem_take(&semlock, K_FOREVER);
|
|
|
|
STRUCT_SECTION_FOREACH(gnss_data_callback, callback) {
|
|
if (callback->dev == NULL || callback->dev == dev) {
|
|
callback->callback(dev, data);
|
|
}
|
|
}
|
|
|
|
k_sem_give(&semlock);
|
|
}
|
|
|
|
#if CONFIG_GNSS_SATELLITES
|
|
void gnss_publish_satellites(const struct device *dev, const struct gnss_satellite *satellites,
|
|
uint16_t size)
|
|
{
|
|
(void)k_sem_take(&semlock, K_FOREVER);
|
|
|
|
STRUCT_SECTION_FOREACH(gnss_satellites_callback, callback) {
|
|
if (callback->dev == NULL || callback->dev == dev) {
|
|
callback->callback(dev, satellites, size);
|
|
}
|
|
}
|
|
|
|
k_sem_give(&semlock);
|
|
}
|
|
#endif
|