feat: add basic driver for amg88xx sensor
Basic amg88xx sensor handling (open, close, read, ioctl). No interrupts supported. I intend to add support for this feature when I gain more know-how on nuttx/posix.
This commit is contained in:
parent
882c0d0a47
commit
eadc2f5690
10 changed files with 1040 additions and 0 deletions
79
boards/arm/stm32/common/include/stm32_amg88xx.h
Normal file
79
boards/arm/stm32/common/include/stm32_amg88xx.h
Normal file
|
|
@ -0,0 +1,79 @@
|
|||
/****************************************************************************
|
||||
* boards/arm/stm32/common/include/stm32_amg88xx.h
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#ifndef __BOARDS_ARM_STM32_COMMON_INCLUDE_STM32_AMG88XX_H
|
||||
#define __BOARDS_ARM_STM32_COMMON_INCLUDE_STM32_AMG88XX_H
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Types
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Data
|
||||
****************************************************************************/
|
||||
|
||||
#ifdef __cplusplus
|
||||
#define EXTERN extern "C"
|
||||
extern "C"
|
||||
{
|
||||
#else
|
||||
#define EXTERN extern
|
||||
#endif
|
||||
|
||||
/****************************************************************************
|
||||
* Inline Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: board_amg88xx_initialize()
|
||||
*
|
||||
* Description:
|
||||
* Initialize and register the AMG88xx infrared matrix sensor driver.
|
||||
*
|
||||
* Input Parameters:
|
||||
* busno - The I2C bus number
|
||||
*
|
||||
* Returned Value:
|
||||
* Zero (OK) on success; a negated errno value on failure.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int board_amg88xx_initialize(int busno);
|
||||
|
||||
#undef EXTERN
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* __BOARDS_ARM_STM32_COMMON_INCLUDE_STM32_AMG88XX_H */
|
||||
|
|
@ -128,6 +128,10 @@ if(CONFIG_CL_MFRC522)
|
|||
list(APPEND SRCS stm32_mfrc522.c)
|
||||
endif()
|
||||
|
||||
if(CONFIG_SENSORS_AMG88XX)
|
||||
list(APPEND SRCS stm32_amg88xx.c)
|
||||
endif()
|
||||
|
||||
if(CONFIG_LIS3DSH)
|
||||
list(APPEND SRCS stm32_lis3dsh.c)
|
||||
endif()
|
||||
|
|
|
|||
|
|
@ -136,6 +136,10 @@ ifeq ($(CONFIG_CL_MFRC522),y)
|
|||
CSRCS += stm32_mfrc522.c
|
||||
endif
|
||||
|
||||
ifeq ($(CONFIG_SENSORS_AMG88XX),y)
|
||||
CSRCS+= stm32_amg88xx.c
|
||||
endif
|
||||
|
||||
ifeq ($(CONFIG_LIS3DSH),y)
|
||||
CSRCS += stm32_lis3dsh.c
|
||||
endif
|
||||
|
|
|
|||
120
boards/arm/stm32/common/src/stm32_amg88xx.c
Normal file
120
boards/arm/stm32/common/src/stm32_amg88xx.c
Normal file
|
|
@ -0,0 +1,120 @@
|
|||
/****************************************************************************
|
||||
* boards/arm/stm32/common/src/stm32_amg88xx.c
|
||||
*
|
||||
* 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 <errno.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/i2c/i2c_master.h>
|
||||
#include <nuttx/sensors/amg88xx.h>
|
||||
#include <arch/board/board.h>
|
||||
|
||||
#include "stm32.h"
|
||||
#include "stm32_i2c.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/* What is the point of passing devno if only
|
||||
* a single config struct is defined
|
||||
* irm = infrared map / infrared matrix
|
||||
*/
|
||||
|
||||
#define AMG88XX_DEVNO_PATH_0 "/dev/irm0"
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
/* One sensor connected to the board */
|
||||
|
||||
/* During device registration OS allocates an pointer to an amg88xx_config_s
|
||||
* not the actual struct, that implies that for each sensor there is the
|
||||
* need for a config struct at a valid memory location which will be passed
|
||||
* to the pointer mentioned above. So there can be only one sensor,
|
||||
* as there is one global config struct instantiated here.
|
||||
* Is this the intended behaviour to minimize the memory allocated through
|
||||
* malloc?
|
||||
*/
|
||||
|
||||
static struct amg88xx_config_s g_amg88xx_config_0 =
|
||||
{
|
||||
.addr = CONFIG_SENSOR_AMG88XX_ADDR,
|
||||
.speed = I2C_SPEED_STANDARD
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: board_amg88xx_initialize()
|
||||
*
|
||||
* Description:
|
||||
* Initialize and register the AMG88xx infrared matrix sensor driver.
|
||||
*
|
||||
* Input Parameters:
|
||||
* busno - The I2C bus number
|
||||
*
|
||||
* Returned Value:
|
||||
* Zero (OK) on success; a negated errno value on failure.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int board_amg88xx_initialize(int busno)
|
||||
{
|
||||
struct i2c_master_s *i2c;
|
||||
int ret;
|
||||
|
||||
sninfo("Initializing AMG88xx!\n");
|
||||
|
||||
/* Initialize I2C */
|
||||
|
||||
i2c = stm32_i2cbus_initialize(busno);
|
||||
|
||||
if (!i2c)
|
||||
{
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* Then register the sensor */
|
||||
|
||||
ret = amg88xx_register(AMG88XX_DEVNO_PATH_0, i2c, &g_amg88xx_config_0);
|
||||
if (ret < 0)
|
||||
{
|
||||
syslog(LOG_ERR, "ERROR: Error registering AMG88xx\n");
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
|
@ -35,6 +35,50 @@
|
|||
#include "stm32_romfs.h"
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_SENSORS_AMG88XX
|
||||
#include "stm32_amg88xx.h"
|
||||
#endif
|
||||
|
||||
#if defined(CONFIG_I2C) && defined(CONFIG_SYSTEM_I2CTOOL)
|
||||
# include "stm32_i2c.h"
|
||||
#endif
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: stm32_i2c_register
|
||||
*
|
||||
* Description:
|
||||
* Register one I2C drivers for the I2C tool.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#if defined(CONFIG_I2C) && defined(CONFIG_SYSTEM_I2CTOOL)
|
||||
static void stm32_i2c_register(int bus)
|
||||
{
|
||||
struct i2c_master_s *i2c;
|
||||
int ret;
|
||||
|
||||
i2c = stm32_i2cbus_initialize(bus);
|
||||
if (i2c == NULL)
|
||||
{
|
||||
syslog(LOG_ERR, "ERROR: Failed to get I2C%d interface\n", bus);
|
||||
}
|
||||
else
|
||||
{
|
||||
ret = i2c_register(i2c, bus);
|
||||
if (ret < 0)
|
||||
{
|
||||
syslog(LOG_ERR, "ERROR: Failed to register I2C%d driver: %d\n",
|
||||
bus, ret);
|
||||
stm32_i2cbus_uninitialize(i2c);
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
|
@ -167,6 +211,14 @@ int board_app_initialize(uintptr_t arg)
|
|||
}
|
||||
#endif
|
||||
|
||||
#if defined(CONFIG_I2C) && defined(CONFIG_SYSTEM_I2CTOOL)
|
||||
stm32_i2c_register(1);
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_SENSORS_AMG88XX
|
||||
board_amg88xx_initialize(1);
|
||||
#endif
|
||||
|
||||
UNUSED(ret);
|
||||
return OK;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -284,6 +284,10 @@ if(CONFIG_SENSORS)
|
|||
list(APPEND SRCS bmm150_uorb.c)
|
||||
endif()
|
||||
|
||||
if(CONFIG_SENSORS_AMG88XX)
|
||||
list(APPEND SRCS amg88xx.c)
|
||||
endif()
|
||||
|
||||
endif() # CONFIG_I2C
|
||||
|
||||
# These drivers depend on SPI support
|
||||
|
|
|
|||
|
|
@ -1717,4 +1717,36 @@ config SENSORS_LTR308_THREAD_STACKSIZE
|
|||
|
||||
endif # SENSORS_LTR308
|
||||
|
||||
config SENSORS_AMG88XX
|
||||
bool "AMG88xx infrared array sensor"
|
||||
default n
|
||||
select I2C
|
||||
---help---
|
||||
Enable driver support for AMG88xx infrared array sensor.
|
||||
|
||||
if SENSORS_AMG88XX
|
||||
|
||||
choice
|
||||
prompt "AMG88xx AD_SELECT value"
|
||||
default SENSOR_AMG88XX_AD_SELECT_0
|
||||
---help---
|
||||
AD SELECT sets the amg88xx i2c address
|
||||
AD_SELECT tied to GND -> sensor address 0x68
|
||||
AD_SELECT tied to VCC -> sensor address 0x69
|
||||
|
||||
config SENSOR_AMG88XX_AD_SELECT_0
|
||||
bool "AD_SELECT tied to GND"
|
||||
|
||||
config SENSOR_AMG88XX_AD_SELECT_1
|
||||
bool "AD_SELECT tied to VCC"
|
||||
|
||||
endchoice
|
||||
|
||||
config SENSOR_AMG88XX_ADDR
|
||||
hex
|
||||
default 0x68 if SENSOR_AMG88XX_AD_SELECT_0
|
||||
default 0x69 if SENSOR_AMG88XX_AD_SELECT_1
|
||||
|
||||
endif # SENSORS_AMG88XX
|
||||
|
||||
endif # SENSORS
|
||||
|
|
|
|||
618
drivers/sensors/amg88xx.c
Normal file
618
drivers/sensors/amg88xx.c
Normal file
|
|
@ -0,0 +1,618 @@
|
|||
/****************************************************************************
|
||||
* drivers/sensors/amg88xx.c
|
||||
*
|
||||
* 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 <nuttx/mutex.h>
|
||||
#include <nuttx/sensors/amg88xx.h>
|
||||
|
||||
#include <errno.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <debug.h>
|
||||
|
||||
#include <nuttx/kmalloc.h>
|
||||
#include <nuttx/fs/fs.h>
|
||||
#include <nuttx/signal.h>
|
||||
#include <nuttx/i2c/i2c_master.h>
|
||||
#include <nuttx/sensors/ioctl.h>
|
||||
#include <unistd.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/* Register bits definitions */
|
||||
|
||||
/* Power Control Register */
|
||||
|
||||
#define AMG88XX_POWER_CONTROL_REGISTER (0x00)
|
||||
#define AMG88XX_NORMAL_MODE_CMD (0x00)
|
||||
#define AMG88XX_SLEEP_MODE_CMD (0x10)
|
||||
|
||||
/* Reset Register */
|
||||
|
||||
#define AMG88XX_RESET_REGISTER (0x01)
|
||||
#define AMG88XX_FLAG_RESET_CMD (0x30)
|
||||
#define AMG88XX_INITIAL_RESET_CMD (0x30)
|
||||
|
||||
/* Frame Rate Register */
|
||||
|
||||
#define AMG88XX_FRAME_RATE_REGISTER (0x02)
|
||||
#define AMG88XX_FPS_BIT (0x00)
|
||||
#define AMG88XX_1FPS (0x01)
|
||||
#define AMG88XX_10FPS (0x00)
|
||||
|
||||
/* Interrupt Control Register */
|
||||
|
||||
#define AMG88XX_INTERRUPT_CONTROL_REGISTER (0x03)
|
||||
#define AMG88XX_INTMOD_BIT (0x01)
|
||||
#define AMG88XX_INTMOD_ABS_MODE (0x01)
|
||||
#define AMG88XX_INTMOD_DIFF_MODE (0x01)
|
||||
#define AMG88XX_INTEN_BIT (0x01)
|
||||
#define AMG88XX_INTEN_ACTIVE (0x01)
|
||||
#define AMG88XX_INTEN_INATIVE (0x00)
|
||||
|
||||
/* Status Register */
|
||||
|
||||
#define AMG88XX_STATUS_REGISTER (0x04)
|
||||
#define AMG88XX_OVF_IRS (0x02)
|
||||
#define AMG88XX_INTF (0x01)
|
||||
|
||||
/* Status Clear Register */
|
||||
|
||||
#define AMG88XX_STATUS_CLEAR_REGISTER (0x05)
|
||||
#define AMG88XX_OVF_CLR (0x02)
|
||||
#define AMG88XX_INT_CLR (0x01)
|
||||
|
||||
/* Average Register */
|
||||
|
||||
#define AMG88XX_AVERAGE_REGISTER (0x07)
|
||||
#define AMG88XX_MAMOD_BIT (0x05)
|
||||
#define AMG88XX_MAMOD_ENABLE (0x01)
|
||||
#define AMG88XX_MAMOD_DISABLE (0x00)
|
||||
|
||||
/* Setting average mode
|
||||
*
|
||||
* There is an difference between
|
||||
* average register and average mode register
|
||||
* Check the datasheet for clarification
|
||||
*/
|
||||
|
||||
#define AMG88XX_AVERAGE_MODE_REGISTER (0x1F)
|
||||
#define AMG88XX_AVEAGE_MODE_CMD_1 (0x50)
|
||||
#define AMG88XX_AVEAGE_MODE_CMD_2 (0x45)
|
||||
#define AMG88XX_AVEAGE_MODE_CMD_3 (0x57)
|
||||
#define AMG88XX_AVEAGE_MODE_CMD_4 (0x00)
|
||||
|
||||
/* Interrupt Level Register */
|
||||
|
||||
#define AMG88XX_INT_HIGH_L (0x08)
|
||||
#define AMG88XX_INT_HIGH_H (0x09)
|
||||
#define AMG88XX_INT_LOW_L (0x0A)
|
||||
#define AMG88XX_INT_LOW_H (0x0B)
|
||||
#define AMG88XX_INT_HYST_L (0x0C)
|
||||
#define AMG88XX_INT_HYST_H (0x0D)
|
||||
#define AMG88XX_INT_MASK_H (0x0F)
|
||||
|
||||
/* Thermistor Register */
|
||||
|
||||
#define AMG88XX_THERMISTOR_L (0x0E)
|
||||
#define AMG88XX_THERMISTOR_H (0x0F)
|
||||
|
||||
/* Interrupt Table Register */
|
||||
|
||||
#define AMG88XX_INTERRUPT_TABLE_REGISTER (0x10)
|
||||
#define AMG88XX_INTERRUPT_TABLE_LENGTH (0x08)
|
||||
|
||||
/* Temperature Register */
|
||||
|
||||
#define AMG88XX_PIXEL_TABLE_BASE (0x80)
|
||||
#define AMG88XX_PIXEL_TABLE_WIDTH (0x7F)
|
||||
#define AMG88XX_PIXEL_WIDTH (0x02)
|
||||
#define AMG88XX_PIXEL_MASK_H (0x0F)
|
||||
|
||||
/****************************************************************************
|
||||
* Private Types
|
||||
****************************************************************************/
|
||||
|
||||
struct amg88xx_dev_s
|
||||
{
|
||||
FAR struct i2c_master_s *i2c; /* I2C interface */
|
||||
FAR struct amg88xx_config_s *config; /* sensor config structure */
|
||||
mutex_t devlock;
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
static inline int amg88xx_i2c_write_addr(FAR struct amg88xx_dev_s *priv,
|
||||
uint8_t regaddr,
|
||||
uint8_t regval);
|
||||
|
||||
static inline int amg88xx_i2c_read_addr(FAR struct amg88xx_dev_s *priv,
|
||||
uint8_t regaddr,
|
||||
uint8_t *regval);
|
||||
|
||||
/* Character driver methods */
|
||||
|
||||
static int amg88xx_open(FAR struct file *filep);
|
||||
|
||||
static int amg88xx_close(FAR struct file *filep);
|
||||
|
||||
static ssize_t amg88xx_read(FAR struct file *filep,
|
||||
FAR char *buffer,
|
||||
size_t buflen);
|
||||
|
||||
static int amg88xx_ioctl(FAR struct file *filep, int cmd,
|
||||
unsigned long arg);
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
static const struct file_operations g_amg88xx_fops =
|
||||
{
|
||||
amg88xx_open, /* open */
|
||||
amg88xx_close, /* close */
|
||||
amg88xx_read, /* read */
|
||||
NULL, /* write */
|
||||
NULL, /* seek */
|
||||
amg88xx_ioctl /* ioctl */
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_i2c_write_addr
|
||||
*
|
||||
* Description:
|
||||
* Write to an amg88xx register transaction pattern:
|
||||
* Write COMMAND at REGISTER
|
||||
* Sensor Address / W - Register Address - Command
|
||||
****************************************************************************/
|
||||
|
||||
static inline int amg88xx_i2c_write_addr(FAR struct amg88xx_dev_s *priv,
|
||||
uint8_t regaddr,
|
||||
uint8_t regval)
|
||||
{
|
||||
/* Write to an amg88xx register transaction pattern:
|
||||
* Sensor Address - Register Address - Command
|
||||
*/
|
||||
|
||||
int ret;
|
||||
struct i2c_msg_s msg;
|
||||
uint8_t data[2];
|
||||
|
||||
data[0] = regaddr;
|
||||
data[1] = regval;
|
||||
|
||||
msg.addr = priv->config->addr;
|
||||
msg.frequency = priv->config->speed;
|
||||
msg.flags = I2C_M_NOSTOP;
|
||||
msg.buffer = data;
|
||||
msg.length = sizeof(data);
|
||||
|
||||
ret = I2C_TRANSFER(priv->i2c, &msg, 1);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_i2c_read_addr
|
||||
*
|
||||
* Description:
|
||||
* Read to an amg88xx register transaction pattern:
|
||||
* Read COMMAND from REGISTER
|
||||
* Sensor Address / W - Register Address - Sensor Address / R - Command
|
||||
****************************************************************************/
|
||||
|
||||
static inline int amg88xx_i2c_read_addr(FAR struct amg88xx_dev_s *priv,
|
||||
uint8_t regaddr,
|
||||
FAR uint8_t *regval)
|
||||
{
|
||||
int ret;
|
||||
struct i2c_msg_s msg[2];
|
||||
|
||||
msg[0].addr = priv->config->addr;
|
||||
msg[0].frequency = priv->config->speed;
|
||||
msg[0].flags = I2C_M_NOSTOP;
|
||||
msg[0].buffer = ®addr;
|
||||
msg[0].length = sizeof(regaddr);
|
||||
|
||||
msg[1].addr = priv->config->addr;
|
||||
msg[1].frequency = priv->config->speed;
|
||||
msg[1].flags = I2C_M_READ;
|
||||
msg[1].buffer = regval;
|
||||
msg[1].length = sizeof(*regval);
|
||||
|
||||
ret = I2C_TRANSFER(priv->i2c, msg, 2);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_open
|
||||
*
|
||||
* Description:
|
||||
* Character device open call.
|
||||
* Opening the device will not ensure that data can be read immediately.
|
||||
* Some time need to pass before data is available in the data registers.
|
||||
* By default the device start with 10 FPS, but still, without not delay
|
||||
* between open and read the data will be full 0x00.
|
||||
*
|
||||
* Input Parameters:
|
||||
* filep - Pointer to struct file
|
||||
*
|
||||
* Returned Value:
|
||||
* OK - Sensor device was opened successfully.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static int amg88xx_open(FAR struct file *filep)
|
||||
{
|
||||
FAR struct inode *inode = filep->f_inode;
|
||||
FAR struct amg88xx_dev_s *priv = inode->i_private;
|
||||
uint8_t sleep;
|
||||
int ret;
|
||||
|
||||
ret = nxmutex_lock(&priv->devlock);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
amg88xx_i2c_read_addr(priv,
|
||||
(uint8_t)AMG88XX_POWER_CONTROL_REGISTER,
|
||||
(uint8_t *)&sleep);
|
||||
|
||||
/* Set the sensor to normal operation mode */
|
||||
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_POWER_CONTROL_REGISTER,
|
||||
(uint8_t)AMG88XX_NORMAL_MODE_CMD);
|
||||
if (ret < 0)
|
||||
{
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (sleep == AMG88XX_SLEEP_MODE_CMD)
|
||||
{
|
||||
/* Hardcoded value specified in the datasheet */
|
||||
|
||||
usleep(50000);
|
||||
|
||||
/* If sensor was in sleep mode, we write initial reset register
|
||||
* same things as flag reset and read nonvolatile memory
|
||||
* which store adjustment value of sensor.
|
||||
*/
|
||||
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_RESET_REGISTER,
|
||||
(uint8_t)AMG88XX_INITIAL_RESET_CMD);
|
||||
if (ret < 0)
|
||||
{
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Hardcoded value specified in the datasheet */
|
||||
|
||||
usleep(2000);
|
||||
}
|
||||
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_RESET_REGISTER,
|
||||
(uint8_t)AMG88XX_FLAG_RESET_CMD);
|
||||
|
||||
if (ret < 0)
|
||||
{
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_close
|
||||
*
|
||||
* Description:
|
||||
* Character device close call.
|
||||
*
|
||||
* Input Parameters:
|
||||
* filep - Pointer to struct file
|
||||
*
|
||||
* Returned Value:
|
||||
* OK - Sensor device was closed successfully.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static int amg88xx_close(FAR struct file *filep)
|
||||
{
|
||||
FAR struct inode *inode = filep->f_inode;
|
||||
FAR struct amg88xx_dev_s *priv = inode->i_private;
|
||||
int ret;
|
||||
|
||||
DEBUGASSERT(priv != NULL);
|
||||
|
||||
ret = nxmutex_lock(&priv->devlock);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Set the sensor to sleep operation mode */
|
||||
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_POWER_CONTROL_REGISTER,
|
||||
(uint8_t)AMG88XX_SLEEP_MODE_CMD);
|
||||
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_read
|
||||
*
|
||||
* Description:
|
||||
* Character device read call. Blocks until requested buffer size is full.
|
||||
*
|
||||
* Input Parameters:
|
||||
* filep - Pointer to struct file
|
||||
* buffer - Pointer to user buffer
|
||||
* buflen - Size of user buffer in bytes
|
||||
*
|
||||
* Returned Value:
|
||||
* Returns the number of bytes written to the buffer.
|
||||
* -EINVAL - Supplied buffer length invalid
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
static ssize_t amg88xx_read(FAR struct file *filep,
|
||||
FAR char *buffer,
|
||||
size_t buflen)
|
||||
{
|
||||
FAR struct inode *inode = filep->f_inode;
|
||||
FAR struct amg88xx_dev_s *priv = inode->i_private;
|
||||
uint8_t regval = AMG88XX_PIXEL_TABLE_BASE;
|
||||
int ret;
|
||||
|
||||
DEBUGASSERT(priv != NULL);
|
||||
|
||||
if (buffer == NULL)
|
||||
{
|
||||
snerr("ERROR: buffer should not be NULL.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (buflen != AMG88XX_PIXELS_ARRAY_LENGTH)
|
||||
{
|
||||
snerr("ERROR: buflen is not sufficient to store sensor data.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
struct i2c_msg_s msg[2];
|
||||
|
||||
msg[0].addr = priv->config->addr;
|
||||
msg[0].frequency = priv->config->speed;
|
||||
msg[0].flags = I2C_M_NOSTOP;
|
||||
msg[0].buffer = ®val;
|
||||
msg[0].length = 1;
|
||||
|
||||
msg[1].addr = priv->config->addr;
|
||||
msg[1].frequency = priv->config->speed;
|
||||
msg[1].flags = I2C_M_READ;
|
||||
msg[1].buffer = (uint8_t *)buffer;
|
||||
msg[1].length = buflen;
|
||||
|
||||
ret = I2C_TRANSFER(priv->i2c, msg, 2);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int amg88xx_ioctl(FAR struct file *filep, int cmd,
|
||||
unsigned long arg)
|
||||
{
|
||||
FAR struct inode *inode = filep->f_inode;
|
||||
FAR struct amg88xx_dev_s *priv = inode->i_private;
|
||||
int ret = -EINVAL;
|
||||
uint8_t regval = 0;
|
||||
|
||||
ret = nxmutex_lock(&priv->devlock);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch (cmd)
|
||||
{
|
||||
case SNIOC_SET_OPERATIONAL_MODE:
|
||||
switch (*(amg88xx_operation_mode_e *)arg)
|
||||
{
|
||||
case op_mode_normal:
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_POWER_CONTROL_REGISTER,
|
||||
(uint8_t)AMG88XX_NORMAL_MODE_CMD);
|
||||
break;
|
||||
case op_mode_sleep:
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_POWER_CONTROL_REGISTER,
|
||||
(uint8_t)AMG88XX_SLEEP_MODE_CMD);
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
case SNIOC_SET_FRAMERATE:
|
||||
switch (*(amg88xx_fps_e *)arg)
|
||||
{
|
||||
case fps_one:
|
||||
regval = (AMG88XX_1FPS << AMG88XX_FPS_BIT);
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_FRAME_RATE_REGISTER,
|
||||
regval);
|
||||
break;
|
||||
case fps_ten:
|
||||
regval = (AMG88XX_10FPS << AMG88XX_FPS_BIT);
|
||||
ret = amg88xx_i2c_write_addr(priv,
|
||||
(uint8_t)AMG88XX_FRAME_RATE_REGISTER,
|
||||
regval);
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
/* Enabling and disabling the moving average requires following
|
||||
* a precedure described in the i2c communication interface manual
|
||||
*/
|
||||
|
||||
case SNIOC_SET_MOVING_AVG:
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_AVERAGE_MODE_REGISTER,
|
||||
(uint8_t)AMG88XX_AVEAGE_MODE_CMD_1);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_AVERAGE_MODE_REGISTER,
|
||||
(uint8_t)AMG88XX_AVEAGE_MODE_CMD_2);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_AVERAGE_MODE_REGISTER,
|
||||
(uint8_t)AMG88XX_AVEAGE_MODE_CMD_3);
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
regval = (bool)arg ?
|
||||
(AMG88XX_MAMOD_ENABLE << AMG88XX_MAMOD_BIT) :
|
||||
(AMG88XX_MAMOD_DISABLE << AMG88XX_MAMOD_BIT) ;
|
||||
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_AVERAGE_REGISTER,
|
||||
regval);
|
||||
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = amg88xx_i2c_write_addr(
|
||||
priv,
|
||||
(uint8_t)AMG88XX_AVERAGE_MODE_REGISTER,
|
||||
(uint8_t)AMG88XX_AVEAGE_MODE_CMD_4);
|
||||
break;
|
||||
|
||||
default:
|
||||
ret = -ENOTTY;
|
||||
break;
|
||||
}
|
||||
|
||||
nxmutex_unlock(&priv->devlock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_register
|
||||
*
|
||||
* Description:
|
||||
* Register the amg88xx character device as 'devpath'
|
||||
*
|
||||
* Input Parameters:
|
||||
* devpath - The full path to the driver to register. E.g., "/dev/irm0"
|
||||
* i2c - An instance of the I2C interface to use to communicate with
|
||||
* AMG88xx
|
||||
* config - Initial configuration of the sensor
|
||||
*
|
||||
* Returned Value:
|
||||
* Zero (OK) on success; a negated errno value on failure.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int amg88xx_register(FAR const char *devpath,
|
||||
FAR struct i2c_master_s *i2c,
|
||||
FAR struct amg88xx_config_s *config)
|
||||
{
|
||||
FAR struct amg88xx_dev_s *priv;
|
||||
int ret;
|
||||
|
||||
/* Sanity check */
|
||||
|
||||
DEBUGASSERT(i2c != NULL);
|
||||
DEBUGASSERT(config != NULL);
|
||||
|
||||
/* Initialize the AMG88xx device structure */
|
||||
|
||||
priv = (FAR struct amg88xx_dev_s *)
|
||||
kmm_malloc(sizeof(struct amg88xx_dev_s));
|
||||
|
||||
if (!priv)
|
||||
{
|
||||
snerr("Failed to allocate instance\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
priv->i2c = i2c;
|
||||
priv->config = config;
|
||||
nxmutex_init(&priv->devlock);
|
||||
|
||||
/* Register the character driver */
|
||||
|
||||
ret = register_driver(devpath, &g_amg88xx_fops, 0666, priv);
|
||||
|
||||
if (ret < 0)
|
||||
{
|
||||
nxmutex_destroy(&priv->devlock);
|
||||
kmm_free(priv);
|
||||
snerr("ERROR: Failed to register driver: %d\n", ret);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
105
include/nuttx/sensors/amg88xx.h
Normal file
105
include/nuttx/sensors/amg88xx.h
Normal file
|
|
@ -0,0 +1,105 @@
|
|||
/****************************************************************************
|
||||
* include/nuttx/sensors/amg88xx.h
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#ifndef __INCLUDE_NUTTX_SENSORS_AMG88XX_H
|
||||
#define __INCLUDE_NUTTX_SENSORS_AMG88XX_H
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
#include <nuttx/i2c/i2c_master.h>
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
#define AMG88XX_PIXELS (64) /* hex 0x40 */
|
||||
#define AMG88XX_PIXELS_ARRAY_LENGTH (127)
|
||||
|
||||
#define AMG88XX_THERMISTOR_RESOLUTION (0.0625)
|
||||
#define AMG88XX_THERMISTOR_MAX_VALUE (0x7FF) /* +127.9375 *c */
|
||||
#define AMG88XX_THERMISTOR_MIN_VALUE (0xBBB) /* -59.6875 *c */
|
||||
|
||||
#define AMG88XX_PIXEL_RESOLUTION (0.25)
|
||||
#define AMG88XX_PIXEL_MAX_VALUE (0x1F4) /* +125 *c */
|
||||
#define AMG88XX_PIXEL_MIN_VALUE (0xF24) /* -55 *c */
|
||||
|
||||
/****************************************************************************
|
||||
* Public Types
|
||||
****************************************************************************/
|
||||
|
||||
/* Data returned by sensor read typedef */
|
||||
|
||||
typedef uint8_t amg88xx_pixels_temp_t[AMG88XX_PIXELS_ARRAY_LENGTH];
|
||||
|
||||
/* Typedef used to interact with ioctl syscall to set sensor operation mode */
|
||||
|
||||
typedef enum
|
||||
{
|
||||
op_mode_normal = 0,
|
||||
op_mode_sleep = 1
|
||||
} amg88xx_operation_mode_e;
|
||||
|
||||
/* Typedef used to interact with ioctl syscall to set sensor fps */
|
||||
|
||||
typedef enum
|
||||
{
|
||||
fps_one = 0,
|
||||
fps_ten = 1
|
||||
} amg88xx_fps_e;
|
||||
|
||||
/* Runtime configuration struct sent to the sensor driver */
|
||||
|
||||
struct amg88xx_config_s
|
||||
{
|
||||
uint8_t addr;
|
||||
uint32_t speed;
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Public Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: amg88xx_register
|
||||
*
|
||||
* Description:
|
||||
* Register the amg88xx character device as 'devpath'
|
||||
*
|
||||
* Input Parameters:
|
||||
* devpath - The full path to the driver to register. E.g., "/dev/irm0"
|
||||
* i2c - An instance of the I2C interface to use to communicate with
|
||||
* AMG88xx
|
||||
* config - Initial configuration of the sensor
|
||||
*
|
||||
* Returned Value:
|
||||
* Zero (OK) on success; a negated errno value on failure.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int amg88xx_register(FAR const char *devpath,
|
||||
FAR struct i2c_master_s *i2c,
|
||||
FAR struct amg88xx_config_s *config);
|
||||
|
||||
#endif /* __INCLUDE_NUTTX_SENSORS_AMG88XX_H */
|
||||
|
|
@ -240,6 +240,28 @@
|
|||
#define SNIOC_FEAT_MANAGE _SNIOC(0x006b) /* Feature manage command */
|
||||
#define SNIOC_SET_SCALE_XL _SNIOC(0x006c) /* Set accelerator scale command */
|
||||
|
||||
/* IOCTL commands unique to AMG88xx */
|
||||
|
||||
/* Command: SNIOC_SET_OPERATIONAL_MODE
|
||||
* Description: Control power mode: Normal / Sleep
|
||||
* Reuse from ISL29023
|
||||
* Arg: amg88xx_operation_mode_e pointer
|
||||
*/
|
||||
|
||||
/* Command: SNIOC_SET_FRAMERATE
|
||||
* Description: Set the framerate of the sensor
|
||||
* Arg: amg88xx_fps_e
|
||||
*/
|
||||
|
||||
#define SNIOC_SET_FRAMERATE _SNIOC(0x006d)
|
||||
|
||||
/* Command: SNIOC_SET_MOVING_AVG
|
||||
* Description: Toggle moving average mode
|
||||
* Arg: bool
|
||||
*/
|
||||
|
||||
#define SNIOC_SET_MOVING_AVG _SNIOC(0x006e)
|
||||
|
||||
/* Command: SNIOC_GET_STATE
|
||||
* Description: Get state for all subscribers, include min_interval,
|
||||
* min_latency and the number of subscribers.
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue