96 lines
2.6 KiB
C
96 lines
2.6 KiB
C
/*
|
|
* Copyright (c) 2022 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#ifndef ZEPHYR_DRIVERS_SMBUS_SMBUS_UTILS_H_
|
|
#define ZEPHYR_DRIVERS_SMBUS_SMBUS_UTILS_H_
|
|
|
|
/**
|
|
* @brief Generic function to insert a callback to a callback list
|
|
*
|
|
* @param callbacks A pointer to the original list of callbacks (can be NULL)
|
|
* @param callback A pointer of the callback to insert to the list
|
|
*
|
|
* @return 0 on success, negative errno otherwise.
|
|
*/
|
|
static inline int smbus_callback_set(sys_slist_t *callbacks,
|
|
struct smbus_callback *callback)
|
|
{
|
|
__ASSERT(callback, "No callback!");
|
|
__ASSERT(callback->handler, "No callback handler!");
|
|
|
|
if (!sys_slist_is_empty(callbacks)) {
|
|
sys_slist_find_and_remove(callbacks, &callback->node);
|
|
}
|
|
|
|
sys_slist_prepend(callbacks, &callback->node);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Generic function to remove a callback from a callback list
|
|
*
|
|
* @param callbacks A pointer to the original list of callbacks (can be NULL)
|
|
* @param callback A pointer of the callback to remove from the list
|
|
*
|
|
* @return 0 on success, negative errno otherwise.
|
|
*/
|
|
static inline int smbus_callback_remove(sys_slist_t *callbacks,
|
|
struct smbus_callback *callback)
|
|
{
|
|
__ASSERT(callback, "No callback!");
|
|
__ASSERT(callback->handler, "No callback handler!");
|
|
|
|
if (sys_slist_is_empty(callbacks) ||
|
|
!sys_slist_find_and_remove(callbacks, &callback->node)) {
|
|
return -ENOENT;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Generic function to go through and fire callback from a callback list
|
|
*
|
|
* @param list A pointer on the SMBus callback list
|
|
* @param dev A pointer on the SMBus device instance
|
|
* @param addr A SMBus peripheral device address.
|
|
*/
|
|
static inline void smbus_fire_callbacks(sys_slist_t *list,
|
|
const struct device *dev,
|
|
uint8_t addr)
|
|
{
|
|
struct smbus_callback *cb, *tmp;
|
|
|
|
SYS_SLIST_FOR_EACH_CONTAINER_SAFE(list, cb, tmp, node) {
|
|
if (cb->addr == addr) {
|
|
__ASSERT(cb->handler, "No callback handler!");
|
|
cb->handler(dev, cb, addr);
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Helper to initialize a struct smbus_callback properly
|
|
*
|
|
* @param callback A valid Application's callback structure pointer.
|
|
* @param handler A valid handler function pointer.
|
|
* @param addr A SMBus peripheral device address.
|
|
*/
|
|
static inline void smbus_init_callback(struct smbus_callback *callback,
|
|
smbus_callback_handler_t handler,
|
|
uint8_t addr)
|
|
{
|
|
__ASSERT(callback, "Callback pointer should not be NULL");
|
|
__ASSERT(handler, "Callback handler pointer should not be NULL");
|
|
|
|
callback->handler = handler;
|
|
callback->addr = addr;
|
|
}
|
|
|
|
|
|
#endif /* ZEPHYR_DRIVERS_SMBUS_SMBUS_UTILS_H_ */
|