 ec8f9ceace
			
		
	
	
	ec8f9ceace
	
	
	
		
			
			Fixes this warning: drivers/misc/apds990x.c: At top level: drivers/misc/apds990x.c:613: warning: `apds990x_chip_on' defined but not used Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org> Cc: Samu Onkalo <samu.p.onkalo@nokia.com> Cc: Jonathan Cameron <jic23@cam.ac.uk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
		
			
				
	
	
		
			1297 lines
		
	
	
	
		
			34 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1297 lines
		
	
	
	
		
			34 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * This file is part of the APDS990x sensor driver.
 | |
|  * Chip is combined proximity and ambient light sensor.
 | |
|  *
 | |
|  * Copyright (C) 2010 Nokia Corporation and/or its subsidiary(-ies).
 | |
|  *
 | |
|  * Contact: Samu Onkalo <samu.p.onkalo@nokia.com>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU General Public License
 | |
|  * version 2 as published by the Free Software Foundation.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful, but
 | |
|  * WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 | |
|  * General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software
 | |
|  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 | |
|  * 02110-1301 USA
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/i2c.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/mutex.h>
 | |
| #include <linux/regulator/consumer.h>
 | |
| #include <linux/pm_runtime.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/wait.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/i2c/apds990x.h>
 | |
| 
 | |
| /* Register map */
 | |
| #define APDS990X_ENABLE	 0x00 /* Enable of states and interrupts */
 | |
| #define APDS990X_ATIME	 0x01 /* ALS ADC time  */
 | |
| #define APDS990X_PTIME	 0x02 /* Proximity ADC time  */
 | |
| #define APDS990X_WTIME	 0x03 /* Wait time  */
 | |
| #define APDS990X_AILTL	 0x04 /* ALS interrupt low threshold low byte */
 | |
| #define APDS990X_AILTH	 0x05 /* ALS interrupt low threshold hi byte */
 | |
| #define APDS990X_AIHTL	 0x06 /* ALS interrupt hi threshold low byte */
 | |
| #define APDS990X_AIHTH	 0x07 /* ALS interrupt hi threshold hi byte */
 | |
| #define APDS990X_PILTL	 0x08 /* Proximity interrupt low threshold low byte */
 | |
| #define APDS990X_PILTH	 0x09 /* Proximity interrupt low threshold hi byte */
 | |
| #define APDS990X_PIHTL	 0x0a /* Proximity interrupt hi threshold low byte */
 | |
| #define APDS990X_PIHTH	 0x0b /* Proximity interrupt hi threshold hi byte */
 | |
| #define APDS990X_PERS	 0x0c /* Interrupt persistence filters */
 | |
| #define APDS990X_CONFIG	 0x0d /* Configuration */
 | |
| #define APDS990X_PPCOUNT 0x0e /* Proximity pulse count */
 | |
| #define APDS990X_CONTROL 0x0f /* Gain control register */
 | |
| #define APDS990X_REV	 0x11 /* Revision Number */
 | |
| #define APDS990X_ID	 0x12 /* Device ID */
 | |
| #define APDS990X_STATUS	 0x13 /* Device status */
 | |
| #define APDS990X_CDATAL	 0x14 /* Clear ADC low data register */
 | |
| #define APDS990X_CDATAH	 0x15 /* Clear ADC high data register */
 | |
| #define APDS990X_IRDATAL 0x16 /* IR ADC low data register */
 | |
| #define APDS990X_IRDATAH 0x17 /* IR ADC high data register */
 | |
| #define APDS990X_PDATAL	 0x18 /* Proximity ADC low data register */
 | |
| #define APDS990X_PDATAH	 0x19 /* Proximity ADC high data register */
 | |
| 
 | |
| /* Control */
 | |
| #define APDS990X_MAX_AGAIN	3
 | |
| 
 | |
| /* Enable register */
 | |
| #define APDS990X_EN_PIEN	(0x1 << 5)
 | |
| #define APDS990X_EN_AIEN	(0x1 << 4)
 | |
| #define APDS990X_EN_WEN		(0x1 << 3)
 | |
| #define APDS990X_EN_PEN		(0x1 << 2)
 | |
| #define APDS990X_EN_AEN		(0x1 << 1)
 | |
| #define APDS990X_EN_PON		(0x1 << 0)
 | |
| #define APDS990X_EN_DISABLE_ALL 0
 | |
| 
 | |
| /* Status register */
 | |
| #define APDS990X_ST_PINT	(0x1 << 5)
 | |
| #define APDS990X_ST_AINT	(0x1 << 4)
 | |
| 
 | |
| /* I2C access types */
 | |
| #define APDS990x_CMD_TYPE_MASK	(0x03 << 5)
 | |
| #define APDS990x_CMD_TYPE_RB	(0x00 << 5) /* Repeated byte */
 | |
| #define APDS990x_CMD_TYPE_INC	(0x01 << 5) /* Auto increment */
 | |
| #define APDS990x_CMD_TYPE_SPE	(0x03 << 5) /* Special function */
 | |
| 
 | |
| #define APDS990x_ADDR_SHIFT	0
 | |
| #define APDS990x_CMD		0x80
 | |
| 
 | |
| /* Interrupt ack commands */
 | |
| #define APDS990X_INT_ACK_ALS	0x6
 | |
| #define APDS990X_INT_ACK_PS	0x5
 | |
| #define APDS990X_INT_ACK_BOTH	0x7
 | |
| 
 | |
| /* ptime */
 | |
| #define APDS990X_PTIME_DEFAULT	0xff /* Recommended conversion time 2.7ms*/
 | |
| 
 | |
| /* wtime */
 | |
| #define APDS990X_WTIME_DEFAULT	0xee /* ~50ms wait time */
 | |
| 
 | |
| #define APDS990X_TIME_TO_ADC	1024 /* One timetick as ADC count value */
 | |
| 
 | |
| /* Persistence */
 | |
| #define APDS990X_APERS_SHIFT	0
 | |
| #define APDS990X_PPERS_SHIFT	4
 | |
| 
 | |
| /* Supported ID:s */
 | |
| #define APDS990X_ID_0		0x0
 | |
| #define APDS990X_ID_4		0x4
 | |
| #define APDS990X_ID_29		0x29
 | |
| 
 | |
| /* pgain and pdiode settings */
 | |
| #define APDS_PGAIN_1X	       0x0
 | |
| #define APDS_PDIODE_IR	       0x2
 | |
| 
 | |
| #define APDS990X_LUX_OUTPUT_SCALE 10
 | |
| 
 | |
| /* Reverse chip factors for threshold calculation */
 | |
| struct reverse_factors {
 | |
| 	u32 afactor;
 | |
| 	int cf1;
 | |
| 	int irf1;
 | |
| 	int cf2;
 | |
| 	int irf2;
 | |
| };
 | |
| 
 | |
| struct apds990x_chip {
 | |
| 	struct apds990x_platform_data	*pdata;
 | |
| 	struct i2c_client		*client;
 | |
| 	struct mutex			mutex; /* avoid parallel access */
 | |
| 	struct regulator_bulk_data	regs[2];
 | |
| 	wait_queue_head_t		wait;
 | |
| 
 | |
| 	int	prox_en;
 | |
| 	bool	prox_continuous_mode;
 | |
| 	bool	lux_wait_fresh_res;
 | |
| 
 | |
| 	/* Chip parameters */
 | |
| 	struct	apds990x_chip_factors	cf;
 | |
| 	struct	reverse_factors		rcf;
 | |
| 	u16	atime;		/* als integration time */
 | |
| 	u16	arate;		/* als reporting rate */
 | |
| 	u16	a_max_result;	/* Max possible ADC value with current atime */
 | |
| 	u8	again_meas;	/* Gain used in last measurement */
 | |
| 	u8	again_next;	/* Next calculated gain */
 | |
| 	u8	pgain;
 | |
| 	u8	pdiode;
 | |
| 	u8	pdrive;
 | |
| 	u8	lux_persistence;
 | |
| 	u8	prox_persistence;
 | |
| 
 | |
| 	u32	lux_raw;
 | |
| 	u32	lux;
 | |
| 	u16	lux_clear;
 | |
| 	u16	lux_ir;
 | |
| 	u16	lux_calib;
 | |
| 	u32	lux_thres_hi;
 | |
| 	u32	lux_thres_lo;
 | |
| 
 | |
| 	u32	prox_thres;
 | |
| 	u16	prox_data;
 | |
| 	u16	prox_calib;
 | |
| 
 | |
| 	char	chipname[10];
 | |
| 	u8	revision;
 | |
| };
 | |
| 
 | |
| #define APDS_CALIB_SCALER		8192
 | |
| #define APDS_LUX_NEUTRAL_CALIB_VALUE	(1 * APDS_CALIB_SCALER)
 | |
| #define APDS_PROX_NEUTRAL_CALIB_VALUE	(1 * APDS_CALIB_SCALER)
 | |
| 
 | |
| #define APDS_PROX_DEF_THRES		600
 | |
| #define APDS_PROX_HYSTERESIS		50
 | |
| #define APDS_LUX_DEF_THRES_HI		101
 | |
| #define APDS_LUX_DEF_THRES_LO		100
 | |
| #define APDS_DEFAULT_PROX_PERS		1
 | |
| 
 | |
| #define APDS_TIMEOUT			2000
 | |
| #define APDS_STARTUP_DELAY		25000 /* us */
 | |
| #define APDS_RANGE			65535
 | |
| #define APDS_PROX_RANGE			1023
 | |
| #define APDS_LUX_GAIN_LO_LIMIT		100
 | |
| #define APDS_LUX_GAIN_LO_LIMIT_STRICT	25
 | |
| 
 | |
| #define TIMESTEP			87 /* 2.7ms is about 87 / 32 */
 | |
| #define TIME_STEP_SCALER		32
 | |
| 
 | |
| #define APDS_LUX_AVERAGING_TIME		50 /* tolerates 50/60Hz ripple */
 | |
| #define APDS_LUX_DEFAULT_RATE		200
 | |
| 
 | |
| static const u8 again[]	= {1, 8, 16, 120}; /* ALS gain steps */
 | |
| static const u8 ir_currents[]	= {100, 50, 25, 12}; /* IRled currents in mA */
 | |
| 
 | |
| /* Following two tables must match i.e 10Hz rate means 1 as persistence value */
 | |
| static const u16 arates_hz[] = {10, 5, 2, 1};
 | |
| static const u8 apersis[] = {1, 2, 4, 5};
 | |
| 
 | |
| /* Regulators */
 | |
| static const char reg_vcc[] = "Vdd";
 | |
| static const char reg_vled[] = "Vled";
 | |
| 
 | |
| static int apds990x_read_byte(struct apds990x_chip *chip, u8 reg, u8 *data)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	s32 ret;
 | |
| 
 | |
| 	reg &= ~APDS990x_CMD_TYPE_MASK;
 | |
| 	reg |= APDS990x_CMD | APDS990x_CMD_TYPE_RB;
 | |
| 
 | |
| 	ret = i2c_smbus_read_byte_data(client, reg);
 | |
| 	*data = ret;
 | |
| 	return (int)ret;
 | |
| }
 | |
| 
 | |
| static int apds990x_read_word(struct apds990x_chip *chip, u8 reg, u16 *data)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	s32 ret;
 | |
| 
 | |
| 	reg &= ~APDS990x_CMD_TYPE_MASK;
 | |
| 	reg |= APDS990x_CMD | APDS990x_CMD_TYPE_INC;
 | |
| 
 | |
| 	ret = i2c_smbus_read_word_data(client, reg);
 | |
| 	*data = ret;
 | |
| 	return (int)ret;
 | |
| }
 | |
| 
 | |
| static int apds990x_write_byte(struct apds990x_chip *chip, u8 reg, u8 data)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	s32 ret;
 | |
| 
 | |
| 	reg &= ~APDS990x_CMD_TYPE_MASK;
 | |
| 	reg |= APDS990x_CMD | APDS990x_CMD_TYPE_RB;
 | |
| 
 | |
| 	ret = i2c_smbus_write_byte_data(client, reg, data);
 | |
| 	return (int)ret;
 | |
| }
 | |
| 
 | |
| static int apds990x_write_word(struct apds990x_chip *chip, u8 reg, u16 data)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	s32 ret;
 | |
| 
 | |
| 	reg &= ~APDS990x_CMD_TYPE_MASK;
 | |
| 	reg |= APDS990x_CMD | APDS990x_CMD_TYPE_INC;
 | |
| 
 | |
| 	ret = i2c_smbus_write_word_data(client, reg, data);
 | |
| 	return (int)ret;
 | |
| }
 | |
| 
 | |
| static int apds990x_mode_on(struct apds990x_chip *chip)
 | |
| {
 | |
| 	/* ALS is mandatory, proximity optional */
 | |
| 	u8 reg = APDS990X_EN_AIEN | APDS990X_EN_PON | APDS990X_EN_AEN |
 | |
| 		APDS990X_EN_WEN;
 | |
| 
 | |
| 	if (chip->prox_en)
 | |
| 		reg |= APDS990X_EN_PIEN | APDS990X_EN_PEN;
 | |
| 
 | |
| 	return apds990x_write_byte(chip, APDS990X_ENABLE, reg);
 | |
| }
 | |
| 
 | |
| static u16 apds990x_lux_to_threshold(struct apds990x_chip *chip, u32 lux)
 | |
| {
 | |
| 	u32 thres;
 | |
| 	u32 cpl;
 | |
| 	u32 ir;
 | |
| 
 | |
| 	if (lux == 0)
 | |
| 		return 0;
 | |
| 	else if (lux == APDS_RANGE)
 | |
| 		return APDS_RANGE;
 | |
| 
 | |
| 	/*
 | |
| 	 * Reported LUX value is a combination of the IR and CLEAR channel
 | |
| 	 * values. However, interrupt threshold is only for clear channel.
 | |
| 	 * This function approximates needed HW threshold value for a given
 | |
| 	 * LUX value in the current lightning type.
 | |
| 	 * IR level compared to visible light varies heavily depending on the
 | |
| 	 * source of the light
 | |
| 	 *
 | |
| 	 * Calculate threshold value for the next measurement period.
 | |
| 	 * Math: threshold = lux * cpl where
 | |
| 	 * cpl = atime * again / (glass_attenuation * device_factor)
 | |
| 	 * (count-per-lux)
 | |
| 	 *
 | |
| 	 * First remove calibration. Division by four is to avoid overflow
 | |
| 	 */
 | |
| 	lux = lux * (APDS_CALIB_SCALER / 4) / (chip->lux_calib / 4);
 | |
| 
 | |
| 	/* Multiplication by 64 is to increase accuracy */
 | |
| 	cpl = ((u32)chip->atime * (u32)again[chip->again_next] *
 | |
| 		APDS_PARAM_SCALE * 64) / (chip->cf.ga * chip->cf.df);
 | |
| 
 | |
| 	thres = lux * cpl / 64;
 | |
| 	/*
 | |
| 	 * Convert IR light from the latest result to match with
 | |
| 	 * new gain step. This helps to adapt with the current
 | |
| 	 * source of light.
 | |
| 	 */
 | |
| 	ir = (u32)chip->lux_ir * (u32)again[chip->again_next] /
 | |
| 		(u32)again[chip->again_meas];
 | |
| 
 | |
| 	/*
 | |
| 	 * Compensate count with IR light impact
 | |
| 	 * IAC1 > IAC2 (see apds990x_get_lux for formulas)
 | |
| 	 */
 | |
| 	if (chip->lux_clear * APDS_PARAM_SCALE >=
 | |
| 		chip->rcf.afactor * chip->lux_ir)
 | |
| 		thres = (chip->rcf.cf1 * thres + chip->rcf.irf1 * ir) /
 | |
| 			APDS_PARAM_SCALE;
 | |
| 	else
 | |
| 		thres = (chip->rcf.cf2 * thres + chip->rcf.irf2 * ir) /
 | |
| 			APDS_PARAM_SCALE;
 | |
| 
 | |
| 	if (thres >= chip->a_max_result)
 | |
| 		thres = chip->a_max_result - 1;
 | |
| 	return thres;
 | |
| }
 | |
| 
 | |
| static inline int apds990x_set_atime(struct apds990x_chip *chip, u32 time_ms)
 | |
| {
 | |
| 	u8 reg_value;
 | |
| 
 | |
| 	chip->atime = time_ms;
 | |
| 	/* Formula is specified in the data sheet */
 | |
| 	reg_value = 256 - ((time_ms * TIME_STEP_SCALER) / TIMESTEP);
 | |
| 	/* Calculate max ADC value for given integration time */
 | |
| 	chip->a_max_result = (u16)(256 - reg_value) * APDS990X_TIME_TO_ADC;
 | |
| 	return apds990x_write_byte(chip, APDS990X_ATIME, reg_value);
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static int apds990x_refresh_pthres(struct apds990x_chip *chip, int data)
 | |
| {
 | |
| 	int ret, lo, hi;
 | |
| 
 | |
| 	/* If the chip is not in use, don't try to access it */
 | |
| 	if (pm_runtime_suspended(&chip->client->dev))
 | |
| 		return 0;
 | |
| 
 | |
| 	if (data < chip->prox_thres) {
 | |
| 		lo = 0;
 | |
| 		hi = chip->prox_thres;
 | |
| 	} else {
 | |
| 		lo = chip->prox_thres - APDS_PROX_HYSTERESIS;
 | |
| 		if (chip->prox_continuous_mode)
 | |
| 			hi = chip->prox_thres;
 | |
| 		else
 | |
| 			hi = APDS_RANGE;
 | |
| 	}
 | |
| 
 | |
| 	ret = apds990x_write_word(chip, APDS990X_PILTL, lo);
 | |
| 	ret |= apds990x_write_word(chip, APDS990X_PIHTL, hi);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static int apds990x_refresh_athres(struct apds990x_chip *chip)
 | |
| {
 | |
| 	int ret;
 | |
| 	/* If the chip is not in use, don't try to access it */
 | |
| 	if (pm_runtime_suspended(&chip->client->dev))
 | |
| 		return 0;
 | |
| 
 | |
| 	ret = apds990x_write_word(chip, APDS990X_AILTL,
 | |
| 			apds990x_lux_to_threshold(chip, chip->lux_thres_lo));
 | |
| 	ret |= apds990x_write_word(chip, APDS990X_AIHTL,
 | |
| 			apds990x_lux_to_threshold(chip, chip->lux_thres_hi));
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static void apds990x_force_a_refresh(struct apds990x_chip *chip)
 | |
| {
 | |
| 	/* This will force ALS interrupt after the next measurement. */
 | |
| 	apds990x_write_word(chip, APDS990X_AILTL, APDS_LUX_DEF_THRES_LO);
 | |
| 	apds990x_write_word(chip, APDS990X_AIHTL, APDS_LUX_DEF_THRES_HI);
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static void apds990x_force_p_refresh(struct apds990x_chip *chip)
 | |
| {
 | |
| 	/* This will force proximity interrupt after the next measurement. */
 | |
| 	apds990x_write_word(chip, APDS990X_PILTL, APDS_PROX_DEF_THRES - 1);
 | |
| 	apds990x_write_word(chip, APDS990X_PIHTL, APDS_PROX_DEF_THRES);
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static int apds990x_calc_again(struct apds990x_chip *chip)
 | |
| {
 | |
| 	int curr_again = chip->again_meas;
 | |
| 	int next_again = chip->again_meas;
 | |
| 	int ret = 0;
 | |
| 
 | |
| 	/* Calculate suitable als gain */
 | |
| 	if (chip->lux_clear == chip->a_max_result)
 | |
| 		next_again -= 2; /* ALS saturated. Decrease gain by 2 steps */
 | |
| 	else if (chip->lux_clear > chip->a_max_result / 2)
 | |
| 		next_again--;
 | |
| 	else if (chip->lux_clear < APDS_LUX_GAIN_LO_LIMIT_STRICT)
 | |
| 		next_again += 2; /* Too dark. Increase gain by 2 steps */
 | |
| 	else if (chip->lux_clear < APDS_LUX_GAIN_LO_LIMIT)
 | |
| 		next_again++;
 | |
| 
 | |
| 	/* Limit gain to available range */
 | |
| 	if (next_again < 0)
 | |
| 		next_again = 0;
 | |
| 	else if (next_again > APDS990X_MAX_AGAIN)
 | |
| 		next_again = APDS990X_MAX_AGAIN;
 | |
| 
 | |
| 	/* Let's check can we trust the measured result */
 | |
| 	if (chip->lux_clear == chip->a_max_result)
 | |
| 		/* Result can be totally garbage due to saturation */
 | |
| 		ret = -ERANGE;
 | |
| 	else if (next_again != curr_again &&
 | |
| 		chip->lux_clear < APDS_LUX_GAIN_LO_LIMIT_STRICT)
 | |
| 		/*
 | |
| 		 * Gain is changed and measurement result is very small.
 | |
| 		 * Result can be totally garbage due to underflow
 | |
| 		 */
 | |
| 		ret = -ERANGE;
 | |
| 
 | |
| 	chip->again_next = next_again;
 | |
| 	apds990x_write_byte(chip, APDS990X_CONTROL,
 | |
| 			(chip->pdrive << 6) |
 | |
| 			(chip->pdiode << 4) |
 | |
| 			(chip->pgain << 2) |
 | |
| 			(chip->again_next << 0));
 | |
| 
 | |
| 	/*
 | |
| 	 * Error means bad result -> re-measurement is needed. The forced
 | |
| 	 * refresh uses fastest possible persistence setting to get result
 | |
| 	 * as soon as possible.
 | |
| 	 */
 | |
| 	if (ret < 0)
 | |
| 		apds990x_force_a_refresh(chip);
 | |
| 	else
 | |
| 		apds990x_refresh_athres(chip);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| /* Called always with mutex locked */
 | |
| static int apds990x_get_lux(struct apds990x_chip *chip, int clear, int ir)
 | |
| {
 | |
| 	int iac, iac1, iac2; /* IR adjusted counts */
 | |
| 	u32 lpc; /* Lux per count */
 | |
| 
 | |
| 	/* Formulas:
 | |
| 	 * iac1 = CF1 * CLEAR_CH - IRF1 * IR_CH
 | |
| 	 * iac2 = CF2 * CLEAR_CH - IRF2 * IR_CH
 | |
| 	 */
 | |
| 	iac1 = (chip->cf.cf1 * clear - chip->cf.irf1 * ir) / APDS_PARAM_SCALE;
 | |
| 	iac2 = (chip->cf.cf2 * clear - chip->cf.irf2 * ir) / APDS_PARAM_SCALE;
 | |
| 
 | |
| 	iac = max(iac1, iac2);
 | |
| 	iac = max(iac, 0);
 | |
| 
 | |
| 	lpc = APDS990X_LUX_OUTPUT_SCALE * (chip->cf.df * chip->cf.ga) /
 | |
| 		(u32)(again[chip->again_meas] * (u32)chip->atime);
 | |
| 
 | |
| 	return (iac * lpc) / APDS_PARAM_SCALE;
 | |
| }
 | |
| 
 | |
| static int apds990x_ack_int(struct apds990x_chip *chip, u8 mode)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	s32 ret;
 | |
| 	u8 reg = APDS990x_CMD | APDS990x_CMD_TYPE_SPE;
 | |
| 
 | |
| 	switch (mode & (APDS990X_ST_AINT | APDS990X_ST_PINT)) {
 | |
| 	case APDS990X_ST_AINT:
 | |
| 		reg |= APDS990X_INT_ACK_ALS;
 | |
| 		break;
 | |
| 	case APDS990X_ST_PINT:
 | |
| 		reg |= APDS990X_INT_ACK_PS;
 | |
| 		break;
 | |
| 	default:
 | |
| 		reg |= APDS990X_INT_ACK_BOTH;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	ret = i2c_smbus_read_byte_data(client, reg);
 | |
| 	return (int)ret;
 | |
| }
 | |
| 
 | |
| static irqreturn_t apds990x_irq(int irq, void *data)
 | |
| {
 | |
| 	struct apds990x_chip *chip = data;
 | |
| 	u8 status;
 | |
| 
 | |
| 	apds990x_read_byte(chip, APDS990X_STATUS, &status);
 | |
| 	apds990x_ack_int(chip, status);
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	if (!pm_runtime_suspended(&chip->client->dev)) {
 | |
| 		if (status & APDS990X_ST_AINT) {
 | |
| 			apds990x_read_word(chip, APDS990X_CDATAL,
 | |
| 					&chip->lux_clear);
 | |
| 			apds990x_read_word(chip, APDS990X_IRDATAL,
 | |
| 					&chip->lux_ir);
 | |
| 			/* Store used gain for calculations */
 | |
| 			chip->again_meas = chip->again_next;
 | |
| 
 | |
| 			chip->lux_raw = apds990x_get_lux(chip,
 | |
| 							chip->lux_clear,
 | |
| 							chip->lux_ir);
 | |
| 
 | |
| 			if (apds990x_calc_again(chip) == 0) {
 | |
| 				/* Result is valid */
 | |
| 				chip->lux = chip->lux_raw;
 | |
| 				chip->lux_wait_fresh_res = false;
 | |
| 				wake_up(&chip->wait);
 | |
| 				sysfs_notify(&chip->client->dev.kobj,
 | |
| 					NULL, "lux0_input");
 | |
| 			}
 | |
| 		}
 | |
| 
 | |
| 		if ((status & APDS990X_ST_PINT) && chip->prox_en) {
 | |
| 			u16 clr_ch;
 | |
| 
 | |
| 			apds990x_read_word(chip, APDS990X_CDATAL, &clr_ch);
 | |
| 			/*
 | |
| 			 * If ALS channel is saturated at min gain,
 | |
| 			 * proximity gives false posivite values.
 | |
| 			 * Just ignore them.
 | |
| 			 */
 | |
| 			if (chip->again_meas == 0 &&
 | |
| 				clr_ch == chip->a_max_result)
 | |
| 				chip->prox_data = 0;
 | |
| 			else
 | |
| 				apds990x_read_word(chip,
 | |
| 						APDS990X_PDATAL,
 | |
| 						&chip->prox_data);
 | |
| 
 | |
| 			apds990x_refresh_pthres(chip, chip->prox_data);
 | |
| 			if (chip->prox_data < chip->prox_thres)
 | |
| 				chip->prox_data = 0;
 | |
| 			else if (!chip->prox_continuous_mode)
 | |
| 				chip->prox_data = APDS_PROX_RANGE;
 | |
| 			sysfs_notify(&chip->client->dev.kobj,
 | |
| 				NULL, "prox0_raw");
 | |
| 		}
 | |
| 	}
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return IRQ_HANDLED;
 | |
| }
 | |
| 
 | |
| static int apds990x_configure(struct apds990x_chip *chip)
 | |
| {
 | |
| 	/* It is recommended to use disabled mode during these operations */
 | |
| 	apds990x_write_byte(chip, APDS990X_ENABLE, APDS990X_EN_DISABLE_ALL);
 | |
| 
 | |
| 	/* conversion and wait times for different state machince states */
 | |
| 	apds990x_write_byte(chip, APDS990X_PTIME, APDS990X_PTIME_DEFAULT);
 | |
| 	apds990x_write_byte(chip, APDS990X_WTIME, APDS990X_WTIME_DEFAULT);
 | |
| 	apds990x_set_atime(chip, APDS_LUX_AVERAGING_TIME);
 | |
| 
 | |
| 	apds990x_write_byte(chip, APDS990X_CONFIG, 0);
 | |
| 
 | |
| 	/* Persistence levels */
 | |
| 	apds990x_write_byte(chip, APDS990X_PERS,
 | |
| 			(chip->lux_persistence << APDS990X_APERS_SHIFT) |
 | |
| 			(chip->prox_persistence << APDS990X_PPERS_SHIFT));
 | |
| 
 | |
| 	apds990x_write_byte(chip, APDS990X_PPCOUNT, chip->pdata->ppcount);
 | |
| 
 | |
| 	/* Start with relatively small gain */
 | |
| 	chip->again_meas = 1;
 | |
| 	chip->again_next = 1;
 | |
| 	apds990x_write_byte(chip, APDS990X_CONTROL,
 | |
| 			(chip->pdrive << 6) |
 | |
| 			(chip->pdiode << 4) |
 | |
| 			(chip->pgain << 2) |
 | |
| 			(chip->again_next << 0));
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int apds990x_detect(struct apds990x_chip *chip)
 | |
| {
 | |
| 	struct i2c_client *client = chip->client;
 | |
| 	int ret;
 | |
| 	u8 id;
 | |
| 
 | |
| 	ret = apds990x_read_byte(chip, APDS990X_ID, &id);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(&client->dev, "ID read failed\n");
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	ret = apds990x_read_byte(chip, APDS990X_REV, &chip->revision);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(&client->dev, "REV read failed\n");
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	switch (id) {
 | |
| 	case APDS990X_ID_0:
 | |
| 	case APDS990X_ID_4:
 | |
| 	case APDS990X_ID_29:
 | |
| 		snprintf(chip->chipname, sizeof(chip->chipname), "APDS-990x");
 | |
| 		break;
 | |
| 	default:
 | |
| 		ret = -ENODEV;
 | |
| 		break;
 | |
| 	}
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| #if defined(CONFIG_PM) || defined(CONFIG_PM_RUNTIME)
 | |
| static int apds990x_chip_on(struct apds990x_chip *chip)
 | |
| {
 | |
| 	int err	 = regulator_bulk_enable(ARRAY_SIZE(chip->regs),
 | |
| 					chip->regs);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
| 	usleep_range(APDS_STARTUP_DELAY, 2 * APDS_STARTUP_DELAY);
 | |
| 
 | |
| 	/* Refresh all configs in case of regulators were off */
 | |
| 	chip->prox_data = 0;
 | |
| 	apds990x_configure(chip);
 | |
| 	apds990x_mode_on(chip);
 | |
| 	return 0;
 | |
| }
 | |
| #endif
 | |
| 
 | |
| static int apds990x_chip_off(struct apds990x_chip *chip)
 | |
| {
 | |
| 	apds990x_write_byte(chip, APDS990X_ENABLE, APDS990X_EN_DISABLE_ALL);
 | |
| 	regulator_bulk_disable(ARRAY_SIZE(chip->regs), chip->regs);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_lux_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip = dev_get_drvdata(dev);
 | |
| 	ssize_t ret;
 | |
| 	u32 result;
 | |
| 	long timeout;
 | |
| 
 | |
| 	if (pm_runtime_suspended(dev))
 | |
| 		return -EIO;
 | |
| 
 | |
| 	timeout = wait_event_interruptible_timeout(chip->wait,
 | |
| 						!chip->lux_wait_fresh_res,
 | |
| 						msecs_to_jiffies(APDS_TIMEOUT));
 | |
| 	if (!timeout)
 | |
| 		return -EIO;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	result = (chip->lux * chip->lux_calib) / APDS_CALIB_SCALER;
 | |
| 	if (result > (APDS_RANGE * APDS990X_LUX_OUTPUT_SCALE))
 | |
| 		result = APDS_RANGE * APDS990X_LUX_OUTPUT_SCALE;
 | |
| 
 | |
| 	ret = sprintf(buf, "%d.%d\n",
 | |
| 		result / APDS990X_LUX_OUTPUT_SCALE,
 | |
| 		result % APDS990X_LUX_OUTPUT_SCALE);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_input, S_IRUGO, apds990x_lux_show, NULL);
 | |
| 
 | |
| static ssize_t apds990x_lux_range_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	return sprintf(buf, "%u\n", APDS_RANGE);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_sensor_range, S_IRUGO, apds990x_lux_range_show, NULL);
 | |
| 
 | |
| static ssize_t apds990x_lux_calib_format_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	return sprintf(buf, "%u\n", APDS_CALIB_SCALER);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_calibscale_default, S_IRUGO,
 | |
| 		apds990x_lux_calib_format_show, NULL);
 | |
| 
 | |
| static ssize_t apds990x_lux_calib_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip = dev_get_drvdata(dev);
 | |
| 
 | |
| 	return sprintf(buf, "%u\n", chip->lux_calib);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_lux_calib_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip = dev_get_drvdata(dev);
 | |
| 	unsigned long value;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &value))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (chip->lux_calib > APDS_RANGE)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	chip->lux_calib = value;
 | |
| 
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_calibscale, S_IRUGO | S_IWUSR, apds990x_lux_calib_show,
 | |
| 		apds990x_lux_calib_store);
 | |
| 
 | |
| static ssize_t apds990x_rate_avail(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	int i;
 | |
| 	int pos = 0;
 | |
| 	for (i = 0; i < ARRAY_SIZE(arates_hz); i++)
 | |
| 		pos += sprintf(buf + pos, "%d ", arates_hz[i]);
 | |
| 	sprintf(buf + pos - 1, "\n");
 | |
| 	return pos;
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_rate_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%d\n", chip->arate);
 | |
| }
 | |
| 
 | |
| static int apds990x_set_arate(struct apds990x_chip *chip, int rate)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(arates_hz); i++)
 | |
| 		if (rate >= arates_hz[i])
 | |
| 			break;
 | |
| 
 | |
| 	if (i == ARRAY_SIZE(arates_hz))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	/* Pick up corresponding persistence value */
 | |
| 	chip->lux_persistence = apersis[i];
 | |
| 	chip->arate = arates_hz[i];
 | |
| 
 | |
| 	/* If the chip is not in use, don't try to access it */
 | |
| 	if (pm_runtime_suspended(&chip->client->dev))
 | |
| 		return 0;
 | |
| 
 | |
| 	/* Persistence levels */
 | |
| 	return apds990x_write_byte(chip, APDS990X_PERS,
 | |
| 			(chip->lux_persistence << APDS990X_APERS_SHIFT) |
 | |
| 			(chip->prox_persistence << APDS990X_PPERS_SHIFT));
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_rate_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	unsigned long value;
 | |
| 	int ret;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &value))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	ret = apds990x_set_arate(chip, value);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_rate_avail, S_IRUGO, apds990x_rate_avail, NULL);
 | |
| 
 | |
| static DEVICE_ATTR(lux0_rate, S_IRUGO | S_IWUSR, apds990x_rate_show,
 | |
| 						 apds990x_rate_store);
 | |
| 
 | |
| static ssize_t apds990x_prox_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	ssize_t ret;
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	if (pm_runtime_suspended(dev) || !chip->prox_en)
 | |
| 		return -EIO;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	ret = sprintf(buf, "%d\n", chip->prox_data);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_raw, S_IRUGO, apds990x_prox_show, NULL);
 | |
| 
 | |
| static ssize_t apds990x_prox_range_show(struct device *dev,
 | |
| 				 struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	return sprintf(buf, "%u\n", APDS_PROX_RANGE);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_sensor_range, S_IRUGO, apds990x_prox_range_show, NULL);
 | |
| 
 | |
| static ssize_t apds990x_prox_enable_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%d\n", chip->prox_en);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_prox_enable_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	unsigned long value;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &value))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 
 | |
| 	if (!chip->prox_en)
 | |
| 		chip->prox_data = 0;
 | |
| 
 | |
| 	if (value)
 | |
| 		chip->prox_en++;
 | |
| 	else if (chip->prox_en > 0)
 | |
| 		chip->prox_en--;
 | |
| 
 | |
| 	if (!pm_runtime_suspended(dev))
 | |
| 		apds990x_mode_on(chip);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_raw_en, S_IRUGO | S_IWUSR, apds990x_prox_enable_show,
 | |
| 						   apds990x_prox_enable_store);
 | |
| 
 | |
| static const char reporting_modes[][9] = {"trigger", "periodic"};
 | |
| 
 | |
| static ssize_t apds990x_prox_reporting_mode_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%s\n",
 | |
| 		reporting_modes[!!chip->prox_continuous_mode]);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_prox_reporting_mode_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 
 | |
| 	if (sysfs_streq(buf, reporting_modes[0]))
 | |
| 		chip->prox_continuous_mode = 0;
 | |
| 	else if (sysfs_streq(buf, reporting_modes[1]))
 | |
| 		chip->prox_continuous_mode = 1;
 | |
| 	else
 | |
| 		return -EINVAL;
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_reporting_mode, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_prox_reporting_mode_show,
 | |
| 		apds990x_prox_reporting_mode_store);
 | |
| 
 | |
| static ssize_t apds990x_prox_reporting_avail_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	return sprintf(buf, "%s %s\n", reporting_modes[0], reporting_modes[1]);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_reporting_mode_avail, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_prox_reporting_avail_show, NULL);
 | |
| 
 | |
| 
 | |
| static ssize_t apds990x_lux_thresh_above_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%d\n", chip->lux_thres_hi);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_lux_thresh_below_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%d\n", chip->lux_thres_lo);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_set_lux_thresh(struct apds990x_chip *chip, u32 *target,
 | |
| 				const char *buf)
 | |
| {
 | |
| 	int ret = 0;
 | |
| 	unsigned long thresh;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &thresh))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (thresh > APDS_RANGE)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	*target = thresh;
 | |
| 	/*
 | |
| 	 * Don't update values in HW if we are still waiting for
 | |
| 	 * first interrupt to come after device handle open call.
 | |
| 	 */
 | |
| 	if (!chip->lux_wait_fresh_res)
 | |
| 		apds990x_refresh_athres(chip);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return ret;
 | |
| 
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_lux_thresh_above_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	int ret = apds990x_set_lux_thresh(chip, &chip->lux_thres_hi, buf);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_lux_thresh_below_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	int ret = apds990x_set_lux_thresh(chip, &chip->lux_thres_lo, buf);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(lux0_thresh_above_value, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_lux_thresh_above_show,
 | |
| 		apds990x_lux_thresh_above_store);
 | |
| 
 | |
| static DEVICE_ATTR(lux0_thresh_below_value, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_lux_thresh_below_show,
 | |
| 		apds990x_lux_thresh_below_store);
 | |
| 
 | |
| static ssize_t apds990x_prox_threshold_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%d\n", chip->prox_thres);
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_prox_threshold_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	unsigned long value;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &value))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if ((value > APDS_RANGE) || (value == 0) ||
 | |
| 		(value < APDS_PROX_HYSTERESIS))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	mutex_lock(&chip->mutex);
 | |
| 	chip->prox_thres = value;
 | |
| 
 | |
| 	apds990x_force_p_refresh(chip);
 | |
| 	mutex_unlock(&chip->mutex);
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(prox0_thresh_above_value, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_prox_threshold_show,
 | |
| 		apds990x_prox_threshold_store);
 | |
| 
 | |
| static ssize_t apds990x_power_state_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	return sprintf(buf, "%d\n", !pm_runtime_suspended(dev));
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static ssize_t apds990x_power_state_store(struct device *dev,
 | |
| 				  struct device_attribute *attr,
 | |
| 				  const char *buf, size_t len)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	unsigned long value;
 | |
| 
 | |
| 	if (strict_strtoul(buf, 0, &value))
 | |
| 		return -EINVAL;
 | |
| 	if (value) {
 | |
| 		pm_runtime_get_sync(dev);
 | |
| 		mutex_lock(&chip->mutex);
 | |
| 		chip->lux_wait_fresh_res = true;
 | |
| 		apds990x_force_a_refresh(chip);
 | |
| 		apds990x_force_p_refresh(chip);
 | |
| 		mutex_unlock(&chip->mutex);
 | |
| 	} else {
 | |
| 		if (!pm_runtime_suspended(dev))
 | |
| 			pm_runtime_put(dev);
 | |
| 	}
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(power_state, S_IRUGO | S_IWUSR,
 | |
| 		apds990x_power_state_show,
 | |
| 		apds990x_power_state_store);
 | |
| 
 | |
| static ssize_t apds990x_chip_id_show(struct device *dev,
 | |
| 				   struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct apds990x_chip *chip =  dev_get_drvdata(dev);
 | |
| 	return sprintf(buf, "%s %d\n", chip->chipname, chip->revision);
 | |
| }
 | |
| 
 | |
| static DEVICE_ATTR(chip_id, S_IRUGO, apds990x_chip_id_show, NULL);
 | |
| 
 | |
| static struct attribute *sysfs_attrs_ctrl[] = {
 | |
| 	&dev_attr_lux0_calibscale.attr,
 | |
| 	&dev_attr_lux0_calibscale_default.attr,
 | |
| 	&dev_attr_lux0_input.attr,
 | |
| 	&dev_attr_lux0_sensor_range.attr,
 | |
| 	&dev_attr_lux0_rate.attr,
 | |
| 	&dev_attr_lux0_rate_avail.attr,
 | |
| 	&dev_attr_lux0_thresh_above_value.attr,
 | |
| 	&dev_attr_lux0_thresh_below_value.attr,
 | |
| 	&dev_attr_prox0_raw_en.attr,
 | |
| 	&dev_attr_prox0_raw.attr,
 | |
| 	&dev_attr_prox0_sensor_range.attr,
 | |
| 	&dev_attr_prox0_thresh_above_value.attr,
 | |
| 	&dev_attr_prox0_reporting_mode.attr,
 | |
| 	&dev_attr_prox0_reporting_mode_avail.attr,
 | |
| 	&dev_attr_chip_id.attr,
 | |
| 	&dev_attr_power_state.attr,
 | |
| 	NULL
 | |
| };
 | |
| 
 | |
| static struct attribute_group apds990x_attribute_group[] = {
 | |
| 	{.attrs = sysfs_attrs_ctrl },
 | |
| };
 | |
| 
 | |
| static int __devinit apds990x_probe(struct i2c_client *client,
 | |
| 				const struct i2c_device_id *id)
 | |
| {
 | |
| 	struct apds990x_chip *chip;
 | |
| 	int err;
 | |
| 
 | |
| 	chip = kzalloc(sizeof *chip, GFP_KERNEL);
 | |
| 	if (!chip)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	i2c_set_clientdata(client, chip);
 | |
| 	chip->client  = client;
 | |
| 
 | |
| 	init_waitqueue_head(&chip->wait);
 | |
| 	mutex_init(&chip->mutex);
 | |
| 	chip->pdata	= client->dev.platform_data;
 | |
| 
 | |
| 	if (chip->pdata == NULL) {
 | |
| 		dev_err(&client->dev, "platform data is mandatory\n");
 | |
| 		err = -EINVAL;
 | |
| 		goto fail1;
 | |
| 	}
 | |
| 
 | |
| 	if (chip->pdata->cf.ga == 0) {
 | |
| 		/* set uncovered sensor default parameters */
 | |
| 		chip->cf.ga = 1966; /* 0.48 * APDS_PARAM_SCALE */
 | |
| 		chip->cf.cf1 = 4096; /* 1.00 * APDS_PARAM_SCALE */
 | |
| 		chip->cf.irf1 = 9134; /* 2.23 * APDS_PARAM_SCALE */
 | |
| 		chip->cf.cf2 = 2867; /* 0.70 * APDS_PARAM_SCALE */
 | |
| 		chip->cf.irf2 = 5816; /* 1.42 * APDS_PARAM_SCALE */
 | |
| 		chip->cf.df = 52;
 | |
| 	} else {
 | |
| 		chip->cf = chip->pdata->cf;
 | |
| 	}
 | |
| 
 | |
| 	/* precalculate inverse chip factors for threshold control */
 | |
| 	chip->rcf.afactor =
 | |
| 		(chip->cf.irf1 - chip->cf.irf2) * APDS_PARAM_SCALE /
 | |
| 		(chip->cf.cf1 - chip->cf.cf2);
 | |
| 	chip->rcf.cf1 = APDS_PARAM_SCALE * APDS_PARAM_SCALE /
 | |
| 		chip->cf.cf1;
 | |
| 	chip->rcf.irf1 = chip->cf.irf1 * APDS_PARAM_SCALE /
 | |
| 		chip->cf.cf1;
 | |
| 	chip->rcf.cf2 = APDS_PARAM_SCALE * APDS_PARAM_SCALE /
 | |
| 		chip->cf.cf2;
 | |
| 	chip->rcf.irf2 = chip->cf.irf2 * APDS_PARAM_SCALE /
 | |
| 		chip->cf.cf2;
 | |
| 
 | |
| 	/* Set something to start with */
 | |
| 	chip->lux_thres_hi = APDS_LUX_DEF_THRES_HI;
 | |
| 	chip->lux_thres_lo = APDS_LUX_DEF_THRES_LO;
 | |
| 	chip->lux_calib = APDS_LUX_NEUTRAL_CALIB_VALUE;
 | |
| 
 | |
| 	chip->prox_thres = APDS_PROX_DEF_THRES;
 | |
| 	chip->pdrive = chip->pdata->pdrive;
 | |
| 	chip->pdiode = APDS_PDIODE_IR;
 | |
| 	chip->pgain = APDS_PGAIN_1X;
 | |
| 	chip->prox_calib = APDS_PROX_NEUTRAL_CALIB_VALUE;
 | |
| 	chip->prox_persistence = APDS_DEFAULT_PROX_PERS;
 | |
| 	chip->prox_continuous_mode = false;
 | |
| 
 | |
| 	chip->regs[0].supply = reg_vcc;
 | |
| 	chip->regs[1].supply = reg_vled;
 | |
| 
 | |
| 	err = regulator_bulk_get(&client->dev,
 | |
| 				 ARRAY_SIZE(chip->regs), chip->regs);
 | |
| 	if (err < 0) {
 | |
| 		dev_err(&client->dev, "Cannot get regulators\n");
 | |
| 		goto fail1;
 | |
| 	}
 | |
| 
 | |
| 	err = regulator_bulk_enable(ARRAY_SIZE(chip->regs), chip->regs);
 | |
| 	if (err < 0) {
 | |
| 		dev_err(&client->dev, "Cannot enable regulators\n");
 | |
| 		goto fail2;
 | |
| 	}
 | |
| 
 | |
| 	usleep_range(APDS_STARTUP_DELAY, 2 * APDS_STARTUP_DELAY);
 | |
| 
 | |
| 	err = apds990x_detect(chip);
 | |
| 	if (err < 0) {
 | |
| 		dev_err(&client->dev, "APDS990X not found\n");
 | |
| 		goto fail3;
 | |
| 	}
 | |
| 
 | |
| 	pm_runtime_set_active(&client->dev);
 | |
| 
 | |
| 	apds990x_configure(chip);
 | |
| 	apds990x_set_arate(chip, APDS_LUX_DEFAULT_RATE);
 | |
| 	apds990x_mode_on(chip);
 | |
| 
 | |
| 	pm_runtime_enable(&client->dev);
 | |
| 
 | |
| 	if (chip->pdata->setup_resources) {
 | |
| 		err = chip->pdata->setup_resources();
 | |
| 		if (err) {
 | |
| 			err = -EINVAL;
 | |
| 			goto fail3;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	err = sysfs_create_group(&chip->client->dev.kobj,
 | |
| 				apds990x_attribute_group);
 | |
| 	if (err < 0) {
 | |
| 		dev_err(&chip->client->dev, "Sysfs registration failed\n");
 | |
| 		goto fail4;
 | |
| 	}
 | |
| 
 | |
| 	err = request_threaded_irq(client->irq, NULL,
 | |
| 				apds990x_irq,
 | |
| 				IRQF_TRIGGER_FALLING | IRQF_TRIGGER_LOW |
 | |
| 				IRQF_ONESHOT,
 | |
| 				"apds990x", chip);
 | |
| 	if (err) {
 | |
| 		dev_err(&client->dev, "could not get IRQ %d\n",
 | |
| 			client->irq);
 | |
| 		goto fail5;
 | |
| 	}
 | |
| 	return err;
 | |
| fail5:
 | |
| 	sysfs_remove_group(&chip->client->dev.kobj,
 | |
| 			&apds990x_attribute_group[0]);
 | |
| fail4:
 | |
| 	if (chip->pdata && chip->pdata->release_resources)
 | |
| 		chip->pdata->release_resources();
 | |
| fail3:
 | |
| 	regulator_bulk_disable(ARRAY_SIZE(chip->regs), chip->regs);
 | |
| fail2:
 | |
| 	regulator_bulk_free(ARRAY_SIZE(chip->regs), chip->regs);
 | |
| fail1:
 | |
| 	kfree(chip);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int __devexit apds990x_remove(struct i2c_client *client)
 | |
| {
 | |
| 	struct apds990x_chip *chip = i2c_get_clientdata(client);
 | |
| 
 | |
| 	free_irq(client->irq, chip);
 | |
| 	sysfs_remove_group(&chip->client->dev.kobj,
 | |
| 			apds990x_attribute_group);
 | |
| 
 | |
| 	if (chip->pdata && chip->pdata->release_resources)
 | |
| 		chip->pdata->release_resources();
 | |
| 
 | |
| 	if (!pm_runtime_suspended(&client->dev))
 | |
| 		apds990x_chip_off(chip);
 | |
| 
 | |
| 	pm_runtime_disable(&client->dev);
 | |
| 	pm_runtime_set_suspended(&client->dev);
 | |
| 
 | |
| 	regulator_bulk_free(ARRAY_SIZE(chip->regs), chip->regs);
 | |
| 
 | |
| 	kfree(chip);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| static int apds990x_suspend(struct device *dev)
 | |
| {
 | |
| 	struct i2c_client *client = container_of(dev, struct i2c_client, dev);
 | |
| 	struct apds990x_chip *chip = i2c_get_clientdata(client);
 | |
| 
 | |
| 	apds990x_chip_off(chip);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int apds990x_resume(struct device *dev)
 | |
| {
 | |
| 	struct i2c_client *client = container_of(dev, struct i2c_client, dev);
 | |
| 	struct apds990x_chip *chip = i2c_get_clientdata(client);
 | |
| 
 | |
| 	/*
 | |
| 	 * If we were enabled at suspend time, it is expected
 | |
| 	 * everything works nice and smoothly. Chip_on is enough
 | |
| 	 */
 | |
| 	apds990x_chip_on(chip);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| #else
 | |
| #define apds990x_suspend  NULL
 | |
| #define apds990x_resume	  NULL
 | |
| #define apds990x_shutdown NULL
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_PM_RUNTIME
 | |
| static int apds990x_runtime_suspend(struct device *dev)
 | |
| {
 | |
| 	struct i2c_client *client = container_of(dev, struct i2c_client, dev);
 | |
| 	struct apds990x_chip *chip = i2c_get_clientdata(client);
 | |
| 
 | |
| 	apds990x_chip_off(chip);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int apds990x_runtime_resume(struct device *dev)
 | |
| {
 | |
| 	struct i2c_client *client = container_of(dev, struct i2c_client, dev);
 | |
| 	struct apds990x_chip *chip = i2c_get_clientdata(client);
 | |
| 
 | |
| 	apds990x_chip_on(chip);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| static const struct i2c_device_id apds990x_id[] = {
 | |
| 	{"apds990x", 0 },
 | |
| 	{}
 | |
| };
 | |
| 
 | |
| MODULE_DEVICE_TABLE(i2c, apds990x_id);
 | |
| 
 | |
| static const struct dev_pm_ops apds990x_pm_ops = {
 | |
| 	SET_SYSTEM_SLEEP_PM_OPS(apds990x_suspend, apds990x_resume)
 | |
| 	SET_RUNTIME_PM_OPS(apds990x_runtime_suspend,
 | |
| 			apds990x_runtime_resume,
 | |
| 			NULL)
 | |
| };
 | |
| 
 | |
| static struct i2c_driver apds990x_driver = {
 | |
| 	.driver	 = {
 | |
| 		.name	= "apds990x",
 | |
| 		.owner	= THIS_MODULE,
 | |
| 		.pm	= &apds990x_pm_ops,
 | |
| 	},
 | |
| 	.probe	  = apds990x_probe,
 | |
| 	.remove	  = __devexit_p(apds990x_remove),
 | |
| 	.id_table = apds990x_id,
 | |
| };
 | |
| 
 | |
| static int __init apds990x_init(void)
 | |
| {
 | |
| 	return i2c_add_driver(&apds990x_driver);
 | |
| }
 | |
| 
 | |
| static void __exit apds990x_exit(void)
 | |
| {
 | |
| 	i2c_del_driver(&apds990x_driver);
 | |
| }
 | |
| 
 | |
| MODULE_DESCRIPTION("APDS990X combined ALS and proximity sensor");
 | |
| MODULE_AUTHOR("Samu Onkalo, Nokia Corporation");
 | |
| MODULE_LICENSE("GPL v2");
 | |
| 
 | |
| module_init(apds990x_init);
 | |
| module_exit(apds990x_exit);
 |