/**************************************************************************** * boards/arm/cxd56xx/drivers/sensors/lt1pa01_scu.c * * Copyright 2018 Sony Semiconductor Solutions Corporation * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * 3. Neither the name of Sony Semiconductor Solutions Corporation nor * the names of its contributors may be used to endorse or promote * products derived from this software without specific prior written * permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * ****************************************************************************/ /**************************************************************************** * Included Files ****************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #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 ****************************************************************************/ /** * @brief Structure for lt1pa01 device */ struct lt1pa01_dev_s { FAR 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(FAR struct file *filep); static int lt1pa01_open_prox(FAR struct file *filep); static int lt1pa01_close_als(FAR struct file *filep); static int lt1pa01_close_prox(FAR struct file *filep); static ssize_t lt1pa01_read_als(FAR struct file *filep, FAR char *buffer, size_t buflen); static ssize_t lt1pa01_read_prox(FAR struct file *filep, FAR char *buffer, size_t buflen); static ssize_t lt1pa01_write(FAR struct file *filep, FAR const char *buffer, size_t buflen); static int lt1pa01_ioctl_als(FAR struct file *filep, int cmd, unsigned long arg); static int lt1pa01_ioctl_prox(FAR 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 */ 0, /* seek */ lt1pa01_ioctl_als, /* ioctl */ #ifndef CONFIG_DISABLE_POLL 0, /* poll */ #endif 0 /* unlink */ }; /* Proximity sensor */ static const struct file_operations g_lt1pa01proxfops = { lt1pa01_open_prox, /* open */ lt1pa01_close_prox, /* close */ lt1pa01_read_prox, /* read */ lt1pa01_write, /* write */ 0, /* seek */ lt1pa01_ioctl_prox, /* ioctl */ #ifndef CONFIG_DISABLE_POLL 0, /* poll */ #endif 0 /* unlink */ }; /* 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(FAR 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, ®val, 1); return regval; } /**************************************************************************** * Name: lt1pa01_putreg8 * * Description: * Write to an 8-bit LT1PA01 register * ****************************************************************************/ static void lt1pa01_putreg8(FAR 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(FAR 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(FAR 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(FAR 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(FAR struct file *filep) { FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep) { #ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep) { FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep) { #ifndef CONFIG_LT1PA01_PROXIMITY_INTERRUPT FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep, FAR char *buffer, size_t len) { FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep, FAR char *buffer, size_t len) { FAR struct inode *inode = filep->f_inode; FAR 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; *(FAR 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(FAR struct file *filep, FAR const char *buffer, size_t buflen) { return -ENOSYS; } /**************************************************************************** * Name: lt1pa01_ioctl_als ****************************************************************************/ static int lt1pa01_ioctl_als(FAR struct file *filep, int cmd, unsigned long arg) { FAR struct inode *inode = filep->f_inode; FAR 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(FAR struct file *filep, int cmd, unsigned long arg) { FAR struct inode *inode = filep->f_inode; FAR 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: { FAR uint8_t intstatus = lt1pa01_getreg8(priv, LT1PA01_INTCONFIG); *(FAR 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("Unregisted 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(FAR struct i2c_master_s *i2c, int port) { FAR struct lt1pa01_dev_s tmp; FAR 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(FAR const char *devpath, int minor, FAR struct i2c_master_s *i2c, int port) { FAR struct lt1pa01_dev_s *priv; char path[16]; int ret; /* Initialize the LT1PA01 device structure */ priv = (FAR 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(FAR const char *devpath, int minor, FAR struct i2c_master_s *i2c, int port) { FAR struct lt1pa01_dev_s *priv; char path[16]; int ret; /* Initialize the LT1PA01 device structure */ priv = (FAR 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 */