12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289 |
- #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>
- #define APDS990X_ENABLE 0x00
- #define APDS990X_ATIME 0x01
- #define APDS990X_PTIME 0x02
- #define APDS990X_WTIME 0x03
- #define APDS990X_AILTL 0x04
- #define APDS990X_AILTH 0x05
- #define APDS990X_AIHTL 0x06
- #define APDS990X_AIHTH 0x07
- #define APDS990X_PILTL 0x08
- #define APDS990X_PILTH 0x09
- #define APDS990X_PIHTL 0x0a
- #define APDS990X_PIHTH 0x0b
- #define APDS990X_PERS 0x0c
- #define APDS990X_CONFIG 0x0d
- #define APDS990X_PPCOUNT 0x0e
- #define APDS990X_CONTROL 0x0f
- #define APDS990X_REV 0x11
- #define APDS990X_ID 0x12
- #define APDS990X_STATUS 0x13
- #define APDS990X_CDATAL 0x14
- #define APDS990X_CDATAH 0x15
- #define APDS990X_IRDATAL 0x16
- #define APDS990X_IRDATAH 0x17
- #define APDS990X_PDATAL 0x18
- #define APDS990X_PDATAH 0x19
- #define APDS990X_MAX_AGAIN 3
- #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
- #define APDS990X_ST_PINT (0x1 << 5)
- #define APDS990X_ST_AINT (0x1 << 4)
- #define APDS990x_CMD_TYPE_MASK (0x03 << 5)
- #define APDS990x_CMD_TYPE_RB (0x00 << 5)
- #define APDS990x_CMD_TYPE_INC (0x01 << 5)
- #define APDS990x_CMD_TYPE_SPE (0x03 << 5)
- #define APDS990x_ADDR_SHIFT 0
- #define APDS990x_CMD 0x80
- #define APDS990X_INT_ACK_ALS 0x6
- #define APDS990X_INT_ACK_PS 0x5
- #define APDS990X_INT_ACK_BOTH 0x7
- #define APDS990X_PTIME_DEFAULT 0xff
- #define APDS990X_WTIME_DEFAULT 0xee
- #define APDS990X_TIME_TO_ADC 1024
- #define APDS990X_APERS_SHIFT 0
- #define APDS990X_PPERS_SHIFT 4
- #define APDS990X_ID_0 0x0
- #define APDS990X_ID_4 0x4
- #define APDS990X_ID_29 0x29
- #define APDS_PGAIN_1X 0x0
- #define APDS_PDIODE_IR 0x2
- #define APDS990X_LUX_OUTPUT_SCALE 10
- 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;
- struct regulator_bulk_data regs[2];
- wait_queue_head_t wait;
- int prox_en;
- bool prox_continuous_mode;
- bool lux_wait_fresh_res;
-
- struct apds990x_chip_factors cf;
- struct reverse_factors rcf;
- u16 atime;
- u16 arate;
- u16 a_max_result;
- u8 again_meas;
- u8 again_next;
- 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
- #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
- #define TIME_STEP_SCALER 32
- #define APDS_LUX_AVERAGING_TIME 50
- #define APDS_LUX_DEFAULT_RATE 200
- static const u8 again[] = {1, 8, 16, 120};
- static const u8 ir_currents[] = {100, 50, 25, 12};
- static const u16 arates_hz[] = {10, 5, 2, 1};
- static const u8 apersis[] = {1, 2, 4, 5};
- 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)
- {
-
- 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;
-
- lux = lux * (APDS_CALIB_SCALER / 4) / (chip->lux_calib / 4);
-
- cpl = ((u32)chip->atime * (u32)again[chip->again_next] *
- APDS_PARAM_SCALE * 64) / (chip->cf.ga * chip->cf.df);
- thres = lux * cpl / 64;
-
- ir = (u32)chip->lux_ir * (u32)again[chip->again_next] /
- (u32)again[chip->again_meas];
-
- 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;
-
- reg_value = 256 - ((time_ms * TIME_STEP_SCALER) / TIMESTEP);
-
- chip->a_max_result = (u16)(256 - reg_value) * APDS990X_TIME_TO_ADC;
- return apds990x_write_byte(chip, APDS990X_ATIME, reg_value);
- }
- static int apds990x_refresh_pthres(struct apds990x_chip *chip, int data)
- {
- int ret, lo, hi;
-
- 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;
- }
- static int apds990x_refresh_athres(struct apds990x_chip *chip)
- {
- int ret;
-
- 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;
- }
- static void apds990x_force_a_refresh(struct apds990x_chip *chip)
- {
-
- apds990x_write_word(chip, APDS990X_AILTL, APDS_LUX_DEF_THRES_LO);
- apds990x_write_word(chip, APDS990X_AIHTL, APDS_LUX_DEF_THRES_HI);
- }
- static void apds990x_force_p_refresh(struct apds990x_chip *chip)
- {
-
- apds990x_write_word(chip, APDS990X_PILTL, APDS_PROX_DEF_THRES - 1);
- apds990x_write_word(chip, APDS990X_PIHTL, APDS_PROX_DEF_THRES);
- }
- static int apds990x_calc_again(struct apds990x_chip *chip)
- {
- int curr_again = chip->again_meas;
- int next_again = chip->again_meas;
- int ret = 0;
-
- if (chip->lux_clear == chip->a_max_result)
- next_again -= 2;
- 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;
- else if (chip->lux_clear < APDS_LUX_GAIN_LO_LIMIT)
- next_again++;
-
- if (next_again < 0)
- next_again = 0;
- else if (next_again > APDS990X_MAX_AGAIN)
- next_again = APDS990X_MAX_AGAIN;
-
- if (chip->lux_clear == chip->a_max_result)
-
- ret = -ERANGE;
- else if (next_again != curr_again &&
- chip->lux_clear < APDS_LUX_GAIN_LO_LIMIT_STRICT)
-
- 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));
-
- if (ret < 0)
- apds990x_force_a_refresh(chip);
- else
- apds990x_refresh_athres(chip);
- return ret;
- }
- static int apds990x_get_lux(struct apds990x_chip *chip, int clear, int ir)
- {
- int iac, iac1, iac2;
- u32 lpc;
-
- 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);
-
- 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) {
-
- 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 (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)
- {
-
- apds990x_write_byte(chip, APDS990X_ENABLE, APDS990X_EN_DISABLE_ALL);
-
- 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);
-
- 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);
-
- 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;
- }
- #ifdef CONFIG_PM
- 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);
-
- 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;
- int ret;
- ret = kstrtoul(buf, 0, &value);
- if (ret)
- return ret;
- 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;
-
- chip->lux_persistence = apersis[i];
- chip->arate = arates_hz[i];
-
- if (pm_runtime_suspended(&chip->client->dev))
- return 0;
-
- 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;
- ret = kstrtoul(buf, 0, &value);
- if (ret)
- return ret;
- 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;
- int ret;
- ret = kstrtoul(buf, 0, &value);
- if (ret)
- return ret;
- 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)
- {
- unsigned long thresh;
- int ret;
- ret = kstrtoul(buf, 0, &thresh);
- if (ret)
- return ret;
- if (thresh > APDS_RANGE)
- return -EINVAL;
- mutex_lock(&chip->mutex);
- *target = thresh;
-
- 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;
- int ret;
- ret = kstrtoul(buf, 0, &value);
- if (ret)
- return ret;
- 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;
- int ret;
- ret = kstrtoul(buf, 0, &value);
- if (ret)
- return ret;
- 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 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) {
-
- chip->cf.ga = 1966;
- chip->cf.cf1 = 4096;
- chip->cf.irf1 = 9134;
- chip->cf.cf2 = 2867;
- chip->cf.irf2 = 5816;
- chip->cf.df = 52;
- } else {
- chip->cf = chip->pdata->cf;
- }
-
- 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;
-
- 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 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_SLEEP
- static int apds990x_suspend(struct device *dev)
- {
- struct i2c_client *client = to_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 = to_i2c_client(dev);
- struct apds990x_chip *chip = i2c_get_clientdata(client);
-
- apds990x_chip_on(chip);
- return 0;
- }
- #endif
- #ifdef CONFIG_PM
- static int apds990x_runtime_suspend(struct device *dev)
- {
- struct i2c_client *client = to_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 = to_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",
- .pm = &apds990x_pm_ops,
- },
- .probe = apds990x_probe,
- .remove = apds990x_remove,
- .id_table = apds990x_id,
- };
- module_i2c_driver(apds990x_driver);
- MODULE_DESCRIPTION("APDS990X combined ALS and proximity sensor");
- MODULE_AUTHOR("Samu Onkalo, Nokia Corporation");
- MODULE_LICENSE("GPL v2");
|