zephyr/drivers/gnss/gnss_publish.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