Add files via upload
This commit is contained in:
NawfalMotii79
GitHub
@@ -0,0 +1,227 @@
|
||||
/***************************************************************************//**
|
||||
* @file iio_trigger.c
|
||||
* @brief Implementation of generic iio trigger.
|
||||
* @author RBolboac (ramona.bolboaca@analog.com)
|
||||
********************************************************************************
|
||||
* Copyright 2022(c) Analog Devices, Inc.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright notice,
|
||||
* this list of conditions and the following disclaimer.
|
||||
*
|
||||
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
||||
* this list of conditions and the following disclaimer in the documentation
|
||||
* and/or other materials provided with the distribution.
|
||||
*
|
||||
* 3. Neither the name of Analog Devices, Inc. nor the names of its
|
||||
* contributors may be used to endorse or promote products derived from this
|
||||
* software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY ANALOG DEVICES, INC. “AS IS” AND ANY EXPRESS OR
|
||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO
|
||||
* EVENT SHALL ANALOG DEVICES, INC. BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include "no_os_error.h"
|
||||
#include "no_os_alloc.h"
|
||||
#include "iio.h"
|
||||
#include "iio_trigger.h"
|
||||
|
||||
#ifndef LINUX_PLATFORM
|
||||
/**
|
||||
* @brief Initialize hardware trigger.
|
||||
*
|
||||
* @param iio_trig - The iio trigger structure.
|
||||
* @param init_param - The structure that contains the trigger initial params.
|
||||
*
|
||||
* @return ret - Result of the initialization procedure.
|
||||
*/
|
||||
int iio_hw_trig_init(struct iio_hw_trig **iio_trig,
|
||||
struct iio_hw_trig_init_param *init_param)
|
||||
{
|
||||
struct iio_hw_trig *trig_desc;
|
||||
int ret;
|
||||
|
||||
if (!init_param->name)
|
||||
return -EINVAL;
|
||||
|
||||
trig_desc = (struct iio_hw_trig*)no_os_calloc(1, sizeof(*trig_desc));
|
||||
if (!trig_desc)
|
||||
return -ENOMEM;
|
||||
|
||||
trig_desc->iio_desc = init_param->iio_desc;
|
||||
strncpy(trig_desc->name, init_param->name, TRIG_MAX_NAME_SIZE);
|
||||
trig_desc->irq_ctrl = init_param->irq_ctrl;
|
||||
trig_desc->irq_id = init_param->irq_id;
|
||||
trig_desc->irq_trig_lvl = init_param->irq_trig_lvl;
|
||||
|
||||
struct no_os_callback_desc irq_cb = {
|
||||
.callback = iio_hw_trig_handler,
|
||||
.ctx = trig_desc,
|
||||
.event = init_param->cb_info.event,
|
||||
.handle = init_param->cb_info.handle,
|
||||
.peripheral = init_param->cb_info.peripheral
|
||||
};
|
||||
|
||||
ret = no_os_irq_register_callback(trig_desc->irq_ctrl,
|
||||
trig_desc->irq_id, &irq_cb);
|
||||
if (ret)
|
||||
goto error;
|
||||
|
||||
if (init_param->cb_info.event == NO_OS_EVT_GPIO) {
|
||||
ret = no_os_irq_trigger_level_set(trig_desc->irq_ctrl,
|
||||
trig_desc->irq_id, trig_desc->irq_trig_lvl);
|
||||
if (ret)
|
||||
goto error;
|
||||
}
|
||||
|
||||
*iio_trig = trig_desc;
|
||||
|
||||
return 0;
|
||||
error:
|
||||
no_os_free(trig_desc);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Enable system interrupt which is linked to the given trigger.
|
||||
*
|
||||
* @param trig - Trigger structure.
|
||||
*
|
||||
* @return ret - Result of the enable procedure.
|
||||
*/
|
||||
int iio_trig_enable(void *trig)
|
||||
{
|
||||
if (!trig)
|
||||
return -EINVAL;
|
||||
|
||||
struct iio_hw_trig *desc = trig;
|
||||
|
||||
return no_os_irq_enable(desc->irq_ctrl, desc->irq_id);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Disable system interrupt which is linked to the given trigger.
|
||||
*
|
||||
* @param trig - Trigger structure.
|
||||
*
|
||||
* @return ret - Result of the disable procedure.
|
||||
*/
|
||||
int iio_trig_disable(void *trig)
|
||||
{
|
||||
if (!trig)
|
||||
return -EINVAL;
|
||||
|
||||
struct iio_hw_trig *desc = trig;
|
||||
|
||||
return no_os_irq_disable(desc->irq_ctrl, desc->irq_id);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Trigger interrupt handler. This function will be called when a system
|
||||
* interrupt is asserted for the configured trigger.
|
||||
*
|
||||
* @param trig - Trigger structure which is linked to this handler.
|
||||
*/
|
||||
void iio_hw_trig_handler(void *trig)
|
||||
{
|
||||
if (!trig)
|
||||
return;
|
||||
|
||||
struct iio_hw_trig *desc = trig;
|
||||
|
||||
iio_process_trigger_type(desc->iio_desc, desc->name);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Free the resources allocated by iio_hw_trig_init().
|
||||
*
|
||||
* @param trig - The trigger structure.
|
||||
*
|
||||
* @return ret - Result of the remove procedure.
|
||||
*/
|
||||
int iio_hw_trig_remove(struct iio_hw_trig *trig)
|
||||
{
|
||||
if (trig)
|
||||
no_os_free(trig);
|
||||
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @brief Initialize software trigger.
|
||||
*
|
||||
* @param iio_trig - The iio trigger structure.
|
||||
* @param init_param - The structure that contains the sw trigger initial params.
|
||||
*
|
||||
* @return ret - Result of the initialization procedure.
|
||||
*/
|
||||
int iio_sw_trig_init(struct iio_sw_trig **iio_trig,
|
||||
struct iio_sw_trig_init_param *init_param)
|
||||
{
|
||||
struct iio_sw_trig *trig_desc;
|
||||
|
||||
if (!init_param->iio_desc || !init_param->name)
|
||||
return -EINVAL;
|
||||
|
||||
trig_desc = (struct iio_sw_trig*)no_os_calloc(1, sizeof(*trig_desc));
|
||||
if (!trig_desc)
|
||||
return -ENOMEM;
|
||||
|
||||
trig_desc->iio_desc = init_param->iio_desc;
|
||||
strncpy(trig_desc->name, init_param->name, TRIG_MAX_NAME_SIZE);
|
||||
|
||||
*iio_trig = trig_desc;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Handles the write request for trigger_now attribute.
|
||||
*
|
||||
* @param trig - The iio trigger structure.
|
||||
* @param buf - Command buffer to be filled with the data to be written.
|
||||
* @param len - Length of the received command buffer in bytes.
|
||||
* @param channel - Command channel info (is NULL).
|
||||
* @param priv - Command attribute id.
|
||||
*
|
||||
* @return ret - Result of the sw trigger handler procedure.
|
||||
*/
|
||||
int iio_sw_trig_handler(void *trig, char *buf, uint32_t len,
|
||||
const struct iio_ch_info *channel,
|
||||
intptr_t priv)
|
||||
{
|
||||
if (!trig)
|
||||
return -EINVAL;
|
||||
|
||||
struct iio_sw_trig *desc = trig;
|
||||
|
||||
return iio_process_trigger_type(desc->iio_desc, desc->name);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Free the resources allocated by iio_sw_trig_init().
|
||||
*
|
||||
* @param trig - The trigger structure.
|
||||
*
|
||||
* @return ret - Result of the remove procedure.
|
||||
*/
|
||||
int iio_sw_trig_remove(struct iio_sw_trig *trig)
|
||||
{
|
||||
if (trig)
|
||||
no_os_free(trig);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user