b10428163a
Currently there is no way to distinguish between a caller explicitly asking for a semaphore with a limit that happens to be `UINT_MAX` and a semaphore that just has a limit "as large as possible". Add `K_SEM_MAX_LIMIT`, currently defined to `UINT_MAX`, and akin to `K_FOREVER` versus just passing some very large wait time. In addition, the `k_sem_*` APIs were type-confused, where the internal data structure was `uint32_t`, but the APIs took and returned `unsigned int`. This changes the underlying data structure to also use `unsigned int`, as changing the APIs would be a (potentially) breaking change. These changes are backwards-compatible, but it is strongly suggested to take a quick scan for `k_sem_init` and `K_SEM_DEFINE` calls with `UINT_MAX` (or `UINT32_MAX`) and replace them with `K_SEM_MAX_LIMIT` where appropriate. Signed-off-by: James Harris <james.harris@intel.com>
148 lines
3.3 KiB
C
148 lines
3.3 KiB
C
/*
|
|
* Copyright (c) 2016 ARM Ltd.
|
|
* Copyright (c) 2019 Nordic Semiconductor ASA
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT nordic_nrf_temp
|
|
|
|
#include <device.h>
|
|
#include <drivers/sensor.h>
|
|
#include <drivers/clock_control.h>
|
|
#include <drivers/clock_control/nrf_clock_control.h>
|
|
#include <logging/log.h>
|
|
#include <hal/nrf_temp.h>
|
|
|
|
LOG_MODULE_REGISTER(temp_nrf5, CONFIG_SENSOR_LOG_LEVEL);
|
|
|
|
|
|
/* The nRF5 temperature device returns measurements in 0.25C
|
|
* increments. Scale to mDegrees C.
|
|
*/
|
|
#define TEMP_NRF5_TEMP_SCALE (1000000 / 4)
|
|
|
|
struct temp_nrf5_data {
|
|
struct k_sem device_sync_sem;
|
|
struct k_mutex mutex;
|
|
int32_t sample;
|
|
struct onoff_manager *clk_mgr;
|
|
};
|
|
|
|
static void hfclk_on_callback(struct onoff_manager *mgr,
|
|
struct onoff_client *cli,
|
|
uint32_t state,
|
|
int res)
|
|
{
|
|
nrf_temp_task_trigger(NRF_TEMP, NRF_TEMP_TASK_START);
|
|
}
|
|
|
|
static int temp_nrf5_sample_fetch(const struct device *dev,
|
|
enum sensor_channel chan)
|
|
{
|
|
struct temp_nrf5_data *data = dev->data;
|
|
struct onoff_client cli;
|
|
int r;
|
|
|
|
/* Error if before sensor initialized */
|
|
if (data->clk_mgr == NULL) {
|
|
return -EAGAIN;
|
|
}
|
|
|
|
if (chan != SENSOR_CHAN_ALL && chan != SENSOR_CHAN_DIE_TEMP) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
k_mutex_lock(&data->mutex, K_FOREVER);
|
|
|
|
sys_notify_init_callback(&cli.notify, hfclk_on_callback);
|
|
r = onoff_request(data->clk_mgr, &cli);
|
|
__ASSERT_NO_MSG(r >= 0);
|
|
|
|
k_sem_take(&data->device_sync_sem, K_FOREVER);
|
|
|
|
r = onoff_release(data->clk_mgr);
|
|
__ASSERT_NO_MSG(r >= 0);
|
|
|
|
data->sample = nrf_temp_result_get(NRF_TEMP);
|
|
LOG_DBG("sample: %d", data->sample);
|
|
nrf_temp_task_trigger(NRF_TEMP, NRF_TEMP_TASK_STOP);
|
|
|
|
k_mutex_unlock(&data->mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int temp_nrf5_channel_get(const struct device *dev,
|
|
enum sensor_channel chan,
|
|
struct sensor_value *val)
|
|
{
|
|
struct temp_nrf5_data *data = dev->data;
|
|
int32_t uval;
|
|
|
|
|
|
if (chan != SENSOR_CHAN_DIE_TEMP) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
uval = data->sample * TEMP_NRF5_TEMP_SCALE;
|
|
val->val1 = uval / 1000000;
|
|
val->val2 = uval % 1000000;
|
|
|
|
LOG_DBG("Temperature:%d,%d", val->val1, val->val2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void temp_nrf5_isr(void *arg)
|
|
{
|
|
const struct device *dev = (const struct device *)arg;
|
|
struct temp_nrf5_data *data = dev->data;
|
|
|
|
nrf_temp_event_clear(NRF_TEMP, NRF_TEMP_EVENT_DATARDY);
|
|
k_sem_give(&data->device_sync_sem);
|
|
}
|
|
|
|
static const struct sensor_driver_api temp_nrf5_driver_api = {
|
|
.sample_fetch = temp_nrf5_sample_fetch,
|
|
.channel_get = temp_nrf5_channel_get,
|
|
};
|
|
|
|
static int temp_nrf5_init(const struct device *dev)
|
|
{
|
|
struct temp_nrf5_data *data = dev->data;
|
|
|
|
LOG_DBG("");
|
|
|
|
/* A null clk_mgr indicates sensor has not been initialized */
|
|
data->clk_mgr =
|
|
z_nrf_clock_control_get_onoff(CLOCK_CONTROL_NRF_SUBSYS_HF);
|
|
__ASSERT_NO_MSG(data->clk_mgr);
|
|
|
|
k_sem_init(&data->device_sync_sem, 0, K_SEM_MAX_LIMIT);
|
|
k_mutex_init(&data->mutex);
|
|
|
|
IRQ_CONNECT(
|
|
DT_INST_IRQN(0),
|
|
DT_INST_IRQ(0, priority),
|
|
temp_nrf5_isr,
|
|
DEVICE_DT_INST_GET(0),
|
|
0);
|
|
irq_enable(DT_INST_IRQN(0));
|
|
|
|
nrf_temp_int_enable(NRF_TEMP, NRF_TEMP_INT_DATARDY_MASK);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct temp_nrf5_data temp_nrf5_driver;
|
|
|
|
DEVICE_DT_INST_DEFINE(0,
|
|
temp_nrf5_init,
|
|
device_pm_control_nop,
|
|
&temp_nrf5_driver,
|
|
NULL,
|
|
POST_KERNEL,
|
|
CONFIG_SENSOR_INIT_PRIORITY,
|
|
&temp_nrf5_driver_api);
|