sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
f5df946676
nuttx/boards/arm/cxd56xx/drivers/sensors/lt1pa01_scu.c
simbit18 8f744592d5 Fix nuttx coding style 
Fix Comments
2023-07-31 10:54:53 -03:00

882 lines
24 KiB
C
Raw Blame History

/****************************************************************************
* boards/arm/cxd56xx/drivers/sensors/lt1pa01_scu.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 <stdlib.h>
#include <stdio.h>
#include <fixedmath.h>
#include <assert.h>
#include <errno.h>
#include <debug.h>
#include <arch/types.h>
#include <nuttx/kmalloc.h>
#include <nuttx/fs/fs.h>
#include <nuttx/i2c/i2c_master.h>
#include <nuttx/sensors/lt1pa01.h>
#include <nuttx/irq.h>
#include <arch/chip/scu.h>
#if defined(CONFIG_I2C) && defined(CONFIG_SENSORS_LT1PA01_SCU)
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#define LT1PA01_ADDR 0x44 /* I2C Slave Address */
#define LT1PA01_DEVICEID 0xC8 /* Device ID */
#define LT1PA01_ALS_BYTESPERSAMPLE 2
#define LT1PA01_PROX_BYTESPERSAMPLE 1
#define LT1PA01_ELEMENTSIZE 0
/* LT1PA01 Registers */
#define LT1PA01_ID 0x00
#define LT1PA01_CONFIG0 0x01
#define LT1PA01_CONFIG1 0x02
#define LT1PA01_CONFIG2 0x03
#define LT1PA01_INTCONFIG 0x04
#define LT1PA01_PROX_INT_TL 0x05
#define LT1PA01_PROX_INT_TH 0x06
#define LT1PA01_ALS_INT_TL 0x07
#define LT1PA01_ALS_INT_TLH 0x08
#define LT1PA01_ALS_INT_TH 0x09
#define LT1PA01_PROX_DATA 0x0A
#define LT1PA01_ALS_DATA_HB 0x0B
#define LT1PA01_ALS_DATA_LB 0x0C
#define LT1PA01_PROX_AMBIR 0x0D
#define LT1PA01_CONFIG3 0x0E
/* Register ID */
#define LT1PA01_ID_MASK 0xF8
/* Register CONFIG0 */
#define LT1PA01_PROX_DIS (0 << 5)
#define LT1PA01_PROX_EN (1 << 5)
#define LT1PA01_PROX_SLP_800MS (0 << 2)
#define LT1PA01_PROX_SLP_200MS (1 << 2)
#define LT1PA01_PROX_SLP_100MS (2 << 2)
#define LT1PA01_PROX_IRDR_DRV0 (0 << 0) /* 3.6mA */
#define LT1PA01_PROX_IRDR_DRV1 (1 << 0) /* 7.2mA */
#define LT1PA01_PROX_IRDR_DRV2 (2 << 0) /* 10.8mA */
#define LT1PA01_PROX_IRDR_DRV3 (3 << 0) /* 14.4mA */
/* Register CONFIG1 */
#define LT1PA01_INT_ALG_COMPARATOR (0 << 7)
#define LT1PA01_INT_ALG_HYSTERESIS (1 << 7)
#define LT1PA01_ALS_DIS (0 << 2)
#define LT1PA01_ALS_EN (1 << 2)
#define LT1PA01_ALS_ALS_RANGE0 (0 << 0) /* 62.5 Lux */
#define LT1PA01_ALS_ALS_RANGE1 (1 << 0) /* 125 Lux */
#define LT1PA01_ALS_ALS_RANGE2 (2 << 0) /* 1000 Lux */
#define LT1PA01_ALS_ALS_RANGE3 (3 << 0) /* 2000 Lux */
#define LT1PA01_ALS_ALS_RANGE_MASK (3 << 0)
/* Register INTCONFIG */
#define LT1PA01_PORX_INT_FLG (1 << 7)
#define LT1PA01_PORX_INT_PRST1 (0 << 5)
#define LT1PA01_PORX_INT_PRST2 (1 << 5)
#define LT1PA01_PORX_INT_PRST4 (2 << 5)
#define LT1PA01_PORX_INT_PRST8 (3 << 5)
#define LT1PA01_PORX_INT_PRST_MASK (3 << 5)
#define LT1PA01_PWR_FAIL (1 << 4)
#define LT1PA01_ALS_INT_FLG (1 << 3)
#define LT1PA01_ALS_INT_PRST1 (0 << 1)
#define LT1PA01_ALS_INT_PRST2 (1 << 1)
#define LT1PA01_ALS_INT_PRST4 (2 << 1)
#define LT1PA01_ALS_INT_PRST8 (3 << 1)
#define LT1PA01_INT_CFG_ALS_AND_PROX (1 << 0)
#define LT1PA01_INT_CFG_ALS_OR_PROX (0 << 0)
/* Register INTCONFIG */
#define LT1PA01_SW_RESET 0x38
/* PROX INT threshold default value */
#define LT1PA01_PROX_INT_TL_DEFAULT 0x03
#define LT1PA01_PROX_INT_TH_DEFAULT 0x03
#ifndef itemsof
# define itemsof(array) (sizeof(array)/sizeof(array[0]))
#endif
/****************************************************************************
* Private Type Definitions
****************************************************************************/
/* Structure for lt1pa01 device */
struct lt1pa01_dev_s
{
struct i2c_master_s *i2c; /* I2C interface */
uint8_t addr; /* I2C address */
int port; /* I2C port */
struct seq_s *seq; /* Sequencer instance */
int minor; /* Minor device number */
};
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
/* Character driver methods */
static int lt1pa01_open_als(struct file *filep);
static int lt1pa01_open_prox(struct file *filep);
static int lt1pa01_close_als(struct file *filep);
static int lt1pa01_close_prox(struct file *filep);
static ssize_t lt1pa01_read_als(struct file *filep, char *buffer,
size_t buflen);
static ssize_t lt1pa01_read_prox(struct file *filep, char *buffer,
size_t buflen);
static ssize_t lt1pa01_write(struct file *filep, const char *buffer,
size_t buflen);
static int lt1pa01_ioctl_als(struct file *filep, int cmd,
unsigned long arg);
static int lt1pa01_ioctl_prox(struct file *filep, int cmd,
unsigned long arg);
/****************************************************************************
* Private Data
****************************************************************************/
/* Ambient light sensor */
static const struct file_operations g_lt1pa01alsfops =
{
lt1pa01_open_als, /* open */
lt1pa01_close_als, /* close */
lt1pa01_read_als, /* read */
lt1pa01_write, /* write */
NULL, /* seek */
lt1pa01_ioctl_als, /* ioctl */
};
/* Proximity sensor */
static const struct file_operations g_lt1pa01proxfops =
{
lt1pa01_open_prox, /* open */
lt1pa01_close_prox, /* close */
lt1pa01_read_prox, /* read */
lt1pa01_write, /* write */
NULL, /* seek */
lt1pa01_ioctl_prox, /* ioctl */
};
/* SCU instructions for pick ambient light sensing data. */
static const uint16_t g_lt1pa01alsinst[] =
{
SCU_INST_SEND(LT1PA01_ALS_DATA_HB),
SCU_INST_RECV(LT1PA01_ALS_BYTESPERSAMPLE) | SCU_INST_LAST,
};
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
/* SCU instructions for pick proximity sensing data. */
static const uint16_t g_lt1pa01proxinst[] =
{
SCU_INST_SEND(LT1PA01_PROX_DATA),
SCU_INST_RECV(LT1PA01_PROX_BYTESPERSAMPLE) | SCU_INST_LAST,
};
#endif
/* Reference count */
static int g_als_refcnt = 0;
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
static int g_prox_refcnt = 0;
#endif
/* Sequencer instance */
static struct seq_s *g_als_seq = NULL;
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
static struct seq_s *g_prox_seq = NULL;
#endif
#ifdef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
/* Proximity interrupt config */
static uint8_t g_prox_lthreshold = LT1PA01_PROX_INT_TL_DEFAULT;
static uint8_t g_prox_hthreshold = LT1PA01_PROX_INT_TH_DEFAULT;
#endif
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: lt1pa01_getreg8
*
* Description:
* Read from an 8-bit LT1PA01 register
*
****************************************************************************/
static uint8_t lt1pa01_getreg8(struct lt1pa01_dev_s *priv,
uint8_t regaddr)
{
uint8_t regval = 0;
uint16_t inst[2];
/* Send register to read and get the next byte */
inst[0] = SCU_INST_SEND(regaddr);
inst[1] = SCU_INST_RECV(1) | SCU_INST_LAST;
scu_i2ctransfer(priv->port, priv->addr, inst, 2, &regval, 1);
return regval;
}
/****************************************************************************
* Name: lt1pa01_putreg8
*
* Description:
* Write to an 8-bit LT1PA01 register
*
****************************************************************************/
static void lt1pa01_putreg8(struct lt1pa01_dev_s *priv,
uint8_t regaddr, uint8_t regval)
{
uint16_t inst[2];
/* Send register address and set the value */
inst[0] = SCU_INST_SEND(regaddr);
inst[1] = SCU_INST_SEND(regval) | SCU_INST_LAST;
scu_i2ctransfer(priv->port, priv->addr, inst, 2, NULL, 0);
}
/****************************************************************************
* Name: lt1pa01_checkid
*
* Description:
* Read and verify the LT1PA01 chip ID
*
****************************************************************************/
static int lt1pa01_checkid(struct lt1pa01_dev_s *priv)
{
uint8_t id;
/* Read Device ID */
id = lt1pa01_getreg8(priv, LT1PA01_ID);
sninfo("LT1PA01 ID:%02X\n", id);
if ((id & LT1PA01_ID_MASK) != LT1PA01_DEVICEID)
{
/* Device ID is not Correct */
snerr("Wrong Device ID! %02x (Exp:%02x)\n", id, LT1PA01_DEVICEID);
return -ENODEV;
}
return OK;
}
/****************************************************************************
* Name: lt1pa01als_seqinit
*
* Description:
* Initialize SCU sequencer.
*
****************************************************************************/
static int lt1pa01als_seqinit(struct lt1pa01_dev_s *priv)
{
DEBUGASSERT(g_als_seq == NULL);
/* Open sequencer */
g_als_seq = seq_open(SEQ_TYPE_NORMAL, SCU_BUS_I2C0);
if (!g_als_seq)
{
return -ENOENT;
}
priv->seq = g_als_seq;
seq_setaddress(priv->seq, priv->addr);
/* Set instruction and sample data information to sequencer */
seq_setinstruction(priv->seq,
g_lt1pa01alsinst,
itemsof(g_lt1pa01alsinst));
seq_setsample(priv->seq,
LT1PA01_ALS_BYTESPERSAMPLE,
0,
LT1PA01_ELEMENTSIZE,
false);
return OK;
}
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
/****************************************************************************
* Name: lt1pa01prox_seqinit
*
* Description:
* Initialize SCU sequencer.
*
****************************************************************************/
static int lt1pa01prox_seqinit(struct lt1pa01_dev_s *priv)
{
DEBUGASSERT(g_prox_seq == NULL);
/* Open sequencer */
g_prox_seq = seq_open(SEQ_TYPE_NORMAL, SCU_BUS_I2C0);
if (!g_prox_seq)
{
return -ENOENT;
}
priv->seq = g_prox_seq;
seq_setaddress(priv->seq, priv->addr);
/* Set instruction and sample data information to sequencer */
seq_setinstruction(priv->seq,
g_lt1pa01proxinst,
itemsof(g_lt1pa01proxinst));
seq_setsample(priv->seq,
LT1PA01_PROX_BYTESPERSAMPLE,
0,
LT1PA01_ELEMENTSIZE,
false);
return OK;
}
#endif
/****************************************************************************
* Name: lt1pa01_open_als
*
* Description:
* This function is called whenever the LT1PA01 device is opened.
*
****************************************************************************/
static int lt1pa01_open_als(struct file *filep)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
uint8_t val;
if (g_als_refcnt == 0)
{
int ret;
ret = lt1pa01als_seqinit(priv);
if (ret < 0)
{
return ret;
}
/* ALS Enable */
val = lt1pa01_getreg8(priv, LT1PA01_CONFIG1);
val |= (LT1PA01_ALS_EN | LT1PA01_ALS_ALS_RANGE2);
lt1pa01_putreg8(priv, LT1PA01_CONFIG1, val);
}
else
{
/* Set existing sequencer */
priv->seq = g_als_seq;
}
g_als_refcnt++;
return OK;
}
/****************************************************************************
* Name: lt1pa01_open_prox
*
* Description:
* This function is called whenever the LT1PA01 device is opened.
*
****************************************************************************/
static int lt1pa01_open_prox(struct file *filep)
{
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
uint8_t val;
if (g_prox_refcnt == 0)
{
int ret;
ret = lt1pa01prox_seqinit(priv);
if (ret < 0)
{
return ret;
}
/* PROX Enable */
val = LT1PA01_PROX_EN | LT1PA01_PROX_SLP_100MS;
lt1pa01_putreg8(priv, LT1PA01_CONFIG0, val);
}
else
{
/* Set existing sequencer */
priv->seq = g_prox_seq;
}
g_prox_refcnt++;
#endif
return OK;
}
/****************************************************************************
* Name: lt1pa01_close_als
*
* Description:
* This routine is called when the LT1PA01 device is closed.
*
****************************************************************************/
static int lt1pa01_close_als(struct file *filep)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
uint8_t val;
g_als_refcnt--;
seq_ioctl(priv->seq, priv->minor, SCUIOC_STOP, 0);
if (g_als_refcnt == 0)
{
/* ALS Disable */
val = lt1pa01_getreg8(priv, LT1PA01_CONFIG1);
val &= ~LT1PA01_ALS_EN;
val &= ~LT1PA01_ALS_ALS_RANGE_MASK;
lt1pa01_putreg8(priv, LT1PA01_CONFIG1, val);
seq_close(g_als_seq);
g_als_seq = NULL;
}
else
{
seq_ioctl(priv->seq, priv->minor, SCUIOC_FREEFIFO, 0);
}
return OK;
}
/****************************************************************************
* Name: lt1pa01_close_prox
*
* Description:
* This routine is called when the LT1PA01 device is closed.
*
****************************************************************************/
static int lt1pa01_close_prox(struct file *filep)
{
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
g_prox_refcnt--;
seq_ioctl(priv->seq, priv->minor, SCUIOC_STOP, 0);
if (g_prox_refcnt == 0)
{
/* PROX Disable */
lt1pa01_putreg8(priv, LT1PA01_CONFIG0, 0);
seq_close(g_prox_seq);
g_prox_seq = NULL;
}
else
{
seq_ioctl(priv->seq, priv->minor, SCUIOC_FREEFIFO, 0);
}
#endif
return OK;
}
/****************************************************************************
* Name: lt1pa01_read_als
****************************************************************************/
static ssize_t lt1pa01_read_als(struct file *filep, char *buffer,
size_t len)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
len = len / LT1PA01_ALS_BYTESPERSAMPLE * LT1PA01_ALS_BYTESPERSAMPLE;
len = seq_read(priv->seq, priv->minor, buffer, len);
return len;
}
/****************************************************************************
* Name: lt1pa01_read_prox
****************************************************************************/
static ssize_t lt1pa01_read_prox(struct file *filep, char *buffer,
size_t len)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
len = len / LT1PA01_PROX_BYTESPERSAMPLE * LT1PA01_PROX_BYTESPERSAMPLE;
#ifdef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
if (len)
{
len = LT1PA01_PROX_BYTESPERSAMPLE;
*(uint8_t *)buffer = lt1pa01_getreg8(priv, LT1PA01_PROX_DATA);
}
#else
len = seq_read(priv->seq, priv->minor, buffer, len);
#endif
return len;
}
/****************************************************************************
* Name: lt1pa01_write
****************************************************************************/
static ssize_t lt1pa01_write(struct file *filep, const char *buffer,
size_t buflen)
{
return -ENOSYS;
}
/****************************************************************************
* Name: lt1pa01_ioctl_als
****************************************************************************/
static int lt1pa01_ioctl_als(struct file *filep, int cmd,
unsigned long arg)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
int ret = OK;
switch (cmd)
{
default:
{
if (_SCUIOCVALID(cmd))
{
/* Redirect SCU commands */
ret = seq_ioctl(priv->seq, priv->minor, cmd, arg);
}
else
{
snerr("Unrecognized cmd: %d\n", cmd);
ret = - ENOTTY;
}
}
break;
}
return ret;
}
/****************************************************************************
* Name: lt1pa01_ioctl_prox
****************************************************************************/
static int lt1pa01_ioctl_prox(struct file *filep, int cmd,
unsigned long arg)
{
struct inode *inode = filep->f_inode;
struct lt1pa01_dev_s *priv = inode->i_private;
int ret = OK;
switch (cmd)
{
#ifdef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
case SNIOC_SETPROXLTHRESHOLD:
{
g_prox_lthreshold = (uint8_t)arg;
}
break;
case SNIOC_SETPROXHTHRESHOLD:
{
g_prox_hthreshold = (uint8_t)arg;
}
break;
case SNIOC_STARTPROXMEASUREMENT:
{
uint8_t val;
/* PROX Interrupt setting */
lt1pa01_putreg8(priv, LT1PA01_PROX_INT_TL, g_prox_lthreshold);
lt1pa01_putreg8(priv, LT1PA01_PROX_INT_TH, g_prox_hthreshold);
val = LT1PA01_PORX_INT_PRST2 | LT1PA01_INT_CFG_ALS_OR_PROX;
lt1pa01_putreg8(priv, LT1PA01_INTCONFIG, val);
val = lt1pa01_getreg8(priv, LT1PA01_CONFIG1);
val |= LT1PA01_INT_ALG_COMPARATOR;
lt1pa01_putreg8(priv, LT1PA01_CONFIG1, val);
/* PROX Enable */
val = LT1PA01_PROX_EN | LT1PA01_PROX_SLP_100MS;
lt1pa01_putreg8(priv, LT1PA01_CONFIG0, val);
}
break;
case SNIOC_STOPPROXMEASUREMENT:
{
/* PROX Disable */
lt1pa01_putreg8(priv, LT1PA01_CONFIG1, 0);
}
break;
case SNIOC_GETINTSTATUS:
{
uint8_t intstatus = lt1pa01_getreg8(priv, LT1PA01_INTCONFIG);
*(uint8_t *)(uintptr_t)arg = intstatus;
sninfo("Get proximity IntStatus 0x%02x\n", intstatus);
}
break;
#endif
default:
{
if (_SCUIOCVALID(cmd))
{
#ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT
/* Redirect SCU commands */
ret = seq_ioctl(priv->seq, priv->minor, cmd, arg);
#else
snerr("Unregistered SCU sequencer cmd: %d\n", cmd);
ret = - ENOTTY;
#endif
}
else
{
snerr("Unrecognized cmd: %d\n", cmd);
ret = - ENOTTY;
}
}
break;
}
return ret;
}
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: lt1pa01_init
*
* Description:
* Initialize the LT1PA01 device
*
* Input Parameters:
* i2c - An instance of the I2C interface to use to communicate with
* LT1PA01
* port - I2C port (0 or 1)
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
int lt1pa01_init(struct i2c_master_s *i2c, int port)
{
struct lt1pa01_dev_s tmp;
struct lt1pa01_dev_s *priv = &tmp;
int ret;
/* Setup temporary device structure for initialization */
priv->i2c = i2c;
priv->addr = LT1PA01_ADDR;
priv->port = port;
/* Check Device ID */
ret = lt1pa01_checkid(priv);
if (ret < 0)
{
snerr("Failed to register driver: %d\n", ret);
return ret;
}
/* Software reset */
lt1pa01_putreg8(priv, LT1PA01_CONFIG3, LT1PA01_SW_RESET);
/* Power-up and Brown-out Reset */
lt1pa01_putreg8(priv, LT1PA01_INTCONFIG, 0);
return OK;
}
/****************************************************************************
* Name: lt1pa01als_register
*
* Description:
* Register the LT1PA01 ambient light sensor character device as 'devpath'
*
* Input Parameters:
* devpath - The full path to the driver to register. E.g., "/dev/light0"
* minor - minor device number
* i2c - An instance of the I2C interface to use to communicate with
* LT1PA01
* port - I2C port (0 or 1)
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
int lt1pa01als_register(const char *devpath, int minor,
struct i2c_master_s *i2c, int port)
{
struct lt1pa01_dev_s *priv;
char path[16];
int ret;
/* Initialize the LT1PA01 device structure */
priv = (struct lt1pa01_dev_s *)
kmm_malloc(sizeof(struct lt1pa01_dev_s));
if (!priv)
{
snerr("Failed to allocate instance\n");
return -ENOMEM;
}
priv->i2c = i2c;
priv->addr = LT1PA01_ADDR;
priv->port = port;
priv->seq = NULL;
priv->minor = minor;
/* Register the character driver */
snprintf(path, sizeof(path), "%s%d", devpath, minor);
ret = register_driver(path, &g_lt1pa01alsfops, 0666, priv);
if (ret < 0)
{
snerr("Failed to register driver: %d\n", ret);
kmm_free(priv);
}
return ret;
}
/****************************************************************************
* Name: lt1pa01prox_register
*
* Description:
* Register the LT1PA01 proximity sensor character device as 'devpath'
*
* Input Parameters:
* devpath - The full path to the driver to register. E.g., "/dev/proxim0"
* minor - minor device number
* i2c - An instance of the I2C interface to use to communicate with
* LT1PA01
* port - I2C port (0 or 1)
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
int lt1pa01prox_register(const char *devpath, int minor,
struct i2c_master_s *i2c, int port)
{
struct lt1pa01_dev_s *priv;
char path[16];
int ret;
/* Initialize the LT1PA01 device structure */
priv = (struct lt1pa01_dev_s *)
kmm_malloc(sizeof(struct lt1pa01_dev_s));
if (!priv)
{
snerr("Failed to allocate instance\n");
return -ENOMEM;
}
priv->i2c = i2c;
priv->addr = LT1PA01_ADDR;
priv->port = port;
priv->seq = NULL;
priv->minor = minor;
/* Register the character driver */
snprintf(path, sizeof(path), "%s%d", devpath, minor);
ret = register_driver(path, &g_lt1pa01proxfops, 0666, priv);
if (ret < 0)
{
snerr("Failed to register driver: %d\n", ret);
kmm_free(priv);
}
sninfo("LT1PA01 proximity sensor driver loaded successfully!\n");
return ret;
}
#endif /* CONFIG_I2C && CONFIG_SENSORS_LT1PA01_SCU */
Reference in New Issue View Git Blame Copy Permalink