bdddc76997
Related: b17c074a18
Log:
Error: sensors/ms56xx_uorb.c:145:20: error: initialization of 'int (*)(struct sensor_lowerhalf_s *, struct file *, uint32_t *)' {aka 'int (*)(struct sensor_lowerhalf_s *, struct file *, unsigned int *)'} from incompatible pointer type 'int (*)(struct sensor_lowerhalf_s *, struct file *, long unsigned int *)' [-Werror=incompatible-pointer-types]
145 | .set_interval = ms56xx_set_interval,
| ^~~~~~~~~~~~~~~~~~~
sensors/ms56xx_uorb.c:145:20: note: (near initialization for 'g_sensor_ops.set_interval')
cc1: all warnings being treated as errors
Signed-off-by: wangjianyu3 <wangjianyu3@xiaomi.com>
992 lines
27 KiB
C
992 lines
27 KiB
C
/****************************************************************************
|
|
* drivers/sensors/ds18b20_uorb.c
|
|
* Character driver for DS18B20 Digital Humidity and Temperature Module.
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdbool.h>
|
|
|
|
#include <nuttx/kmalloc.h>
|
|
#include <nuttx/kthread.h>
|
|
#include <nuttx/signal.h>
|
|
#include <nuttx/semaphore.h>
|
|
#include <nuttx/fs/fs.h>
|
|
#include <nuttx/1wire/1wire.h>
|
|
#include <nuttx/1wire/1wire_master.h>
|
|
#include <nuttx/1wire/1wire_crc.h>
|
|
#include <nuttx/sensors/ds18b20.h>
|
|
#include <nuttx/sensors/sensor.h>
|
|
|
|
#if defined(CONFIG_1WIRE) && defined(CONFIG_SENSORS_DS18B20)
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
#ifndef CONFIG_ENDIAN_BIG
|
|
# define ds18b20_leuint64(x) (x)
|
|
#endif
|
|
|
|
/* Scratchpad data definition for reading */
|
|
|
|
#define DS18B20_SPAD_LSB_OFFSET 0
|
|
#define DS18B20_SPAD_MSB_OFFSET 1
|
|
#define DS18B20_SPAD_TH_OFFSET 2
|
|
#define DS18B20_SPAD_TL_OFFSET 3
|
|
#define DS18B20_SPAD_RES_OFFSET 4
|
|
#define DS18B20_SPAD_CRC_OFFSET 9
|
|
#define DS18B20_SPAD_SIZE 9
|
|
|
|
/* Scratchpad data definition for writing */
|
|
|
|
#define DS18B20_WSPAD_CMD_OFFSET 0
|
|
#define DS18B20_WSPAD_TH_OFFSET 0
|
|
#define DS18B20_WSPAD_TL_OFFSET 1
|
|
#define DS18B20_WSPAD_RES_OFFSET 2
|
|
#define DS18B20_WSPAD_SIZE 3
|
|
|
|
/* Measurement resolution bit definition */
|
|
|
|
#define DS18B20_RESMIN 0
|
|
#define DS18B20_RESMAX 3
|
|
#define DS18B20_NRES DS18B20_RESMAX - DS18B20_RESMIN + 1
|
|
|
|
#define DS18B20_RES_VAL(x) (((x) >> 5) & 0x3)
|
|
#define DS18B20_RES_CONV(x) (((x) & 0x3) << 5)
|
|
|
|
/* Measurement timneout offset */
|
|
|
|
#define DS18B20_TIMEOUT_OFFSET(x) (DS18B20_RESMAX - (x))
|
|
|
|
/* Default alarm temperature */
|
|
|
|
#define DS18B20_TALARM_MIN -55
|
|
#define DS18B20_TALARM_MAX 125
|
|
|
|
/* Helper for getting data from scratchpad memory */
|
|
|
|
#define DS18B20_TEMP_PREDEC(lsb, msb) (int8_t)(((msb) << 4) | ((lsb) >> 4))
|
|
#define DS18B20_TEMP_RES(lsb, res) (DS18B20_RESMAX - DS18B20_RES_VAL(res))
|
|
#define DS18B20_TEMP_RESMASK(lsb, res) (0x0f << DS18B20_TEMP_RES(lsb, res))
|
|
#define DS18B20_TEMP_DEC(lsb, res) (((lsb) & 0x0f) & \
|
|
DS18B20_TEMP_RESMASK(lsb, res))
|
|
#define DS18B20_TEMP(lsb, msb, res) (DS18B20_TEMP_PREDEC(lsb, msb) + \
|
|
DS18B20_TEMP_DEC(lsb, res) / 16.0)
|
|
|
|
/****************************************************************************
|
|
* Private Types
|
|
****************************************************************************/
|
|
|
|
/* Internal sensor data */
|
|
|
|
struct ds18b20_sensor_data_s
|
|
{
|
|
uint64_t timestamp;
|
|
uint8_t spad[DS18B20_SPAD_SIZE];
|
|
};
|
|
|
|
/* User configuration register */
|
|
|
|
struct ds18b20_config_s
|
|
{
|
|
uint8_t res; /* Sensor resolution */
|
|
struct ds18b20_alarm_s alarm; /* Sensor temperature alarm */
|
|
};
|
|
|
|
/* Callback handling for alarm detection */
|
|
|
|
struct ds18b20_cb_alarm_s
|
|
{
|
|
bool isalarm;
|
|
uint64_t romcode;
|
|
};
|
|
|
|
/* Lower sensor */
|
|
|
|
struct ds18b20_sensor_s
|
|
{
|
|
struct sensor_lowerhalf_s lower; /* Common lower interface */
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
bool enabled; /* Sensor activated */
|
|
#endif
|
|
};
|
|
|
|
/* Internal device */
|
|
|
|
struct ds18b20_dev_s
|
|
{
|
|
struct ds18b20_sensor_s sensor; /* Sensor */
|
|
FAR struct onewire_master_s *master; /* 1wire master interface */
|
|
struct onewire_config_s config; /* 1wire device configuration */
|
|
struct ds18b20_config_s reg; /* Sensor resolution */
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
uint32_t interval; /* Polling interval */
|
|
sem_t run; /* Locks sensor thread */
|
|
#endif
|
|
};
|
|
|
|
/****************************************************************************
|
|
* Private Function Prototypes
|
|
****************************************************************************/
|
|
|
|
/* Sensor functions */
|
|
|
|
static int ds18b20_active(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
bool enabled);
|
|
|
|
static int ds18b20_fetch(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
FAR char *buffer, size_t buflen);
|
|
|
|
static int ds18b20_control(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
int cmd, unsigned long arg);
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static int ds18b20_set_interval(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
FAR uint32_t *period_us);
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Private Data
|
|
****************************************************************************/
|
|
|
|
/* Timeout definitions after measurement according to the data sheet */
|
|
|
|
static const uint32_t g_res_timeout[DS18B20_NRES] =
|
|
{
|
|
93750,
|
|
187500,
|
|
375000,
|
|
750000
|
|
};
|
|
|
|
static const struct sensor_ops_s g_ds18b20_ops =
|
|
{
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
.set_interval = ds18b20_set_interval,
|
|
#endif
|
|
.activate = ds18b20_active,
|
|
.fetch = ds18b20_fetch,
|
|
.control = ds18b20_control
|
|
};
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_rawdata
|
|
*
|
|
* Description:
|
|
* Helper for extract temperature data from scratchpad
|
|
*
|
|
* Return:
|
|
* Raw temperature data
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline int16_t ds18b20_rawtemp(FAR const uint8_t *spad)
|
|
{
|
|
return (spad[DS18B20_SPAD_LSB_OFFSET] |
|
|
(spad[DS18B20_SPAD_MSB_OFFSET] << 8));
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_tempdata
|
|
*
|
|
* Description:
|
|
* Helper for converting temperature data from raw sensor data
|
|
*
|
|
* Return:
|
|
* Temperature data
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline float ds18b20_temp(FAR const uint8_t *spad)
|
|
{
|
|
int8_t predec = DS18B20_TEMP_PREDEC(spad[DS18B20_SPAD_LSB_OFFSET],
|
|
spad[DS18B20_SPAD_MSB_OFFSET]);
|
|
uint8_t dec = DS18B20_TEMP_DEC(spad[DS18B20_SPAD_LSB_OFFSET],
|
|
spad[DS18B20_SPAD_RES_OFFSET]);
|
|
|
|
return predec + dec / 16.0;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_alarm_cb
|
|
*
|
|
* Description:
|
|
* Call back function for searching a single alarm device.
|
|
*
|
|
* Input Parameters:
|
|
* romcode - Unique romcode of a device with alarm flag set
|
|
* arg - Pointer to struct onewire_alarm_s
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static void ds18b20_alarm_cb(int family, uint64_t romcode, FAR void *arg)
|
|
{
|
|
FAR struct ds18b20_cb_alarm_s *priv = (FAR struct ds18b20_cb_alarm_s *)arg;
|
|
|
|
if (romcode == priv->romcode)
|
|
{
|
|
priv->isalarm = true;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_isalarm
|
|
*
|
|
* Description:
|
|
* Check if a 1wire device has set the alarm flag in an atomic operation.
|
|
*
|
|
* Input Parameters:
|
|
* master - Pointer to the allocated 1-wire interface
|
|
* config - Described the 1WIRE configuration
|
|
*
|
|
* Return Value:
|
|
* 0 - no alarm flag is set
|
|
* 1 - alarm flag is set
|
|
* < 0 - in case of error
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static int ds18b20_isalarm(FAR struct onewire_master_s *master,
|
|
FAR const struct onewire_config_s *config)
|
|
{
|
|
int ret;
|
|
struct ds18b20_cb_alarm_s alarm;
|
|
alarm.romcode = config->romcode;
|
|
alarm.isalarm = false;
|
|
|
|
ret = onewire_search(master, DS18B20_DEVICE_FAMILY, true, ds18b20_alarm_cb,
|
|
&alarm);
|
|
if (ret > 0)
|
|
{
|
|
/* Check if our device is in the alarm list */
|
|
|
|
if (alarm.isalarm == true)
|
|
{
|
|
ret = 1;
|
|
}
|
|
else
|
|
{
|
|
/* Device found, but not our */
|
|
|
|
ret = 0;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_measure
|
|
*
|
|
* Description: Perform a measurement
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_measure(FAR struct ds18b20_dev_s *dev)
|
|
{
|
|
int ret;
|
|
uint8_t buf = DS18B20_CMD_CONVERTT;
|
|
|
|
ret = onewire_write(dev->master, &dev->config, &buf, 1);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: Unable to perform a temperature measurement\n");
|
|
return ret;
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_write_spad
|
|
*
|
|
* Description: Write scratchpad data to chip
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* th - High alarm temperature
|
|
* lh - Low alarm temperature
|
|
* res - Temperature resolution
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_write_spad(FAR struct ds18b20_dev_s *dev, int8_t th,
|
|
int8_t tl, uint8_t res)
|
|
{
|
|
int ret;
|
|
uint8_t wbuf[DS18B20_WSPAD_SIZE + 1];
|
|
|
|
wbuf[DS18B20_WSPAD_CMD_OFFSET] = ONEWIRE_CMD_WRITE_SCRATCHPAD;
|
|
wbuf[DS18B20_WSPAD_TH_OFFSET + 1] = th;
|
|
wbuf[DS18B20_WSPAD_TL_OFFSET + 1] = tl;
|
|
wbuf[DS18B20_WSPAD_RES_OFFSET + 1] = res;
|
|
|
|
ret = onewire_write(dev->master, &dev->config, wbuf, sizeof(wbuf));
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: Unable to write scratchpad\n");
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_read_spad
|
|
*
|
|
* Description: Read scratchpad data from chip
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* spad - Pointer to store the scratchpad data
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_read_spad(FAR struct ds18b20_dev_s *dev,
|
|
FAR uint8_t *spad)
|
|
{
|
|
int ret;
|
|
uint8_t crc;
|
|
uint8_t wbuf = ONEWIRE_CMD_READ_SCRATCHPAD;
|
|
FAR struct ds18b20_config_s *reg = &dev->reg;
|
|
|
|
ret = onewire_writeread(dev->master, &dev->config, &wbuf, 1, spad,
|
|
DS18B20_SPAD_SIZE);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: Unable to read scratchpad\n");
|
|
return ret;
|
|
}
|
|
|
|
crc = onewire_crc8(spad, DS18B20_SPAD_SIZE - 1);
|
|
if (crc != spad[DS18B20_SPAD_CRC_OFFSET - 1])
|
|
{
|
|
snerr("ERROR: crc mismatch in scratchpad\n");
|
|
return -EIO;
|
|
}
|
|
|
|
/* Update configurable register state each time reading the scratchpad */
|
|
|
|
reg->res = spad[DS18B20_SPAD_RES_OFFSET];
|
|
|
|
if (reg->res < DS18B20_RES_CONV(DS18B20_RESMIN) ||
|
|
reg->res > DS18B20_RES_CONV(reg->res))
|
|
{
|
|
/* Usually this should not happen, but be sure that we did not run into
|
|
* a buffer overflow later.
|
|
*/
|
|
|
|
swarn("WARNING: Sensor responded unknown resolution: %d\n", reg->res);
|
|
reg->res = DS18B20_RES_CONV(DS18B20_RESMAX);
|
|
}
|
|
|
|
reg->alarm.thigh = spad[DS18B20_SPAD_TH_OFFSET];
|
|
reg->alarm.tlow = spad[DS18B20_SPAD_TL_OFFSET];
|
|
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_set_res
|
|
*
|
|
* Description: Set resolution for temperature measurement
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* res - Resolution, can be 9 to 12 bit
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_set_res(FAR struct ds18b20_dev_s *dev, uint8_t res)
|
|
{
|
|
int ret;
|
|
uint8_t spad[DS18B20_SPAD_SIZE];
|
|
|
|
/* Read current scratchpad first */
|
|
|
|
ret = ds18b20_read_spad(dev, spad);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
ret = ds18b20_write_spad(dev, dev->reg.alarm.thigh, dev->reg.alarm.tlow,
|
|
res);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* Read current scratchpad again and verify that res is set */
|
|
|
|
ret = ds18b20_read_spad(dev, spad);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
if (DS18B20_RES_VAL(spad[DS18B20_SPAD_RES_OFFSET]) != DS18B20_RES_VAL(res))
|
|
{
|
|
snerr("ERROR: Expected resolution not matched, received RES: %d\n",
|
|
spad[DS18B20_SPAD_RES_OFFSET]);
|
|
return -EIO;
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_set_alarm
|
|
*
|
|
* Description: Set temperature alarm
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* alarm - Pointer to store the alarm temperature
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_set_alarm(FAR struct ds18b20_dev_s *dev,
|
|
FAR const struct ds18b20_alarm_s *alarm)
|
|
{
|
|
int ret;
|
|
uint8_t spad[DS18B20_SPAD_SIZE];
|
|
|
|
/* Read current scratchpad first, to get current resolution */
|
|
|
|
ret = ds18b20_read_spad(dev, spad);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
ret = ds18b20_write_spad(dev, alarm->thigh, alarm->tlow, dev->reg.res);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
dev->reg.alarm.wakeup = alarm->wakeup;
|
|
#endif
|
|
|
|
/* Read current scratchpad again and verify that alarm is set */
|
|
|
|
ret = ds18b20_read_spad(dev, spad);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
if (spad[DS18B20_SPAD_TH_OFFSET] != alarm->thigh ||
|
|
spad[DS18B20_SPAD_TL_OFFSET] != alarm->tlow)
|
|
{
|
|
snerr("ERROR: Expected alarm trigger does not match, "
|
|
"received TH: %d, TL: %d\n",
|
|
spad[DS18B20_SPAD_TH_OFFSET],
|
|
spad[DS18B20_SPAD_TL_OFFSET]);
|
|
return -EIO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_curtime
|
|
*
|
|
* Description: Helper to get current timestamp.
|
|
*
|
|
* Return:
|
|
* Timestamp in nsec
|
|
****************************************************************************/
|
|
|
|
static unsigned long ds18b20_curtime(void)
|
|
{
|
|
struct timespec ts;
|
|
|
|
clock_systime_timespec(&ts);
|
|
return 1000000ull * ts.tv_sec + ts.tv_nsec / 1000;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_notify
|
|
*
|
|
* Description:
|
|
* Notify upper about data has been changed.
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* data - Read sensor data
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static void ds18b20_notify(FAR struct ds18b20_dev_s *dev,
|
|
FAR struct ds18b20_sensor_data_s *data)
|
|
{
|
|
FAR struct ds18b20_sensor_s *sensor = &dev->sensor;
|
|
struct sensor_temp temp;
|
|
|
|
temp.temperature = ds18b20_temp(data->spad);
|
|
temp.timestamp = data->timestamp;
|
|
sensor->lower.push_event(sensor->lower.priv, &temp,
|
|
sizeof(struct sensor_temp));
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_measure_read
|
|
*
|
|
* Description: Perform a measurement and read last measured temperature
|
|
*
|
|
* Parameter:
|
|
* dev - Internal private lower half driver instance
|
|
* data - Pointer to store sensor data
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_measure_read(FAR struct ds18b20_dev_s *dev,
|
|
FAR struct ds18b20_sensor_data_s *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = ds18b20_measure(dev);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
nxsig_usleep(g_res_timeout[DS18B20_RES_VAL(dev->reg.res)]);
|
|
|
|
ret = ds18b20_read_spad(dev, data->spad);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
data->timestamp = ds18b20_curtime();
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_fetch
|
|
*
|
|
* Description: Performs a measuremnt cylce and data read with data
|
|
* conversion.
|
|
*
|
|
* Parameter:
|
|
* lower - Pointer to lower half sensor driver instance.
|
|
* filep - The pointer of file, represents each user using the sensor.
|
|
* buffer - Pointer to the buffer for reading data.
|
|
* buflen - Size of the buffer.
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_fetch(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
FAR char *buffer, size_t buflen)
|
|
{
|
|
int ret;
|
|
struct ds18b20_sensor_data_s data;
|
|
FAR struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)lower;
|
|
|
|
/* Check if the user is reading the right size */
|
|
|
|
if (buflen != sizeof(struct sensor_temp))
|
|
{
|
|
snerr("ERROR: You need to read %d bytes from this sensor!\n",
|
|
sizeof(struct sensor_temp));
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = ds18b20_measure_read(priv, &data);
|
|
if (!ret)
|
|
{
|
|
FAR struct sensor_temp *temp =
|
|
(FAR struct sensor_temp *)buffer;
|
|
temp->temperature = ds18b20_temp(data.spad);
|
|
temp->timestamp = data.timestamp;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
return buflen;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_control
|
|
*
|
|
* Description: Interface function of struct sensor_ops_s.
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_control(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
int cmd, unsigned long arg)
|
|
{
|
|
int ret;
|
|
struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)lower;
|
|
|
|
switch (cmd)
|
|
{
|
|
/* Read rom code */
|
|
|
|
case SNIOC_READROMCODE:
|
|
{
|
|
FAR uint64_t *ptr = (FAR uint64_t *)((uintptr_t)arg);
|
|
DEBUGASSERT(ptr != NULL);
|
|
*ptr = priv->config.romcode;
|
|
sninfo("read romcode: %16llx\n", *ptr);
|
|
ret = OK;
|
|
}
|
|
break;
|
|
|
|
/* Set new temperature alarm */
|
|
|
|
case SNIOC_SETALARM:
|
|
{
|
|
FAR struct ds18b20_alarm_s *ptr =
|
|
(FAR struct ds18b20_alarm_s *)((uintptr_t)arg);
|
|
DEBUGASSERT(ptr != NULL);
|
|
sninfo("set alarm: [TH/TL] = %d/%d °C\n", ptr->thigh, ptr->tlow);
|
|
ret = ds18b20_set_alarm(priv, ptr);
|
|
}
|
|
break;
|
|
|
|
/* Set sensor resolution */
|
|
|
|
case SNIOC_SETRESOLUTION:
|
|
{
|
|
uint8_t res = arg - 9;
|
|
sninfo("set resolution: %ld\n", arg);
|
|
if (res >= DS18B20_RESMIN && res <= DS18B20_RESMAX)
|
|
{
|
|
ret = ds18b20_set_res(priv, DS18B20_RES_CONV(res));
|
|
}
|
|
else
|
|
{
|
|
ret = -EINVAL;
|
|
}
|
|
}
|
|
break;
|
|
|
|
default:
|
|
snerr("ERROR: Unrecognized cmd: %d\n", cmd);
|
|
ret = -ENOTTY;
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_active
|
|
*
|
|
* Description: Interface function of struct sensor_ops_s.
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
static int ds18b20_active(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
bool enabled)
|
|
{
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
bool start_thread = false;
|
|
struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)lower;
|
|
|
|
if (enabled)
|
|
{
|
|
if (!priv->sensor.enabled)
|
|
{
|
|
start_thread = true;
|
|
}
|
|
}
|
|
|
|
priv->sensor.enabled = enabled;
|
|
|
|
if (start_thread == true)
|
|
{
|
|
/* Wake up the thread */
|
|
|
|
nxsem_post(&priv->run);
|
|
}
|
|
#endif
|
|
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_set_interval
|
|
*
|
|
* Description: Interface function of struct sensor_ops_s.
|
|
*
|
|
* Return:
|
|
* OK - on success
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static int ds18b20_set_interval(FAR struct sensor_lowerhalf_s *lower,
|
|
FAR struct file *filep,
|
|
FAR uint32_t *period_us)
|
|
{
|
|
FAR struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)lower;
|
|
priv->interval = *period_us;
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_thread
|
|
*
|
|
* Description: Thread for performing interval measurement cycle and data
|
|
* read.
|
|
*
|
|
* Parameter:
|
|
* argc - Number of arguments
|
|
* argv - Pointer to argument list
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
static int ds18b20_thread(int argc, char** argv)
|
|
{
|
|
uint16_t orawdata;
|
|
FAR struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)
|
|
((uintptr_t)strtoul(argv[1], NULL, 16));
|
|
|
|
/* Set initial value to out of measurement range to ensure that the first
|
|
* data read leads to an upper notification.
|
|
*/
|
|
|
|
orawdata = 0xffff;
|
|
|
|
while (true)
|
|
{
|
|
int ret;
|
|
struct ds18b20_sensor_data_s data;
|
|
FAR struct ds18b20_sensor_s *sensor = &priv->sensor;
|
|
FAR struct ds18b20_alarm_s *alarm = &priv->reg.alarm;
|
|
|
|
if (!sensor->enabled)
|
|
{
|
|
/* Waiting to be woken up */
|
|
|
|
nxsem_wait(&priv->run);
|
|
}
|
|
|
|
if (alarm->wakeup == true)
|
|
{
|
|
/* Perform a temperature conversion to update the alarm flag */
|
|
|
|
ret = ds18b20_measure(priv);
|
|
if (!ret)
|
|
{
|
|
/* Wait until temperature conversion is done and the alarm flag
|
|
* is up to date.
|
|
*/
|
|
|
|
nxsig_usleep(g_res_timeout[DS18B20_RES_VAL(priv->reg.res)]);
|
|
|
|
/* Check for existing temperature alarm */
|
|
|
|
ret = ds18b20_isalarm(priv->master, &priv->config);
|
|
if (ret == 1)
|
|
{
|
|
ret = ds18b20_measure_read(priv, &data);
|
|
if (!ret && sensor->enabled == true)
|
|
{
|
|
/* Notify upper */
|
|
|
|
ds18b20_notify(priv, &data);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Default nofitication when temperature has been changed */
|
|
|
|
ret = ds18b20_measure_read(priv, &data);
|
|
if (!ret)
|
|
{
|
|
uint16_t rawtemp = ds18b20_rawtemp(data.spad);
|
|
|
|
if (sensor->enabled == true && orawdata != rawtemp)
|
|
{
|
|
ds18b20_notify(priv, &data);
|
|
}
|
|
|
|
/* Store the last sensor data for later comparison */
|
|
|
|
orawdata = ds18b20_rawtemp(data.spad);
|
|
}
|
|
}
|
|
|
|
/* Sleeping thread before fetching the next sensor data */
|
|
|
|
nxsig_usleep(priv->interval);
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: ds18b20_register
|
|
*
|
|
* Description:
|
|
* Register the DS18B20 character device.
|
|
*
|
|
* Input Parameters:
|
|
* devno - The user specifies device number, from 0.
|
|
* onewire - An instance of the 1wire interface to communicate with DS18B20
|
|
* sensor.
|
|
* romcode - The ROM code of the DS18B20.
|
|
*
|
|
* Returned Value:
|
|
* Zero (OK) on success; a negated errno value on failure.
|
|
****************************************************************************/
|
|
|
|
int ds18b20_register(int devno, FAR struct onewire_master_s *onewire,
|
|
uint64_t romcode)
|
|
{
|
|
int ret;
|
|
struct ds18b20_sensor_s *tmp;
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
FAR char *argv[2];
|
|
char arg1[32];
|
|
#endif
|
|
|
|
/* Sanity check */
|
|
|
|
if (!onewire)
|
|
{
|
|
snerr("Invalid 1wire instance\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Initialize the DS18B20 device structure */
|
|
|
|
FAR struct ds18b20_dev_s *priv = (FAR struct ds18b20_dev_s *)
|
|
kmm_malloc(sizeof(struct ds18b20_dev_s));
|
|
|
|
if (priv == NULL)
|
|
{
|
|
snerr("ERROR: Failed to allocate instance\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
priv->master = onewire;
|
|
priv->config.romcode = romcode;
|
|
priv->reg.res = DS18B20_RES_CONV(DS18B20_RESMAX);
|
|
priv->reg.alarm.thigh = DS18B20_TALARM_MAX;
|
|
priv->reg.alarm.tlow = DS18B20_TALARM_MIN;
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
priv->reg.alarm.wakeup = false;
|
|
priv->interval = CONFIG_SENSORS_DS18B20_POLL_INTERVAL;
|
|
|
|
nxsem_init(&priv->run, 0, 0);
|
|
#endif
|
|
|
|
/* Temperature register */
|
|
|
|
tmp = &priv->sensor;
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
tmp->enabled = false;
|
|
#endif
|
|
tmp->lower.ops = &g_ds18b20_ops;
|
|
tmp->lower.type = SENSOR_TYPE_AMBIENT_TEMPERATURE;
|
|
tmp->lower.uncalibrated = false;
|
|
tmp->lower.nbuffer = 1;
|
|
ret = sensor_register(&tmp->lower, devno);
|
|
if (ret < 0)
|
|
{
|
|
goto sensor_err;
|
|
}
|
|
|
|
#ifdef CONFIG_SENSORS_DS18B20_POLL
|
|
|
|
/* Create thread for polling sensor data */
|
|
|
|
snprintf(arg1, 16, "%p", priv);
|
|
argv[0] = arg1;
|
|
argv[1] = NULL;
|
|
ret = kthread_create("ds18b20_thread", SCHED_PRIORITY_DEFAULT,
|
|
CONFIG_SENSORS_DS18B20_THREAD_STACKSIZE,
|
|
ds18b20_thread, argv);
|
|
if (ret > 0)
|
|
#endif
|
|
{
|
|
return OK;
|
|
}
|
|
|
|
sensor_err:
|
|
sensor_unregister(&priv->sensor.lower, devno);
|
|
kmm_free(priv);
|
|
return ret;
|
|
}
|
|
#endif /* CONFIG_1WIRE && CONFIG_SENSORS_DS18B20 */
|