2017-05-31 14:31:53 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* drivers/input/cypress_mbr3108.c
|
|
|
|
*
|
2021-11-15 08:04:55 +01:00
|
|
|
* 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
|
2017-05-31 14:31:53 +02:00
|
|
|
*
|
2021-11-15 08:04:55 +01:00
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
2017-05-31 14:31:53 +02:00
|
|
|
*
|
2021-11-15 08:04:55 +01:00
|
|
|
* 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.
|
2017-05-31 14:31:53 +02:00
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Included Files
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <sys/types.h>
|
|
|
|
#include <stdbool.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <poll.h>
|
2021-05-18 08:59:14 +02:00
|
|
|
#include <assert.h>
|
2017-05-31 14:31:53 +02:00
|
|
|
#include <errno.h>
|
|
|
|
#include <debug.h>
|
|
|
|
|
|
|
|
#include <nuttx/arch.h>
|
|
|
|
#include <nuttx/kmalloc.h>
|
2017-10-06 18:15:01 +02:00
|
|
|
#include <nuttx/signal.h>
|
|
|
|
#include <nuttx/i2c/i2c_master.h>
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
#include <nuttx/input/cypress_mbr3108.h>
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Pre-Processor Definitions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#ifdef CONFIG_INPUT_CYPRESS_MBR3108_DEBUG
|
|
|
|
# define mbr3108_dbg(x, ...) _info(x, ##__VA_ARGS__)
|
|
|
|
#else
|
|
|
|
# define mbr3108_dbg(x, ...) iinfo(x, ##__VA_ARGS__)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Register macros */
|
|
|
|
|
|
|
|
#define MBR3108_SENSOR_EN 0x0
|
|
|
|
#define MBR3108_FSS_EN 0x02
|
|
|
|
#define MBR3108_TOGGLE_EN 0x04
|
|
|
|
#define MBR3108_LED_ON_EN 0x06
|
|
|
|
#define MBR3108_SENSITIVITY0 0x08
|
|
|
|
#define MBR3108_SENSITIVITY1 0x09
|
|
|
|
#define MBR3108_BASE_THRESHOLD0 0x0c
|
|
|
|
#define MBR3108_BASE_THRESHOLD1 0x0d
|
|
|
|
#define MBR3108_FINGER_THRESHOLD2 0x0e
|
|
|
|
#define MBR3108_FINGER_THRESHOLD3 0x0f
|
|
|
|
#define MBR3108_FINGER_THRESHOLD4 0x10
|
|
|
|
#define MBR3108_FINGER_THRESHOLD5 0x11
|
|
|
|
#define MBR3108_FINGER_THRESHOLD6 0x12
|
|
|
|
#define MBR3108_FINGER_THRESHOLD7 0x13
|
|
|
|
#define MBR3108_SENSOR_DEBOUNCE 0x1c
|
|
|
|
#define MBR3108_BUTTON_HYS 0x1d
|
|
|
|
#define MBR3108_BUTTON_LBR 0x1f
|
|
|
|
#define MBR3108_BUTTON_NNT 0x20
|
|
|
|
#define MBR3108_BUTTON_NT 0x21
|
|
|
|
#define MBR3108_PROX_EN 0x26
|
|
|
|
#define MBR3108_PROX_CFG 0x27
|
|
|
|
#define MBR3108_PROX_CFG2 0x28
|
|
|
|
#define MBR3108_PROX_TOUCH_TH0 0x2a
|
|
|
|
#define MBR3108_PROX_TOUCH_TH1 0x2c
|
|
|
|
#define MBR3108_PROX_RESOLUTION0 0x2e
|
|
|
|
#define MBR3108_PROX_RESOLUTION1 0x2f
|
|
|
|
#define MBR3108_PROX_HYS 0x30
|
|
|
|
#define MBR3108_PROX_LBR 0x32
|
|
|
|
#define MBR3108_PROX_NNT 0x33
|
|
|
|
#define MBR3108_PROX_NT 0x34
|
|
|
|
#define MBR3108_PROX_POSITIVE_TH0 0x35
|
|
|
|
#define MBR3108_PROX_POSITIVE_TH1 0x36
|
|
|
|
#define MBR3108_PROX_NEGATIVE_TH0 0x39
|
|
|
|
#define MBR3108_PROX_NEGATIVE_TH1 0x3a
|
|
|
|
#define MBR3108_LED_ON_TIME 0x3d
|
|
|
|
#define MBR3108_BUZZER_CFG 0x3e
|
|
|
|
#define MBR3108_BUZZER_ON_TIME 0x3f
|
|
|
|
#define MBR3108_GPO_CFG 0x40
|
|
|
|
#define MBR3108_PWM_DUTYCYCLE_CFG0 0x41
|
|
|
|
#define MBR3108_PWM_DUTYCYCLE_CFG1 0x42
|
|
|
|
#define MBR3108_PWM_DUTYCYCLE_CFG2 0x43
|
|
|
|
#define MBR3108_PWM_DUTYCYCLE_CFG3 0x44
|
|
|
|
#define MBR3108_SPO_CFG 0x4c
|
|
|
|
#define MBR3108_DEVICE_CFG0 0x4d
|
|
|
|
#define MBR3108_DEVICE_CFG1 0x4e
|
|
|
|
#define MBR3108_DEVICE_CFG2 0x4f
|
|
|
|
#define MBR3108_DEVICE_CFG3 0x50
|
|
|
|
#define MBR3108_I2C_ADDR 0x51
|
|
|
|
#define MBR3108_REFRESH_CTRL 0x52
|
|
|
|
#define MBR3108_STATE_TIMEOUT 0x55
|
|
|
|
#define MBR3108_CONFIG_CRC 0x7e
|
|
|
|
#define MBR3108_GPO_OUTPUT_STATE 0x80
|
|
|
|
#define MBR3108_SENSOR_ID 0x82
|
|
|
|
#define MBR3108_CTRL_CMD 0x86
|
|
|
|
#define MBR3108_CTRL_CMD_STATUS 0x88
|
|
|
|
#define MBR3108_CTRL_CMD_ERR 0x89
|
|
|
|
#define MBR3108_SYSTEM_STATUS 0x8a
|
|
|
|
#define MBR3108_PREV_CTRL_CMD_CODE 0x8c
|
|
|
|
#define MBR3108_FAMILY_ID 0x8f
|
|
|
|
#define MBR3108_DEVICE_ID 0x90
|
|
|
|
#define MBR3108_DEVICE_REV 0x92
|
|
|
|
#define MBR3108_CALC_CRC 0x94
|
|
|
|
#define MBR3108_TOTAL_WORKING_SNS 0x97
|
|
|
|
#define MBR3108_SNS_CP_HIGH 0x98
|
|
|
|
#define MBR3108_SNS_VDD_SHORT 0x9a
|
|
|
|
#define MBR3108_SNS_GND_SHORT 0x9c
|
|
|
|
#define MBR3108_SNS_SNS_SHORT 0x9e
|
|
|
|
#define MBR3108_CMOD_SHIELD_TEST 0xa0
|
|
|
|
#define MBR3108_BUTTON_STAT 0xaa
|
|
|
|
#define MBR3108_LATCHED_BUTTON_STAT 0xac
|
|
|
|
#define MBR3108_PROX_STAT 0xae
|
|
|
|
#define MBR3108_LATCHED_PROX_STAT 0xaf
|
|
|
|
#define MBR3108_SYNC_COUNTER0 0xb9
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR0 0xba
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR1 0xbc
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR2 0xbe
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR3 0xc0
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR4 0xc2
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR5 0xc4
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR6 0xc6
|
|
|
|
#define MBR3108_DIFFERENCE_COUNT_SENSOR7 0xc8
|
|
|
|
#define MBR3108_GPO_DATA 0xda
|
|
|
|
#define MBR3108_SYNC_COUNTER1 0xdb
|
|
|
|
#define MBR3108_DEBUG_SENSOR_ID 0xdc
|
|
|
|
#define MBR3108_DEBUG_CP 0xdd
|
|
|
|
#define MBR3108_DEBUG_DIFFERENCE_COUNT0 0xde
|
|
|
|
#define MBR3108_DEBUG_BASELINE0 0xe0
|
|
|
|
#define MBR3108_DEBUG_RAW_COUNT0 0xe2
|
|
|
|
#define MBR3108_DEBUG_AVG_RAW_COUNT0 0xe4
|
|
|
|
#define MBR3108_SYNC_COUNTER2 0xe7
|
|
|
|
|
|
|
|
/* Device commands for MBR3108_CTRL_CMD */
|
|
|
|
|
|
|
|
#define MBR3108_CMD_COMPLETED 0
|
|
|
|
#define MBR3108_CMD_CHECK_CONFIG_CRC 2
|
|
|
|
#define MBR3108_CMD_SET_CONFIG_CRC 3
|
|
|
|
#define MBR3108_CMD_ENTER_LOW_POWER_MODE 7
|
|
|
|
#define MBR3108_CMD_CLEAR_LATCHED 8
|
|
|
|
#define MBR3108_CMD_RESET_ADV_LOWPASS_FILTER_PROX_SENS_0 9
|
|
|
|
#define MBR3108_CMD_RESET_ADV_LOWPASS_FILTER_PROX_SENS_1 10
|
|
|
|
#define MBR3108_CMD_SOFTWARE_RESET 255
|
|
|
|
|
|
|
|
#define MBR3108_CMD_STATUS_SUCCESS 0
|
|
|
|
#define MBR3108_CMD_STATUS_ERROR 1
|
|
|
|
#define MBR3108_CMD_STATUS_MASK 1
|
|
|
|
|
|
|
|
/* Completion times for device commands */
|
|
|
|
|
|
|
|
#define MBR3108_CMD_MSECS_CHECK_CONFIG_CRC 280 /* >220 (typ.) */
|
|
|
|
#define MBR3108_CMD_MSECS_SOFTWARE_RESET 50
|
|
|
|
#define MBR3108_CMD_MSECS_CLEAR_LATCHED 50
|
|
|
|
|
|
|
|
/* Other macros */
|
|
|
|
|
|
|
|
#define MBR3108_I2C_RETRIES 10
|
|
|
|
#define MBR3108_NUM_SENSORS 8
|
|
|
|
#define MBR3108_EXPECTED_FAMILY_ID 0x9a
|
|
|
|
#define MBR3108_EXPECTED_DEVICE_ID 0x0a03
|
|
|
|
#define MBR3108_EXPECTED_DEVICE_REV 1
|
|
|
|
#define MBR3108_SYNC_RETRIES 10
|
|
|
|
|
|
|
|
#ifndef CONFIG_MBR3108_I2C_FREQUENCY
|
|
|
|
# define CONFIG_MBR3108_I2C_FREQUENCY 400000
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Types
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
struct mbr3108_dev_s
|
|
|
|
{
|
|
|
|
/* I2C bus and address for device. */
|
|
|
|
|
|
|
|
struct i2c_master_s *i2c;
|
|
|
|
uint8_t addr;
|
|
|
|
|
|
|
|
/* Configuration for device. */
|
|
|
|
|
|
|
|
struct mbr3108_board_s *board;
|
|
|
|
const struct mbr3108_sensor_conf_s *sensor_conf;
|
2022-09-06 08:18:45 +02:00
|
|
|
mutex_t devlock;
|
2017-05-31 14:31:53 +02:00
|
|
|
uint8_t cref;
|
|
|
|
struct mbr3108_debug_conf_s debug_conf;
|
|
|
|
bool int_pending;
|
|
|
|
|
|
|
|
struct pollfd *fds[CONFIG_INPUT_CYPRESS_MBR3108_NPOLLWAITERS];
|
|
|
|
};
|
|
|
|
|
|
|
|
/****************************************************************************
|
2020-03-31 00:32:20 +02:00
|
|
|
* Private Function Prototypes
|
|
|
|
****************************************************************************/
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
static int mbr3108_open(FAR struct file *filep);
|
|
|
|
static int mbr3108_close(FAR struct file *filep);
|
|
|
|
static ssize_t mbr3108_read(FAR struct file *filep, FAR char *buffer,
|
|
|
|
size_t buflen);
|
|
|
|
static ssize_t mbr3108_write(FAR struct file *filep, FAR const char *buffer,
|
|
|
|
size_t buflen);
|
|
|
|
static int mbr3108_poll(FAR struct file *filep, FAR struct pollfd *fds,
|
|
|
|
bool setup);
|
|
|
|
|
|
|
|
/****************************************************************************
|
2020-03-31 00:32:20 +02:00
|
|
|
* Private Data
|
|
|
|
****************************************************************************/
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
static const struct file_operations g_mbr3108_fileops =
|
|
|
|
{
|
|
|
|
mbr3108_open, /* open */
|
|
|
|
mbr3108_close, /* close */
|
|
|
|
mbr3108_read, /* read */
|
|
|
|
mbr3108_write, /* write */
|
2019-05-22 02:57:54 +02:00
|
|
|
NULL, /* seek */
|
|
|
|
NULL, /* ioctl */
|
2023-01-02 14:02:51 +01:00
|
|
|
NULL, /* mmap */
|
2023-01-02 18:06:12 +01:00
|
|
|
NULL, /* truncate */
|
2019-05-22 02:57:54 +02:00
|
|
|
mbr3108_poll /* poll */
|
2017-05-31 14:31:53 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
/****************************************************************************
|
2020-03-31 00:32:20 +02:00
|
|
|
* Private Functions
|
|
|
|
****************************************************************************/
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
static int mbr3108_i2c_write(FAR struct mbr3108_dev_s *dev, uint8_t reg,
|
|
|
|
const uint8_t *buf, size_t buflen)
|
|
|
|
{
|
|
|
|
struct i2c_msg_s msgv[2] =
|
|
|
|
{
|
|
|
|
{
|
2022-03-26 21:51:22 +01:00
|
|
|
CONFIG_MBR3108_I2C_FREQUENCY,
|
|
|
|
dev->addr, 0, ®, sizeof(reg)
|
2017-05-31 14:31:53 +02:00
|
|
|
},
|
|
|
|
{
|
2022-03-26 21:51:22 +01:00
|
|
|
CONFIG_MBR3108_I2C_FREQUENCY,
|
|
|
|
dev->addr, I2C_M_NOSTART, buf, buflen
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
};
|
2020-03-31 00:32:20 +02:00
|
|
|
|
2017-05-31 14:31:53 +02:00
|
|
|
int ret = -EIO;
|
|
|
|
int retries;
|
|
|
|
|
|
|
|
/* MBR3108 will respond with NACK to address when in low-power mode. Host
|
2020-03-31 00:32:20 +02:00
|
|
|
* needs to retry address selection multiple times to get MBR3108 to
|
|
|
|
* wake-up.
|
2017-05-31 14:31:53 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
for (retries = 0; retries < MBR3108_I2C_RETRIES; retries++)
|
|
|
|
{
|
|
|
|
ret = I2C_TRANSFER(dev->i2c, msgv, 2);
|
|
|
|
if (ret == -ENXIO)
|
|
|
|
{
|
|
|
|
/* -ENXIO is returned when getting NACK from response.
|
|
|
|
* Keep trying.
|
|
|
|
*/
|
|
|
|
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret >= 0)
|
|
|
|
{
|
|
|
|
/* Success! */
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Failed to read sensor. */
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_i2c_read(FAR struct mbr3108_dev_s *dev, uint8_t reg,
|
|
|
|
uint8_t *buf, size_t buflen)
|
|
|
|
{
|
|
|
|
struct i2c_msg_s msgv[2] =
|
|
|
|
{
|
|
|
|
{
|
2022-03-26 21:51:22 +01:00
|
|
|
CONFIG_MBR3108_I2C_FREQUENCY,
|
|
|
|
dev->addr, 0, ®, sizeof(reg)
|
2017-05-31 14:31:53 +02:00
|
|
|
},
|
|
|
|
{
|
2022-03-26 21:51:22 +01:00
|
|
|
CONFIG_MBR3108_I2C_FREQUENCY,
|
|
|
|
dev->addr, I2C_M_READ, buf, buflen
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
};
|
2020-03-31 00:32:20 +02:00
|
|
|
|
2017-05-31 14:31:53 +02:00
|
|
|
int ret = -EIO;
|
|
|
|
int retries;
|
|
|
|
|
|
|
|
/* MBR3108 will respond with NACK to address when in low-power mode. Host
|
2020-03-31 00:32:20 +02:00
|
|
|
* needs to retry address selection multiple times to get MBR3108 to
|
|
|
|
* wake-up.
|
2017-05-31 14:31:53 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
for (retries = 0; retries < MBR3108_I2C_RETRIES; retries++)
|
|
|
|
{
|
|
|
|
ret = I2C_TRANSFER(dev->i2c, msgv, 2);
|
|
|
|
if (ret == -ENXIO)
|
|
|
|
{
|
|
|
|
/* -ENXIO is returned when getting NACK from response.
|
|
|
|
* Keep trying.
|
|
|
|
*/
|
|
|
|
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
else if (ret >= 0)
|
|
|
|
{
|
|
|
|
/* Success! */
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Some other error. Try to reset I2C bus and keep trying. */
|
|
|
|
|
|
|
|
#ifdef CONFIG_I2C_RESET
|
|
|
|
if (retries == MBR3108_I2C_RETRIES - 1)
|
|
|
|
{
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = I2C_RESET(dev->i2c);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("I2C_RESET failed: %d\n", ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Failed to read sensor. */
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_check_cmd_status(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
const uint8_t start_reg = MBR3108_CTRL_CMD;
|
|
|
|
const uint8_t last_reg = MBR3108_CTRL_CMD_ERR;
|
|
|
|
uint8_t readbuf[MBR3108_CTRL_CMD_ERR - MBR3108_CTRL_CMD + 1];
|
2020-03-31 00:32:20 +02:00
|
|
|
uint8_t cmd;
|
|
|
|
uint8_t cmd_status;
|
|
|
|
uint8_t cmd_err;
|
2017-05-31 14:31:53 +02:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
DEBUGASSERT(last_reg - start_reg + 1 == sizeof(readbuf));
|
|
|
|
|
|
|
|
/* Multi-byte read to get command status. */
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_read(dev, start_reg, readbuf, sizeof(readbuf));
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("cmd status get failed. ret=%d\n", ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
cmd = readbuf[MBR3108_CTRL_CMD - MBR3108_CTRL_CMD];
|
|
|
|
cmd_status = readbuf[MBR3108_CTRL_CMD_STATUS - MBR3108_CTRL_CMD];
|
|
|
|
cmd_err = readbuf[MBR3108_CTRL_CMD_ERR - MBR3108_CTRL_CMD];
|
|
|
|
|
|
|
|
mbr3108_dbg("cmd: %d, status: %d, err: %d\n", cmd, cmd_status, cmd_err);
|
|
|
|
|
|
|
|
if (cmd != MBR3108_CMD_COMPLETED)
|
|
|
|
{
|
|
|
|
return -EBUSY;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((cmd_status & MBR3108_CMD_STATUS_MASK) == MBR3108_CMD_STATUS_SUCCESS)
|
|
|
|
{
|
|
|
|
/* Success. */
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return cmd_err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_save_check_crc(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
uint8_t reg = MBR3108_CTRL_CMD;
|
|
|
|
uint8_t cmd = MBR3108_CMD_CHECK_CONFIG_CRC;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, reg, &cmd, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108_CTRL_CMD:CHECK_CONFIG_CRC write failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2017-10-06 18:15:01 +02:00
|
|
|
nxsig_usleep(MBR3108_CMD_MSECS_CHECK_CONFIG_CRC * 1000);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = mbr3108_check_cmd_status(dev);
|
|
|
|
if (ret != 0)
|
|
|
|
{
|
|
|
|
return ret < 0 ? ret : -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_software_reset(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
uint8_t reg = MBR3108_CTRL_CMD;
|
|
|
|
uint8_t cmd = MBR3108_CMD_SOFTWARE_RESET;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, reg, &cmd, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108_CTRL_CMD:SOFTWARE_RESET write failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2017-10-06 18:15:01 +02:00
|
|
|
nxsig_usleep(MBR3108_CMD_MSECS_SOFTWARE_RESET * 1000);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = mbr3108_check_cmd_status(dev);
|
|
|
|
if (ret != 0)
|
|
|
|
{
|
|
|
|
return ret < 0 ? ret : -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_enter_low_power_mode(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
uint8_t reg = MBR3108_CTRL_CMD;
|
|
|
|
uint8_t cmd = MBR3108_CMD_ENTER_LOW_POWER_MODE;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, reg, &cmd, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108_CTRL_CMD:SOFTWARE_RESET write failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Device is now in low-power mode and not scanning. Further communication
|
|
|
|
* will cause wake-up and make chip resume scanning operations.
|
|
|
|
*/
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_clear_latched(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
uint8_t reg = MBR3108_CTRL_CMD;
|
|
|
|
uint8_t cmd = MBR3108_CMD_CLEAR_LATCHED;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, reg, &cmd, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
2020-03-31 00:32:20 +02:00
|
|
|
mbr3108_dbg("MBR3108_CTRL_CMD: "
|
|
|
|
"MBR3108_CMD_CLEAR_LATCHED write failed.\n");
|
2017-05-31 14:31:53 +02:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2017-10-06 18:15:01 +02:00
|
|
|
nxsig_usleep(MBR3108_CMD_MSECS_CLEAR_LATCHED * 1000);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = mbr3108_check_cmd_status(dev);
|
|
|
|
if (ret != 0)
|
|
|
|
{
|
|
|
|
return ret < 0 ? ret : -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_debug_setup(FAR struct mbr3108_dev_s *dev,
|
|
|
|
FAR const struct mbr3108_debug_conf_s *conf)
|
|
|
|
{
|
|
|
|
uint8_t reg = MBR3108_SENSOR_ID;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
/* Store new debug configuration. */
|
|
|
|
|
|
|
|
dev->debug_conf = *conf;
|
|
|
|
|
|
|
|
if (!conf->debug_mode)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Setup debug sensor id. */
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, reg, &conf->debug_sensor_id, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108_SENSOR_ID write failed.\n");
|
|
|
|
|
|
|
|
dev->debug_conf.debug_mode = false;
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
static int
|
|
|
|
mbr3108_device_configuration(FAR struct mbr3108_dev_s *dev,
|
|
|
|
FAR const struct mbr3108_sensor_conf_s *conf)
|
2017-05-31 14:31:53 +02:00
|
|
|
{
|
|
|
|
const uint8_t start_reg = MBR3108_SENSOR_EN;
|
|
|
|
const uint8_t last_reg = MBR3108_CONFIG_CRC + 1;
|
|
|
|
uint8_t value;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
DEBUGASSERT(sizeof(conf->conf_data) == last_reg - start_reg + 1);
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_read(dev, MBR3108_CTRL_CMD, &value, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108_CTRL_CMD read failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (value != MBR3108_CMD_COMPLETED)
|
|
|
|
{
|
|
|
|
/* Device is busy processing previous command. */
|
|
|
|
|
|
|
|
return -EBUSY;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_i2c_write(dev, start_reg, conf->conf_data,
|
|
|
|
last_reg - start_reg + 1);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108 configuration write failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_save_check_crc(dev);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108 save check CRC failed. ret=%d\n", ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_software_reset(dev);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("MBR3108 software reset failed.\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev->board->irq_enable(dev->board, true);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_get_sensor_status(FAR struct mbr3108_dev_s *dev,
|
|
|
|
FAR void *buf)
|
|
|
|
{
|
2020-03-31 00:32:20 +02:00
|
|
|
struct mbr3108_sensor_status_s status =
|
|
|
|
{
|
|
|
|
};
|
|
|
|
|
2017-05-31 14:31:53 +02:00
|
|
|
const uint8_t start_reg = MBR3108_BUTTON_STAT;
|
|
|
|
const uint8_t last_reg = MBR3108_LATCHED_PROX_STAT;
|
|
|
|
uint8_t readbuf[MBR3108_LATCHED_PROX_STAT - MBR3108_BUTTON_STAT + 1];
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
DEBUGASSERT(last_reg - start_reg + 1 == sizeof(readbuf));
|
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
/* Attempt to sensor status registers. */
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = mbr3108_i2c_read(dev, start_reg, readbuf, sizeof(readbuf));
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("Sensor status read failed.\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
status.button =
|
|
|
|
(readbuf[MBR3108_BUTTON_STAT + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_BUTTON_STAT + 1 - start_reg] << 8);
|
|
|
|
status.proximity =
|
|
|
|
readbuf[MBR3108_PROX_STAT - start_reg];
|
2017-05-31 14:31:53 +02:00
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
status.latched_button =
|
|
|
|
(readbuf[MBR3108_LATCHED_BUTTON_STAT + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_LATCHED_BUTTON_STAT + 1 - start_reg] << 8);
|
|
|
|
status.latched_proximity =
|
|
|
|
readbuf[MBR3108_LATCHED_PROX_STAT - start_reg];
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
memcpy(buf, &status, sizeof(status));
|
|
|
|
|
|
|
|
mbr3108_dbg("but: %x, prox: %x; latched[btn: %x, prox: %x]\n",
|
|
|
|
status.button, status.proximity, status.latched_button,
|
|
|
|
status.latched_button);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_get_sensor_debug_data(FAR struct mbr3108_dev_s *dev,
|
|
|
|
FAR void *buf)
|
|
|
|
{
|
2020-03-31 00:32:20 +02:00
|
|
|
struct mbr3108_sensor_debug_s data =
|
|
|
|
{
|
|
|
|
};
|
|
|
|
|
2017-05-31 14:31:53 +02:00
|
|
|
const uint8_t start_reg = MBR3108_SYNC_COUNTER1;
|
|
|
|
const uint8_t last_reg = MBR3108_SYNC_COUNTER2;
|
|
|
|
uint8_t readbuf[MBR3108_SYNC_COUNTER2 - MBR3108_SYNC_COUNTER1 + 1];
|
2020-03-31 00:32:20 +02:00
|
|
|
uint8_t sync1;
|
|
|
|
uint8_t sync2;
|
2017-05-31 14:31:53 +02:00
|
|
|
int ret;
|
|
|
|
int retries;
|
|
|
|
|
|
|
|
DEBUGASSERT(last_reg - start_reg + 1 == sizeof(readbuf));
|
|
|
|
|
|
|
|
for (retries = MBR3108_SYNC_RETRIES; retries > 0; retries--)
|
|
|
|
{
|
|
|
|
ret = mbr3108_i2c_read(dev, start_reg, readbuf, sizeof(readbuf));
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("Sensor debug data read failed.\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Sync counters need to match. */
|
|
|
|
|
|
|
|
sync1 = readbuf[MBR3108_SYNC_COUNTER1 - start_reg];
|
|
|
|
sync2 = readbuf[MBR3108_SYNC_COUNTER2 - start_reg];
|
|
|
|
|
|
|
|
if (sync1 == sync2)
|
|
|
|
{
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (retries == 0)
|
|
|
|
{
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
data.sensor_average_counts =
|
|
|
|
(readbuf[MBR3108_DEBUG_AVG_RAW_COUNT0 + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_DEBUG_AVG_RAW_COUNT0 + 1 - start_reg] << 8);
|
|
|
|
data.sensor_baseline =
|
|
|
|
(readbuf[MBR3108_DEBUG_BASELINE0 + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_DEBUG_BASELINE0 + 1 - start_reg] << 8);
|
|
|
|
data.sensor_diff_counts =
|
|
|
|
(readbuf[MBR3108_DEBUG_DIFFERENCE_COUNT0 + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_DEBUG_DIFFERENCE_COUNT0 + 1 - start_reg] << 8);
|
|
|
|
data.sensor_raw_counts =
|
|
|
|
(readbuf[MBR3108_DEBUG_RAW_COUNT0 + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_DEBUG_RAW_COUNT0 + 1 - start_reg] << 8);
|
|
|
|
data.sensor_total_capacitance = readbuf[MBR3108_DEBUG_CP - start_reg];
|
|
|
|
|
|
|
|
memcpy(buf, &data, sizeof(data));
|
|
|
|
|
|
|
|
mbr3108_dbg("avg_cnt: %d, baseline: %d, diff_cnt: %d, raw_cnt: %d, "
|
|
|
|
"total_cp: %d\n",
|
|
|
|
data.sensor_average_counts, data.sensor_baseline,
|
|
|
|
data.sensor_diff_counts, data.sensor_raw_counts,
|
|
|
|
data.sensor_total_capacitance);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_probe_device(FAR struct mbr3108_dev_s *dev)
|
|
|
|
{
|
|
|
|
const uint8_t start_reg = MBR3108_FAMILY_ID;
|
|
|
|
const uint8_t last_reg = MBR3108_DEVICE_REV;
|
|
|
|
uint8_t readbuf[MBR3108_DEVICE_REV - MBR3108_FAMILY_ID + 1];
|
|
|
|
uint8_t fam_id;
|
|
|
|
uint16_t dev_id;
|
|
|
|
uint8_t dev_rev;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
DEBUGASSERT(last_reg - start_reg + 1 == sizeof(readbuf));
|
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
/* Attempt to read device identification registers with multi-byte
|
|
|
|
* read.
|
|
|
|
*/
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = mbr3108_i2c_read(dev, start_reg, readbuf, sizeof(readbuf));
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
/* Failed to read registers from device. */
|
|
|
|
|
|
|
|
mbr3108_dbg("Probe failed.\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Check result. */
|
|
|
|
|
|
|
|
fam_id = readbuf[MBR3108_FAMILY_ID - start_reg];
|
|
|
|
dev_id = (readbuf[MBR3108_DEVICE_ID + 0 - start_reg]) |
|
|
|
|
(readbuf[MBR3108_DEVICE_ID + 1 - start_reg] << 8);
|
|
|
|
dev_rev = readbuf[MBR3108_DEVICE_REV - start_reg];
|
|
|
|
|
|
|
|
mbr3108_dbg("family_id: 0x%02x, device_id: 0x%04x, device_rev: %d\n",
|
|
|
|
fam_id, dev_id, dev_rev);
|
|
|
|
|
|
|
|
if (fam_id != MBR3108_EXPECTED_FAMILY_ID ||
|
|
|
|
dev_id != MBR3108_EXPECTED_DEVICE_ID ||
|
|
|
|
dev_rev != MBR3108_EXPECTED_DEVICE_REV)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("Probe failed, dev-id mismatch!\n");
|
2020-03-31 00:32:20 +02:00
|
|
|
mbr3108_dbg(" Expected: family_id: 0x%02x, device_id: "
|
|
|
|
"0x%04x, device_rev: %d\n",
|
|
|
|
MBR3108_EXPECTED_FAMILY_ID,
|
|
|
|
MBR3108_EXPECTED_DEVICE_ID,
|
|
|
|
MBR3108_EXPECTED_DEVICE_REV);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
return -ENXIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t mbr3108_read(FAR struct file *filep, FAR char *buffer,
|
|
|
|
size_t buflen)
|
|
|
|
{
|
|
|
|
FAR struct inode *inode;
|
|
|
|
FAR struct mbr3108_dev_s *priv;
|
|
|
|
size_t outlen;
|
|
|
|
irqstate_t flags;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
inode = filep->f_inode;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(inode->i_private);
|
2017-05-31 14:31:53 +02:00
|
|
|
priv = inode->i_private;
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
ret = nxmutex_lock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
|
|
|
if (priv->debug_conf.debug_mode)
|
|
|
|
{
|
|
|
|
outlen = sizeof(struct mbr3108_sensor_debug_s);
|
|
|
|
if (buflen >= outlen)
|
|
|
|
{
|
|
|
|
ret = mbr3108_get_sensor_debug_data(priv, buffer);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
outlen = sizeof(struct mbr3108_sensor_status_s);
|
|
|
|
if (buflen >= outlen)
|
|
|
|
{
|
|
|
|
ret = mbr3108_get_sensor_status(priv, buffer);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
flags = enter_critical_section();
|
|
|
|
priv->int_pending = false;
|
|
|
|
leave_critical_section(flags);
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
nxmutex_unlock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
return ret < 0 ? ret : outlen;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t mbr3108_write(FAR struct file *filep, FAR const char *buffer,
|
|
|
|
size_t buflen)
|
|
|
|
{
|
|
|
|
FAR struct inode *inode;
|
|
|
|
FAR struct mbr3108_dev_s *priv;
|
|
|
|
enum mbr3108_cmd_e type;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
inode = filep->f_inode;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(inode->i_private);
|
2017-05-31 14:31:53 +02:00
|
|
|
priv = inode->i_private;
|
|
|
|
|
|
|
|
if (buflen < sizeof(enum mbr3108_cmd_e))
|
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
ret = nxmutex_lock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
type = *(FAR const enum mbr3108_cmd_e *)buffer;
|
|
|
|
|
|
|
|
switch (type)
|
|
|
|
{
|
|
|
|
case CYPRESS_MBR3108_CMD_SENSOR_CONF:
|
|
|
|
{
|
|
|
|
FAR const struct mbr3108_cmd_sensor_conf_s *conf =
|
|
|
|
(FAR const struct mbr3108_cmd_sensor_conf_s *)buffer;
|
|
|
|
|
|
|
|
if (buflen != sizeof(*conf))
|
|
|
|
{
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_device_configuration(priv, &conf->conf);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
case CYPRESS_MBR3108_CMD_DEBUG_CONF:
|
|
|
|
{
|
|
|
|
FAR const struct mbr3108_cmd_debug_conf_s *conf =
|
|
|
|
(FAR const struct mbr3108_cmd_debug_conf_s *)buffer;
|
|
|
|
|
|
|
|
if (buflen != sizeof(*conf))
|
|
|
|
{
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_debug_setup(priv, &conf->conf);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
case CYPRESS_MBR3108_CMD_CLEAR_LATCHED:
|
|
|
|
{
|
|
|
|
if (buflen != sizeof(type))
|
|
|
|
{
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = mbr3108_clear_latched(priv);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
default:
|
|
|
|
ret = -EINVAL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
out:
|
2022-09-06 08:18:45 +02:00
|
|
|
nxmutex_unlock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
return ret < 0 ? ret : buflen;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_open(FAR struct file *filep)
|
|
|
|
{
|
|
|
|
FAR struct inode *inode;
|
|
|
|
FAR struct mbr3108_dev_s *priv;
|
|
|
|
unsigned int use_count;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
inode = filep->f_inode;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(inode->i_private);
|
2017-05-31 14:31:53 +02:00
|
|
|
priv = inode->i_private;
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
ret = nxmutex_lock(&priv->devlock);
|
2020-03-31 00:32:20 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
use_count = priv->cref + 1;
|
|
|
|
if (use_count == 1)
|
|
|
|
{
|
|
|
|
/* First user, do power on. */
|
|
|
|
|
|
|
|
ret = priv->board->set_power(priv->board, true);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
2022-09-06 08:18:45 +02:00
|
|
|
goto out_lock;
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Let chip to power up before probing */
|
|
|
|
|
2017-10-06 18:15:01 +02:00
|
|
|
nxsig_usleep(100 * 1000);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
/* Check that device exists on I2C. */
|
|
|
|
|
|
|
|
ret = mbr3108_probe_device(priv);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
/* No such device. Power off the switch. */
|
|
|
|
|
2020-01-02 17:49:34 +01:00
|
|
|
priv->board->set_power(priv->board, false);
|
2022-09-06 08:18:45 +02:00
|
|
|
goto out_lock;
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (priv->sensor_conf)
|
|
|
|
{
|
|
|
|
/* Do configuration. */
|
|
|
|
|
|
|
|
ret = mbr3108_device_configuration(priv, priv->sensor_conf);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
/* Configuration failed. Power off the switch. */
|
|
|
|
|
2020-01-02 17:49:34 +01:00
|
|
|
priv->board->set_power(priv->board, false);
|
2022-09-06 08:18:45 +02:00
|
|
|
goto out_lock;
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
priv->cref = use_count;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
DEBUGASSERT(use_count < UINT8_MAX && use_count > priv->cref);
|
|
|
|
|
|
|
|
priv->cref = use_count;
|
|
|
|
ret = 0;
|
|
|
|
}
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
out_lock:
|
|
|
|
nxmutex_unlock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_close(FAR struct file *filep)
|
|
|
|
{
|
|
|
|
FAR struct inode *inode;
|
|
|
|
FAR struct mbr3108_dev_s *priv;
|
|
|
|
int use_count;
|
2020-03-31 00:32:20 +02:00
|
|
|
int ret;
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
inode = filep->f_inode;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(inode->i_private);
|
2017-05-31 14:31:53 +02:00
|
|
|
priv = inode->i_private;
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
ret = nxmutex_lock(&priv->devlock);
|
2020-03-31 00:32:20 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
use_count = priv->cref - 1;
|
|
|
|
if (use_count == 0)
|
|
|
|
{
|
|
|
|
/* Disable interrupt */
|
|
|
|
|
|
|
|
priv->board->irq_enable(priv->board, false);
|
|
|
|
|
|
|
|
/* Set chip in low-power mode. */
|
|
|
|
|
2020-01-02 17:49:34 +01:00
|
|
|
mbr3108_enter_low_power_mode(priv);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
/* Last user, do power off. */
|
|
|
|
|
2020-01-02 17:49:34 +01:00
|
|
|
priv->board->set_power(priv->board, false);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
priv->debug_conf.debug_mode = false;
|
|
|
|
priv->cref = use_count;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
DEBUGASSERT(use_count > 0);
|
|
|
|
|
|
|
|
priv->cref = use_count;
|
|
|
|
}
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
nxmutex_unlock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_poll(FAR struct file *filep, FAR struct pollfd *fds,
|
|
|
|
bool setup)
|
|
|
|
{
|
|
|
|
FAR struct mbr3108_dev_s *priv;
|
|
|
|
FAR struct inode *inode;
|
|
|
|
bool pending;
|
|
|
|
int ret = 0;
|
|
|
|
int i;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(fds);
|
2017-05-31 14:31:53 +02:00
|
|
|
inode = filep->f_inode;
|
|
|
|
|
2023-08-28 11:17:05 +02:00
|
|
|
DEBUGASSERT(inode->i_private);
|
2023-08-29 06:16:49 +02:00
|
|
|
priv = inode->i_private;
|
2017-05-31 14:31:53 +02:00
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
ret = nxmutex_lock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (setup)
|
|
|
|
{
|
|
|
|
/* Ignore waits that do not include POLLIN */
|
|
|
|
|
|
|
|
if ((fds->events & POLLIN) == 0)
|
|
|
|
{
|
|
|
|
ret = -EDEADLK;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2020-03-31 00:32:20 +02:00
|
|
|
/* This is a request to set up the poll. Find an available slot for
|
|
|
|
* the poll structure reference.
|
2017-05-31 14:31:53 +02:00
|
|
|
*/
|
|
|
|
|
|
|
|
for (i = 0; i < CONFIG_INPUT_CYPRESS_MBR3108_NPOLLWAITERS; i++)
|
|
|
|
{
|
|
|
|
/* Find an available slot */
|
|
|
|
|
|
|
|
if (!priv->fds[i])
|
|
|
|
{
|
|
|
|
/* Bind the poll structure and this slot */
|
|
|
|
|
|
|
|
priv->fds[i] = fds;
|
|
|
|
fds->priv = &priv->fds[i];
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i >= CONFIG_INPUT_CYPRESS_MBR3108_NPOLLWAITERS)
|
|
|
|
{
|
|
|
|
fds->priv = NULL;
|
|
|
|
ret = -EBUSY;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
pending = priv->int_pending;
|
|
|
|
if (pending)
|
|
|
|
{
|
2022-09-19 05:08:57 +02:00
|
|
|
poll_notify(priv->fds,
|
|
|
|
CONFIG_INPUT_CYPRESS_MBR3108_NPOLLWAITERS,
|
|
|
|
POLLIN);
|
2017-05-31 14:31:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else if (fds->priv)
|
|
|
|
{
|
|
|
|
/* This is a request to tear down the poll. */
|
|
|
|
|
|
|
|
FAR struct pollfd **slot = (FAR struct pollfd **)fds->priv;
|
|
|
|
DEBUGASSERT(slot != NULL);
|
|
|
|
|
|
|
|
/* Remove all memory of the poll setup */
|
|
|
|
|
|
|
|
*slot = NULL;
|
|
|
|
fds->priv = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
out:
|
2022-09-06 08:18:45 +02:00
|
|
|
nxmutex_unlock(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mbr3108_isr_handler(int irq, FAR void *context, FAR void *arg)
|
|
|
|
{
|
|
|
|
FAR struct mbr3108_dev_s *priv = (FAR struct mbr3108_dev_s *)arg;
|
|
|
|
irqstate_t flags;
|
|
|
|
|
|
|
|
DEBUGASSERT(priv != NULL);
|
|
|
|
|
|
|
|
flags = enter_critical_section();
|
|
|
|
priv->int_pending = true;
|
|
|
|
leave_critical_section(flags);
|
|
|
|
|
2022-09-19 05:08:57 +02:00
|
|
|
poll_notify(priv->fds, CONFIG_INPUT_CYPRESS_MBR3108_NPOLLWAITERS, POLLIN);
|
2017-05-31 14:31:53 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
int cypress_mbr3108_register(FAR const char *devpath,
|
|
|
|
FAR struct i2c_master_s *i2c_dev,
|
|
|
|
uint8_t i2c_devaddr,
|
|
|
|
struct mbr3108_board_s *board_config,
|
|
|
|
const struct mbr3108_sensor_conf_s *sensor_conf)
|
|
|
|
{
|
|
|
|
struct mbr3108_dev_s *priv;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
/* Allocate device private structure. */
|
|
|
|
|
|
|
|
priv = kmm_zalloc(sizeof(struct mbr3108_dev_s));
|
|
|
|
if (!priv)
|
|
|
|
{
|
|
|
|
mbr3108_dbg("Memory cannot be allocated for mbr3108 sensor\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Setup device structure. */
|
|
|
|
|
|
|
|
priv->addr = i2c_devaddr;
|
|
|
|
priv->i2c = i2c_dev;
|
|
|
|
priv->board = board_config;
|
|
|
|
priv->sensor_conf = sensor_conf;
|
|
|
|
|
2022-09-06 08:18:45 +02:00
|
|
|
nxmutex_init(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
|
|
|
|
ret = register_driver(devpath, &g_mbr3108_fileops, 0666, priv);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
2022-10-16 18:50:59 +02:00
|
|
|
nxmutex_destroy(&priv->devlock);
|
2017-05-31 14:31:53 +02:00
|
|
|
kmm_free(priv);
|
|
|
|
mbr3108_dbg("Error occurred during the driver registering\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
mbr3108_dbg("Registered with %d\n", ret);
|
|
|
|
|
|
|
|
/* Prepare interrupt line and handler. */
|
|
|
|
|
|
|
|
priv->board->irq_attach(priv->board, mbr3108_isr_handler, priv);
|
|
|
|
priv->board->irq_enable(priv->board, false);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|