12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * KXCJK-1013 3-axis accelerometer driver
- * Copyright (c) 2014, Intel Corporation.
- */
- #include <linux/module.h>
- #include <linux/i2c.h>
- #include <linux/interrupt.h>
- #include <linux/delay.h>
- #include <linux/bitops.h>
- #include <linux/slab.h>
- #include <linux/string.h>
- #include <linux/acpi.h>
- #include <linux/pm.h>
- #include <linux/pm_runtime.h>
- #include <linux/regulator/consumer.h>
- #include <linux/iio/iio.h>
- #include <linux/iio/sysfs.h>
- #include <linux/iio/buffer.h>
- #include <linux/iio/trigger.h>
- #include <linux/iio/events.h>
- #include <linux/iio/trigger_consumer.h>
- #include <linux/iio/triggered_buffer.h>
- #include <linux/iio/accel/kxcjk_1013.h>
- #define KXCJK1013_DRV_NAME "kxcjk1013"
- #define KXCJK1013_IRQ_NAME "kxcjk1013_event"
- #define KXTF9_REG_HP_XOUT_L 0x00
- #define KXTF9_REG_HP_XOUT_H 0x01
- #define KXTF9_REG_HP_YOUT_L 0x02
- #define KXTF9_REG_HP_YOUT_H 0x03
- #define KXTF9_REG_HP_ZOUT_L 0x04
- #define KXTF9_REG_HP_ZOUT_H 0x05
- #define KXCJK1013_REG_XOUT_L 0x06
- /*
- * From low byte X axis register, all the other addresses of Y and Z can be
- * obtained by just applying axis offset. The following axis defines are just
- * provide clarity, but not used.
- */
- #define KXCJK1013_REG_XOUT_H 0x07
- #define KXCJK1013_REG_YOUT_L 0x08
- #define KXCJK1013_REG_YOUT_H 0x09
- #define KXCJK1013_REG_ZOUT_L 0x0A
- #define KXCJK1013_REG_ZOUT_H 0x0B
- #define KXCJK1013_REG_DCST_RESP 0x0C
- #define KXCJK1013_REG_WHO_AM_I 0x0F
- #define KXTF9_REG_TILT_POS_CUR 0x10
- #define KXTF9_REG_TILT_POS_PREV 0x11
- #define KXTF9_REG_INT_SRC1 0x15
- #define KXTF9_REG_INT_SRC2 0x16
- #define KXCJK1013_REG_INT_SRC1 0x16
- #define KXCJK1013_REG_INT_SRC2 0x17
- #define KXCJK1013_REG_STATUS_REG 0x18
- #define KXCJK1013_REG_INT_REL 0x1A
- #define KXCJK1013_REG_CTRL1 0x1B
- #define KXTF9_REG_CTRL2 0x1C
- #define KXTF9_REG_CTRL3 0x1D
- #define KXCJK1013_REG_CTRL2 0x1D
- #define KXCJK1013_REG_INT_CTRL1 0x1E
- #define KXCJK1013_REG_INT_CTRL2 0x1F
- #define KXTF9_REG_INT_CTRL3 0x20
- #define KXCJK1013_REG_DATA_CTRL 0x21
- #define KXTF9_REG_TILT_TIMER 0x28
- #define KXCJK1013_REG_WAKE_TIMER 0x29
- #define KXTF9_REG_TDT_TIMER 0x2B
- #define KXTF9_REG_TDT_THRESH_H 0x2C
- #define KXTF9_REG_TDT_THRESH_L 0x2D
- #define KXTF9_REG_TDT_TAP_TIMER 0x2E
- #define KXTF9_REG_TDT_TOTAL_TIMER 0x2F
- #define KXTF9_REG_TDT_LATENCY_TIMER 0x30
- #define KXTF9_REG_TDT_WINDOW_TIMER 0x31
- #define KXCJK1013_REG_SELF_TEST 0x3A
- #define KXTF9_REG_WAKE_THRESH 0x5A
- #define KXTF9_REG_TILT_ANGLE 0x5C
- #define KXTF9_REG_HYST_SET 0x5F
- #define KXCJK1013_REG_WAKE_THRES 0x6A
- /* Everything up to 0x11 is equal to KXCJK1013/KXTF9 above */
- #define KX023_REG_INS1 0x12
- #define KX023_REG_INS2 0x13
- #define KX023_REG_INS3 0x14
- #define KX023_REG_STAT 0x15
- #define KX023_REG_INT_REL 0x17
- #define KX023_REG_CNTL1 0x18
- #define KX023_REG_CNTL2 0x19
- #define KX023_REG_CNTL3 0x1A
- #define KX023_REG_ODCNTL 0x1B
- #define KX023_REG_INC1 0x1C
- #define KX023_REG_INC2 0x1D
- #define KX023_REG_INC3 0x1E
- #define KX023_REG_INC4 0x1F
- #define KX023_REG_INC5 0x20
- #define KX023_REG_INC6 0x21
- #define KX023_REG_TILT_TIMER 0x22
- #define KX023_REG_WUFC 0x23
- #define KX023_REG_TDTRC 0x24
- #define KX023_REG_TDTC 0x25
- #define KX023_REG_TTH 0x26
- #define KX023_REG_TTL 0x27
- #define KX023_REG_FTD 0x28
- #define KX023_REG_STD 0x29
- #define KX023_REG_TLT 0x2A
- #define KX023_REG_TWS 0x2B
- #define KX023_REG_ATH 0x30
- #define KX023_REG_TILT_ANGLE_LL 0x32
- #define KX023_REG_TILT_ANGLE_HL 0x33
- #define KX023_REG_HYST_SET 0x34
- #define KX023_REG_LP_CNTL 0x35
- #define KX023_REG_BUF_CNTL1 0x3A
- #define KX023_REG_BUF_CNTL2 0x3B
- #define KX023_REG_BUF_STATUS_1 0x3C
- #define KX023_REG_BUF_STATUS_2 0x3D
- #define KX023_REG_BUF_CLEAR 0x3E
- #define KX023_REG_BUF_READ 0x3F
- #define KX023_REG_SELF_TEST 0x60
- #define KXCJK1013_REG_CTRL1_BIT_PC1 BIT(7)
- #define KXCJK1013_REG_CTRL1_BIT_RES BIT(6)
- #define KXCJK1013_REG_CTRL1_BIT_DRDY BIT(5)
- #define KXCJK1013_REG_CTRL1_BIT_GSEL1 BIT(4)
- #define KXCJK1013_REG_CTRL1_BIT_GSEL0 BIT(3)
- #define KXCJK1013_REG_CTRL1_BIT_WUFE BIT(1)
- #define KXCJK1013_REG_INT_CTRL1_BIT_IEU BIT(2) /* KXTF9 */
- #define KXCJK1013_REG_INT_CTRL1_BIT_IEL BIT(3)
- #define KXCJK1013_REG_INT_CTRL1_BIT_IEA BIT(4)
- #define KXCJK1013_REG_INT_CTRL1_BIT_IEN BIT(5)
- #define KXTF9_REG_TILT_BIT_LEFT_EDGE BIT(5)
- #define KXTF9_REG_TILT_BIT_RIGHT_EDGE BIT(4)
- #define KXTF9_REG_TILT_BIT_LOWER_EDGE BIT(3)
- #define KXTF9_REG_TILT_BIT_UPPER_EDGE BIT(2)
- #define KXTF9_REG_TILT_BIT_FACE_DOWN BIT(1)
- #define KXTF9_REG_TILT_BIT_FACE_UP BIT(0)
- #define KXCJK1013_DATA_MASK_12_BIT 0x0FFF
- #define KXCJK1013_MAX_STARTUP_TIME_US 100000
- #define KXCJK1013_SLEEP_DELAY_MS 2000
- #define KXCJK1013_REG_INT_SRC1_BIT_TPS BIT(0) /* KXTF9 */
- #define KXCJK1013_REG_INT_SRC1_BIT_WUFS BIT(1)
- #define KXCJK1013_REG_INT_SRC1_MASK_TDTS (BIT(2) | BIT(3)) /* KXTF9 */
- #define KXCJK1013_REG_INT_SRC1_TAP_NONE 0
- #define KXCJK1013_REG_INT_SRC1_TAP_SINGLE BIT(2)
- #define KXCJK1013_REG_INT_SRC1_TAP_DOUBLE BIT(3)
- #define KXCJK1013_REG_INT_SRC1_BIT_DRDY BIT(4)
- /* KXCJK: INT_SOURCE2: motion detect, KXTF9: INT_SRC_REG1: tap detect */
- #define KXCJK1013_REG_INT_SRC2_BIT_ZP BIT(0)
- #define KXCJK1013_REG_INT_SRC2_BIT_ZN BIT(1)
- #define KXCJK1013_REG_INT_SRC2_BIT_YP BIT(2)
- #define KXCJK1013_REG_INT_SRC2_BIT_YN BIT(3)
- #define KXCJK1013_REG_INT_SRC2_BIT_XP BIT(4)
- #define KXCJK1013_REG_INT_SRC2_BIT_XN BIT(5)
- /* KX023 interrupt routing to INT1. INT2 can be configured with INC6 */
- #define KX023_REG_INC4_BFI1 BIT(6)
- #define KX023_REG_INC4_WMI1 BIT(5)
- #define KX023_REG_INC4_DRDY1 BIT(4)
- #define KX023_REG_INC4_TDTI1 BIT(2)
- #define KX023_REG_INC4_WUFI1 BIT(1)
- #define KX023_REG_INC4_TPI1 BIT(0)
- #define KXCJK1013_DEFAULT_WAKE_THRES 1
- enum kx_chipset {
- KXCJK1013,
- KXCJ91008,
- KXTJ21009,
- KXTF9,
- KX0231025,
- KX_MAX_CHIPS /* this must be last */
- };
- enum kx_acpi_type {
- ACPI_GENERIC,
- ACPI_SMO8500,
- ACPI_KIOX010A,
- };
- struct kx_chipset_regs {
- u8 int_src1;
- u8 int_src2;
- u8 int_rel;
- u8 ctrl1;
- u8 wuf_ctrl;
- u8 int_ctrl1;
- u8 data_ctrl;
- u8 wake_timer;
- u8 wake_thres;
- };
- static const struct kx_chipset_regs kxcjk1013_regs = {
- .int_src1 = KXCJK1013_REG_INT_SRC1,
- .int_src2 = KXCJK1013_REG_INT_SRC2,
- .int_rel = KXCJK1013_REG_INT_REL,
- .ctrl1 = KXCJK1013_REG_CTRL1,
- .wuf_ctrl = KXCJK1013_REG_CTRL2,
- .int_ctrl1 = KXCJK1013_REG_INT_CTRL1,
- .data_ctrl = KXCJK1013_REG_DATA_CTRL,
- .wake_timer = KXCJK1013_REG_WAKE_TIMER,
- .wake_thres = KXCJK1013_REG_WAKE_THRES,
- };
- static const struct kx_chipset_regs kxtf9_regs = {
- /* .int_src1 was moved to INT_SRC2 on KXTF9 */
- .int_src1 = KXTF9_REG_INT_SRC2,
- /* .int_src2 is not available */
- .int_rel = KXCJK1013_REG_INT_REL,
- .ctrl1 = KXCJK1013_REG_CTRL1,
- .wuf_ctrl = KXTF9_REG_CTRL3,
- .int_ctrl1 = KXCJK1013_REG_INT_CTRL1,
- .data_ctrl = KXCJK1013_REG_DATA_CTRL,
- .wake_timer = KXCJK1013_REG_WAKE_TIMER,
- .wake_thres = KXTF9_REG_WAKE_THRESH,
- };
- /* The registers have totally different names but the bits are compatible */
- static const struct kx_chipset_regs kx0231025_regs = {
- .int_src1 = KX023_REG_INS2,
- .int_src2 = KX023_REG_INS3,
- .int_rel = KX023_REG_INT_REL,
- .ctrl1 = KX023_REG_CNTL1,
- .wuf_ctrl = KX023_REG_CNTL3,
- .int_ctrl1 = KX023_REG_INC1,
- .data_ctrl = KX023_REG_ODCNTL,
- .wake_timer = KX023_REG_WUFC,
- .wake_thres = KX023_REG_ATH,
- };
- enum kxcjk1013_axis {
- AXIS_X,
- AXIS_Y,
- AXIS_Z,
- AXIS_MAX
- };
- struct kxcjk1013_data {
- struct regulator_bulk_data regulators[2];
- struct i2c_client *client;
- struct iio_trigger *dready_trig;
- struct iio_trigger *motion_trig;
- struct iio_mount_matrix orientation;
- struct mutex mutex;
- /* Ensure timestamp naturally aligned */
- struct {
- s16 chans[AXIS_MAX];
- s64 timestamp __aligned(8);
- } scan;
- u8 odr_bits;
- u8 range;
- int wake_thres;
- int wake_dur;
- bool active_high_intr;
- bool dready_trigger_on;
- int ev_enable_state;
- bool motion_trigger_on;
- int64_t timestamp;
- enum kx_chipset chipset;
- enum kx_acpi_type acpi_type;
- const struct kx_chipset_regs *regs;
- };
- enum kxcjk1013_mode {
- STANDBY,
- OPERATION,
- };
- enum kxcjk1013_range {
- KXCJK1013_RANGE_2G,
- KXCJK1013_RANGE_4G,
- KXCJK1013_RANGE_8G,
- };
- struct kx_odr_map {
- int val;
- int val2;
- int odr_bits;
- int wuf_bits;
- };
- static const struct kx_odr_map samp_freq_table[] = {
- { 0, 781000, 0x08, 0x00 },
- { 1, 563000, 0x09, 0x01 },
- { 3, 125000, 0x0A, 0x02 },
- { 6, 250000, 0x0B, 0x03 },
- { 12, 500000, 0x00, 0x04 },
- { 25, 0, 0x01, 0x05 },
- { 50, 0, 0x02, 0x06 },
- { 100, 0, 0x03, 0x06 },
- { 200, 0, 0x04, 0x06 },
- { 400, 0, 0x05, 0x06 },
- { 800, 0, 0x06, 0x06 },
- { 1600, 0, 0x07, 0x06 },
- };
- static const char *const kxcjk1013_samp_freq_avail =
- "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600";
- static const struct kx_odr_map kxtf9_samp_freq_table[] = {
- { 25, 0, 0x01, 0x00 },
- { 50, 0, 0x02, 0x01 },
- { 100, 0, 0x03, 0x01 },
- { 200, 0, 0x04, 0x01 },
- { 400, 0, 0x05, 0x01 },
- { 800, 0, 0x06, 0x01 },
- };
- static const char *const kxtf9_samp_freq_avail =
- "25 50 100 200 400 800";
- /* Refer to section 4 of the specification */
- static __maybe_unused const struct {
- int odr_bits;
- int usec;
- } odr_start_up_times[KX_MAX_CHIPS][12] = {
- /* KXCJK-1013 */
- {
- {0x08, 100000},
- {0x09, 100000},
- {0x0A, 100000},
- {0x0B, 100000},
- {0, 80000},
- {0x01, 41000},
- {0x02, 21000},
- {0x03, 11000},
- {0x04, 6400},
- {0x05, 3900},
- {0x06, 2700},
- {0x07, 2100},
- },
- /* KXCJ9-1008 */
- {
- {0x08, 100000},
- {0x09, 100000},
- {0x0A, 100000},
- {0x0B, 100000},
- {0, 80000},
- {0x01, 41000},
- {0x02, 21000},
- {0x03, 11000},
- {0x04, 6400},
- {0x05, 3900},
- {0x06, 2700},
- {0x07, 2100},
- },
- /* KXCTJ2-1009 */
- {
- {0x08, 1240000},
- {0x09, 621000},
- {0x0A, 309000},
- {0x0B, 151000},
- {0, 80000},
- {0x01, 41000},
- {0x02, 21000},
- {0x03, 11000},
- {0x04, 6000},
- {0x05, 4000},
- {0x06, 3000},
- {0x07, 2000},
- },
- /* KXTF9 */
- {
- {0x01, 81000},
- {0x02, 41000},
- {0x03, 21000},
- {0x04, 11000},
- {0x05, 5100},
- {0x06, 2700},
- },
- /* KX023-1025 */
- {
- /* First 4 are not in datasheet, taken from KXCTJ2-1009 */
- {0x08, 1240000},
- {0x09, 621000},
- {0x0A, 309000},
- {0x0B, 151000},
- {0, 81000},
- {0x01, 40000},
- {0x02, 22000},
- {0x03, 12000},
- {0x04, 7000},
- {0x05, 4400},
- {0x06, 3000},
- {0x07, 3000},
- },
- };
- static const struct {
- u16 scale;
- u8 gsel_0;
- u8 gsel_1;
- } KXCJK1013_scale_table[] = { {9582, 0, 0},
- {19163, 1, 0},
- {38326, 0, 1} };
- #ifdef CONFIG_ACPI
- enum kiox010a_fn_index {
- KIOX010A_SET_LAPTOP_MODE = 1,
- KIOX010A_SET_TABLET_MODE = 2,
- };
- static int kiox010a_dsm(struct device *dev, int fn_index)
- {
- acpi_handle handle = ACPI_HANDLE(dev);
- guid_t kiox010a_dsm_guid;
- union acpi_object *obj;
- if (!handle)
- return -ENODEV;
- guid_parse("1f339696-d475-4e26-8cad-2e9f8e6d7a91", &kiox010a_dsm_guid);
- obj = acpi_evaluate_dsm(handle, &kiox010a_dsm_guid, 1, fn_index, NULL);
- if (!obj)
- return -EIO;
- ACPI_FREE(obj);
- return 0;
- }
- #endif
- static int kxcjk1013_set_mode(struct kxcjk1013_data *data,
- enum kxcjk1013_mode mode)
- {
- int ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- if (mode == STANDBY)
- ret &= ~KXCJK1013_REG_CTRL1_BIT_PC1;
- else
- ret |= KXCJK1013_REG_CTRL1_BIT_PC1;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
- return ret;
- }
- return 0;
- }
- static int kxcjk1013_get_mode(struct kxcjk1013_data *data,
- enum kxcjk1013_mode *mode)
- {
- int ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- if (ret & KXCJK1013_REG_CTRL1_BIT_PC1)
- *mode = OPERATION;
- else
- *mode = STANDBY;
- return 0;
- }
- static int kxcjk1013_set_range(struct kxcjk1013_data *data, int range_index)
- {
- int ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- ret &= ~(KXCJK1013_REG_CTRL1_BIT_GSEL0 |
- KXCJK1013_REG_CTRL1_BIT_GSEL1);
- ret |= (KXCJK1013_scale_table[range_index].gsel_0 << 3);
- ret |= (KXCJK1013_scale_table[range_index].gsel_1 << 4);
- ret = i2c_smbus_write_byte_data(data->client, data->regs->ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
- return ret;
- }
- data->range = range_index;
- return 0;
- }
- static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
- {
- int ret;
- #ifdef CONFIG_ACPI
- if (data->acpi_type == ACPI_KIOX010A) {
- /* Make sure the kbd and touchpad on 2-in-1s using 2 KXCJ91008-s work */
- kiox010a_dsm(&data->client->dev, KIOX010A_SET_LAPTOP_MODE);
- }
- #endif
- ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_WHO_AM_I);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading who_am_i\n");
- return ret;
- }
- dev_dbg(&data->client->dev, "KXCJK1013 Chip Id %x\n", ret);
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0)
- return ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- /* Set 12 bit mode */
- ret |= KXCJK1013_REG_CTRL1_BIT_RES;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl\n");
- return ret;
- }
- /* Setting range to 4G */
- ret = kxcjk1013_set_range(data, KXCJK1013_RANGE_4G);
- if (ret < 0)
- return ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->data_ctrl);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_data_ctrl\n");
- return ret;
- }
- data->odr_bits = ret;
- /* Set up INT polarity */
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
- return ret;
- }
- if (data->active_high_intr)
- ret |= KXCJK1013_REG_INT_CTRL1_BIT_IEA;
- else
- ret &= ~KXCJK1013_REG_INT_CTRL1_BIT_IEA;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->int_ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
- return ret;
- }
- /* On KX023, route all used interrupts to INT1 for now */
- if (data->chipset == KX0231025 && data->client->irq > 0) {
- ret = i2c_smbus_write_byte_data(data->client, KX023_REG_INC4,
- KX023_REG_INC4_DRDY1 |
- KX023_REG_INC4_WUFI1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_inc4\n");
- return ret;
- }
- }
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret < 0)
- return ret;
- data->wake_thres = KXCJK1013_DEFAULT_WAKE_THRES;
- return 0;
- }
- #ifdef CONFIG_PM
- static int kxcjk1013_get_startup_times(struct kxcjk1013_data *data)
- {
- int i;
- int idx = data->chipset;
- for (i = 0; i < ARRAY_SIZE(odr_start_up_times[idx]); ++i) {
- if (odr_start_up_times[idx][i].odr_bits == data->odr_bits)
- return odr_start_up_times[idx][i].usec;
- }
- return KXCJK1013_MAX_STARTUP_TIME_US;
- }
- #endif
- static int kxcjk1013_set_power_state(struct kxcjk1013_data *data, bool on)
- {
- #ifdef CONFIG_PM
- int ret;
- if (on)
- ret = pm_runtime_resume_and_get(&data->client->dev);
- else {
- pm_runtime_mark_last_busy(&data->client->dev);
- ret = pm_runtime_put_autosuspend(&data->client->dev);
- }
- if (ret < 0) {
- dev_err(&data->client->dev,
- "Failed: %s for %d\n", __func__, on);
- return ret;
- }
- #endif
- return 0;
- }
- static int kxcjk1013_chip_update_thresholds(struct kxcjk1013_data *data)
- {
- int ret;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->wake_timer,
- data->wake_dur);
- if (ret < 0) {
- dev_err(&data->client->dev,
- "Error writing reg_wake_timer\n");
- return ret;
- }
- ret = i2c_smbus_write_byte_data(data->client, data->regs->wake_thres,
- data->wake_thres);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_wake_thres\n");
- return ret;
- }
- return 0;
- }
- static int kxcjk1013_setup_any_motion_interrupt(struct kxcjk1013_data *data,
- bool status)
- {
- int ret;
- enum kxcjk1013_mode store_mode;
- ret = kxcjk1013_get_mode(data, &store_mode);
- if (ret < 0)
- return ret;
- /* This is requirement by spec to change state to STANDBY */
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0)
- return ret;
- ret = kxcjk1013_chip_update_thresholds(data);
- if (ret < 0)
- return ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
- return ret;
- }
- if (status)
- ret |= KXCJK1013_REG_INT_CTRL1_BIT_IEN;
- else
- ret &= ~KXCJK1013_REG_INT_CTRL1_BIT_IEN;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->int_ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
- return ret;
- }
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- if (status)
- ret |= KXCJK1013_REG_CTRL1_BIT_WUFE;
- else
- ret &= ~KXCJK1013_REG_CTRL1_BIT_WUFE;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
- return ret;
- }
- if (store_mode == OPERATION) {
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret < 0)
- return ret;
- }
- return 0;
- }
- static int kxcjk1013_setup_new_data_interrupt(struct kxcjk1013_data *data,
- bool status)
- {
- int ret;
- enum kxcjk1013_mode store_mode;
- ret = kxcjk1013_get_mode(data, &store_mode);
- if (ret < 0)
- return ret;
- /* This is requirement by spec to change state to STANDBY */
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0)
- return ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
- return ret;
- }
- if (status)
- ret |= KXCJK1013_REG_INT_CTRL1_BIT_IEN;
- else
- ret &= ~KXCJK1013_REG_INT_CTRL1_BIT_IEN;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->int_ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
- return ret;
- }
- ret = i2c_smbus_read_byte_data(data->client, data->regs->ctrl1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
- return ret;
- }
- if (status)
- ret |= KXCJK1013_REG_CTRL1_BIT_DRDY;
- else
- ret &= ~KXCJK1013_REG_CTRL1_BIT_DRDY;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->ctrl1, ret);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
- return ret;
- }
- if (store_mode == OPERATION) {
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret < 0)
- return ret;
- }
- return 0;
- }
- static const struct kx_odr_map *kxcjk1013_find_odr_value(
- const struct kx_odr_map *map, size_t map_size, int val, int val2)
- {
- int i;
- for (i = 0; i < map_size; ++i) {
- if (map[i].val == val && map[i].val2 == val2)
- return &map[i];
- }
- return ERR_PTR(-EINVAL);
- }
- static int kxcjk1013_convert_odr_value(const struct kx_odr_map *map,
- size_t map_size, int odr_bits,
- int *val, int *val2)
- {
- int i;
- for (i = 0; i < map_size; ++i) {
- if (map[i].odr_bits == odr_bits) {
- *val = map[i].val;
- *val2 = map[i].val2;
- return IIO_VAL_INT_PLUS_MICRO;
- }
- }
- return -EINVAL;
- }
- static int kxcjk1013_set_odr(struct kxcjk1013_data *data, int val, int val2)
- {
- int ret;
- enum kxcjk1013_mode store_mode;
- const struct kx_odr_map *odr_setting;
- ret = kxcjk1013_get_mode(data, &store_mode);
- if (ret < 0)
- return ret;
- if (data->chipset == KXTF9)
- odr_setting = kxcjk1013_find_odr_value(kxtf9_samp_freq_table,
- ARRAY_SIZE(kxtf9_samp_freq_table),
- val, val2);
- else
- odr_setting = kxcjk1013_find_odr_value(samp_freq_table,
- ARRAY_SIZE(samp_freq_table),
- val, val2);
- if (IS_ERR(odr_setting))
- return PTR_ERR(odr_setting);
- /* To change ODR, the chip must be set to STANDBY as per spec */
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0)
- return ret;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->data_ctrl,
- odr_setting->odr_bits);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing data_ctrl\n");
- return ret;
- }
- data->odr_bits = odr_setting->odr_bits;
- ret = i2c_smbus_write_byte_data(data->client, data->regs->wuf_ctrl,
- odr_setting->wuf_bits);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error writing reg_ctrl2\n");
- return ret;
- }
- if (store_mode == OPERATION) {
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret < 0)
- return ret;
- }
- return 0;
- }
- static int kxcjk1013_get_odr(struct kxcjk1013_data *data, int *val, int *val2)
- {
- if (data->chipset == KXTF9)
- return kxcjk1013_convert_odr_value(kxtf9_samp_freq_table,
- ARRAY_SIZE(kxtf9_samp_freq_table),
- data->odr_bits, val, val2);
- else
- return kxcjk1013_convert_odr_value(samp_freq_table,
- ARRAY_SIZE(samp_freq_table),
- data->odr_bits, val, val2);
- }
- static int kxcjk1013_get_acc_reg(struct kxcjk1013_data *data, int axis)
- {
- u8 reg = KXCJK1013_REG_XOUT_L + axis * 2;
- int ret;
- ret = i2c_smbus_read_word_data(data->client, reg);
- if (ret < 0) {
- dev_err(&data->client->dev,
- "failed to read accel_%c registers\n", 'x' + axis);
- return ret;
- }
- return ret;
- }
- static int kxcjk1013_set_scale(struct kxcjk1013_data *data, int val)
- {
- int ret, i;
- enum kxcjk1013_mode store_mode;
- for (i = 0; i < ARRAY_SIZE(KXCJK1013_scale_table); ++i) {
- if (KXCJK1013_scale_table[i].scale == val) {
- ret = kxcjk1013_get_mode(data, &store_mode);
- if (ret < 0)
- return ret;
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0)
- return ret;
- ret = kxcjk1013_set_range(data, i);
- if (ret < 0)
- return ret;
- if (store_mode == OPERATION) {
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret)
- return ret;
- }
- return 0;
- }
- }
- return -EINVAL;
- }
- static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
- struct iio_chan_spec const *chan, int *val,
- int *val2, long mask)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- switch (mask) {
- case IIO_CHAN_INFO_RAW:
- mutex_lock(&data->mutex);
- if (iio_buffer_enabled(indio_dev))
- ret = -EBUSY;
- else {
- ret = kxcjk1013_set_power_state(data, true);
- if (ret < 0) {
- mutex_unlock(&data->mutex);
- return ret;
- }
- ret = kxcjk1013_get_acc_reg(data, chan->scan_index);
- if (ret < 0) {
- kxcjk1013_set_power_state(data, false);
- mutex_unlock(&data->mutex);
- return ret;
- }
- *val = sign_extend32(ret >> chan->scan_type.shift,
- chan->scan_type.realbits - 1);
- ret = kxcjk1013_set_power_state(data, false);
- }
- mutex_unlock(&data->mutex);
- if (ret < 0)
- return ret;
- return IIO_VAL_INT;
- case IIO_CHAN_INFO_SCALE:
- *val = 0;
- *val2 = KXCJK1013_scale_table[data->range].scale;
- return IIO_VAL_INT_PLUS_MICRO;
- case IIO_CHAN_INFO_SAMP_FREQ:
- mutex_lock(&data->mutex);
- ret = kxcjk1013_get_odr(data, val, val2);
- mutex_unlock(&data->mutex);
- return ret;
- default:
- return -EINVAL;
- }
- }
- static int kxcjk1013_write_raw(struct iio_dev *indio_dev,
- struct iio_chan_spec const *chan, int val,
- int val2, long mask)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- switch (mask) {
- case IIO_CHAN_INFO_SAMP_FREQ:
- mutex_lock(&data->mutex);
- ret = kxcjk1013_set_odr(data, val, val2);
- mutex_unlock(&data->mutex);
- break;
- case IIO_CHAN_INFO_SCALE:
- if (val)
- return -EINVAL;
- mutex_lock(&data->mutex);
- ret = kxcjk1013_set_scale(data, val2);
- mutex_unlock(&data->mutex);
- break;
- default:
- ret = -EINVAL;
- }
- return ret;
- }
- static int kxcjk1013_read_event(struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan,
- enum iio_event_type type,
- enum iio_event_direction dir,
- enum iio_event_info info,
- int *val, int *val2)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- *val2 = 0;
- switch (info) {
- case IIO_EV_INFO_VALUE:
- *val = data->wake_thres;
- break;
- case IIO_EV_INFO_PERIOD:
- *val = data->wake_dur;
- break;
- default:
- return -EINVAL;
- }
- return IIO_VAL_INT;
- }
- static int kxcjk1013_write_event(struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan,
- enum iio_event_type type,
- enum iio_event_direction dir,
- enum iio_event_info info,
- int val, int val2)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- if (data->ev_enable_state)
- return -EBUSY;
- switch (info) {
- case IIO_EV_INFO_VALUE:
- data->wake_thres = val;
- break;
- case IIO_EV_INFO_PERIOD:
- data->wake_dur = val;
- break;
- default:
- return -EINVAL;
- }
- return 0;
- }
- static int kxcjk1013_read_event_config(struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan,
- enum iio_event_type type,
- enum iio_event_direction dir)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- return data->ev_enable_state;
- }
- static int kxcjk1013_write_event_config(struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan,
- enum iio_event_type type,
- enum iio_event_direction dir,
- int state)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- if (state && data->ev_enable_state)
- return 0;
- mutex_lock(&data->mutex);
- if (!state && data->motion_trigger_on) {
- data->ev_enable_state = 0;
- mutex_unlock(&data->mutex);
- return 0;
- }
- /*
- * We will expect the enable and disable to do operation in
- * reverse order. This will happen here anyway as our
- * resume operation uses sync mode runtime pm calls, the
- * suspend operation will be delayed by autosuspend delay
- * So the disable operation will still happen in reverse of
- * enable operation. When runtime pm is disabled the mode
- * is always on so sequence doesn't matter
- */
- ret = kxcjk1013_set_power_state(data, state);
- if (ret < 0) {
- mutex_unlock(&data->mutex);
- return ret;
- }
- ret = kxcjk1013_setup_any_motion_interrupt(data, state);
- if (ret < 0) {
- kxcjk1013_set_power_state(data, false);
- data->ev_enable_state = 0;
- mutex_unlock(&data->mutex);
- return ret;
- }
- data->ev_enable_state = state;
- mutex_unlock(&data->mutex);
- return 0;
- }
- static int kxcjk1013_buffer_preenable(struct iio_dev *indio_dev)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- return kxcjk1013_set_power_state(data, true);
- }
- static int kxcjk1013_buffer_postdisable(struct iio_dev *indio_dev)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- return kxcjk1013_set_power_state(data, false);
- }
- static ssize_t kxcjk1013_get_samp_freq_avail(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct iio_dev *indio_dev = dev_to_iio_dev(dev);
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- const char *str;
- if (data->chipset == KXTF9)
- str = kxtf9_samp_freq_avail;
- else
- str = kxcjk1013_samp_freq_avail;
- return sprintf(buf, "%s\n", str);
- }
- static IIO_DEVICE_ATTR(in_accel_sampling_frequency_available, S_IRUGO,
- kxcjk1013_get_samp_freq_avail, NULL, 0);
- static IIO_CONST_ATTR(in_accel_scale_available, "0.009582 0.019163 0.038326");
- static struct attribute *kxcjk1013_attributes[] = {
- &iio_dev_attr_in_accel_sampling_frequency_available.dev_attr.attr,
- &iio_const_attr_in_accel_scale_available.dev_attr.attr,
- NULL,
- };
- static const struct attribute_group kxcjk1013_attrs_group = {
- .attrs = kxcjk1013_attributes,
- };
- static const struct iio_event_spec kxcjk1013_event = {
- .type = IIO_EV_TYPE_THRESH,
- .dir = IIO_EV_DIR_EITHER,
- .mask_separate = BIT(IIO_EV_INFO_VALUE) |
- BIT(IIO_EV_INFO_ENABLE) |
- BIT(IIO_EV_INFO_PERIOD)
- };
- static const struct iio_mount_matrix *
- kxcjk1013_get_mount_matrix(const struct iio_dev *indio_dev,
- const struct iio_chan_spec *chan)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- return &data->orientation;
- }
- static const struct iio_chan_spec_ext_info kxcjk1013_ext_info[] = {
- IIO_MOUNT_MATRIX(IIO_SHARED_BY_TYPE, kxcjk1013_get_mount_matrix),
- { }
- };
- #define KXCJK1013_CHANNEL(_axis) { \
- .type = IIO_ACCEL, \
- .modified = 1, \
- .channel2 = IIO_MOD_##_axis, \
- .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
- .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
- BIT(IIO_CHAN_INFO_SAMP_FREQ), \
- .scan_index = AXIS_##_axis, \
- .scan_type = { \
- .sign = 's', \
- .realbits = 12, \
- .storagebits = 16, \
- .shift = 4, \
- .endianness = IIO_LE, \
- }, \
- .event_spec = &kxcjk1013_event, \
- .ext_info = kxcjk1013_ext_info, \
- .num_event_specs = 1 \
- }
- static const struct iio_chan_spec kxcjk1013_channels[] = {
- KXCJK1013_CHANNEL(X),
- KXCJK1013_CHANNEL(Y),
- KXCJK1013_CHANNEL(Z),
- IIO_CHAN_SOFT_TIMESTAMP(3),
- };
- static const struct iio_buffer_setup_ops kxcjk1013_buffer_setup_ops = {
- .preenable = kxcjk1013_buffer_preenable,
- .postdisable = kxcjk1013_buffer_postdisable,
- };
- static const struct iio_info kxcjk1013_info = {
- .attrs = &kxcjk1013_attrs_group,
- .read_raw = kxcjk1013_read_raw,
- .write_raw = kxcjk1013_write_raw,
- .read_event_value = kxcjk1013_read_event,
- .write_event_value = kxcjk1013_write_event,
- .write_event_config = kxcjk1013_write_event_config,
- .read_event_config = kxcjk1013_read_event_config,
- };
- static const unsigned long kxcjk1013_scan_masks[] = {0x7, 0};
- static irqreturn_t kxcjk1013_trigger_handler(int irq, void *p)
- {
- struct iio_poll_func *pf = p;
- struct iio_dev *indio_dev = pf->indio_dev;
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- mutex_lock(&data->mutex);
- ret = i2c_smbus_read_i2c_block_data_or_emulated(data->client,
- KXCJK1013_REG_XOUT_L,
- AXIS_MAX * 2,
- (u8 *)data->scan.chans);
- mutex_unlock(&data->mutex);
- if (ret < 0)
- goto err;
- iio_push_to_buffers_with_timestamp(indio_dev, &data->scan,
- data->timestamp);
- err:
- iio_trigger_notify_done(indio_dev->trig);
- return IRQ_HANDLED;
- }
- static void kxcjk1013_trig_reen(struct iio_trigger *trig)
- {
- struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_rel);
- if (ret < 0)
- dev_err(&data->client->dev, "Error reading reg_int_rel\n");
- }
- static int kxcjk1013_data_rdy_trigger_set_state(struct iio_trigger *trig,
- bool state)
- {
- struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- mutex_lock(&data->mutex);
- if (!state && data->ev_enable_state && data->motion_trigger_on) {
- data->motion_trigger_on = false;
- mutex_unlock(&data->mutex);
- return 0;
- }
- ret = kxcjk1013_set_power_state(data, state);
- if (ret < 0) {
- mutex_unlock(&data->mutex);
- return ret;
- }
- if (data->motion_trig == trig)
- ret = kxcjk1013_setup_any_motion_interrupt(data, state);
- else
- ret = kxcjk1013_setup_new_data_interrupt(data, state);
- if (ret < 0) {
- kxcjk1013_set_power_state(data, false);
- mutex_unlock(&data->mutex);
- return ret;
- }
- if (data->motion_trig == trig)
- data->motion_trigger_on = state;
- else
- data->dready_trigger_on = state;
- mutex_unlock(&data->mutex);
- return 0;
- }
- static const struct iio_trigger_ops kxcjk1013_trigger_ops = {
- .set_trigger_state = kxcjk1013_data_rdy_trigger_set_state,
- .reenable = kxcjk1013_trig_reen,
- };
- static void kxcjk1013_report_motion_event(struct iio_dev *indio_dev)
- {
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret = i2c_smbus_read_byte_data(data->client, data->regs->int_src2);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_int_src2\n");
- return;
- }
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_XN)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_X,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_FALLING),
- data->timestamp);
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_XP)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_X,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_RISING),
- data->timestamp);
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_YN)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_Y,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_FALLING),
- data->timestamp);
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_YP)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_Y,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_RISING),
- data->timestamp);
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZN)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_Z,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_FALLING),
- data->timestamp);
- if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZP)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_Z,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_RISING),
- data->timestamp);
- }
- static irqreturn_t kxcjk1013_event_handler(int irq, void *private)
- {
- struct iio_dev *indio_dev = private;
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_src1);
- if (ret < 0) {
- dev_err(&data->client->dev, "Error reading reg_int_src1\n");
- goto ack_intr;
- }
- if (ret & KXCJK1013_REG_INT_SRC1_BIT_WUFS) {
- if (data->chipset == KXTF9)
- iio_push_event(indio_dev,
- IIO_MOD_EVENT_CODE(IIO_ACCEL,
- 0,
- IIO_MOD_X_AND_Y_AND_Z,
- IIO_EV_TYPE_THRESH,
- IIO_EV_DIR_RISING),
- data->timestamp);
- else
- kxcjk1013_report_motion_event(indio_dev);
- }
- ack_intr:
- if (data->dready_trigger_on)
- return IRQ_HANDLED;
- ret = i2c_smbus_read_byte_data(data->client, data->regs->int_rel);
- if (ret < 0)
- dev_err(&data->client->dev, "Error reading reg_int_rel\n");
- return IRQ_HANDLED;
- }
- static irqreturn_t kxcjk1013_data_rdy_trig_poll(int irq, void *private)
- {
- struct iio_dev *indio_dev = private;
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- data->timestamp = iio_get_time_ns(indio_dev);
- if (data->dready_trigger_on)
- iio_trigger_poll(data->dready_trig);
- else if (data->motion_trigger_on)
- iio_trigger_poll(data->motion_trig);
- if (data->ev_enable_state)
- return IRQ_WAKE_THREAD;
- else
- return IRQ_HANDLED;
- }
- static const char *kxcjk1013_match_acpi_device(struct device *dev,
- enum kx_chipset *chipset,
- enum kx_acpi_type *acpi_type,
- const char **label)
- {
- const struct acpi_device_id *id;
- id = acpi_match_device(dev->driver->acpi_match_table, dev);
- if (!id)
- return NULL;
- if (strcmp(id->id, "SMO8500") == 0) {
- *acpi_type = ACPI_SMO8500;
- } else if (strcmp(id->id, "KIOX010A") == 0) {
- *acpi_type = ACPI_KIOX010A;
- *label = "accel-display";
- } else if (strcmp(id->id, "KIOX020A") == 0) {
- *label = "accel-base";
- }
- *chipset = (enum kx_chipset)id->driver_data;
- return dev_name(dev);
- }
- static void kxcjk1013_disable_regulators(void *d)
- {
- struct kxcjk1013_data *data = d;
- regulator_bulk_disable(ARRAY_SIZE(data->regulators), data->regulators);
- }
- static int kxcjk1013_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- struct kxcjk1013_data *data;
- struct iio_dev *indio_dev;
- struct kxcjk_1013_platform_data *pdata;
- const char *name;
- int ret;
- indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
- if (!indio_dev)
- return -ENOMEM;
- data = iio_priv(indio_dev);
- i2c_set_clientdata(client, indio_dev);
- data->client = client;
- pdata = dev_get_platdata(&client->dev);
- if (pdata) {
- data->active_high_intr = pdata->active_high_intr;
- data->orientation = pdata->orientation;
- } else {
- data->active_high_intr = true; /* default polarity */
- ret = iio_read_mount_matrix(&client->dev, &data->orientation);
- if (ret)
- return ret;
- }
- data->regulators[0].supply = "vdd";
- data->regulators[1].supply = "vddio";
- ret = devm_regulator_bulk_get(&client->dev, ARRAY_SIZE(data->regulators),
- data->regulators);
- if (ret)
- return dev_err_probe(&client->dev, ret, "Failed to get regulators\n");
- ret = regulator_bulk_enable(ARRAY_SIZE(data->regulators),
- data->regulators);
- if (ret)
- return ret;
- ret = devm_add_action_or_reset(&client->dev, kxcjk1013_disable_regulators, data);
- if (ret)
- return ret;
- /*
- * A typical delay of 10ms is required for powering up
- * according to the data sheets of supported chips.
- * Hence double that to play safe.
- */
- msleep(20);
- if (id) {
- data->chipset = (enum kx_chipset)(id->driver_data);
- name = id->name;
- } else if (ACPI_HANDLE(&client->dev)) {
- name = kxcjk1013_match_acpi_device(&client->dev,
- &data->chipset,
- &data->acpi_type,
- &indio_dev->label);
- } else
- return -ENODEV;
- switch (data->chipset) {
- case KXCJK1013:
- case KXCJ91008:
- case KXTJ21009:
- data->regs = &kxcjk1013_regs;
- break;
- case KXTF9:
- data->regs = &kxtf9_regs;
- break;
- case KX0231025:
- data->regs = &kx0231025_regs;
- break;
- default:
- return -EINVAL;
- }
- ret = kxcjk1013_chip_init(data);
- if (ret < 0)
- return ret;
- mutex_init(&data->mutex);
- indio_dev->channels = kxcjk1013_channels;
- indio_dev->num_channels = ARRAY_SIZE(kxcjk1013_channels);
- indio_dev->available_scan_masks = kxcjk1013_scan_masks;
- indio_dev->name = name;
- indio_dev->modes = INDIO_DIRECT_MODE;
- indio_dev->info = &kxcjk1013_info;
- if (client->irq > 0 && data->acpi_type != ACPI_SMO8500) {
- ret = devm_request_threaded_irq(&client->dev, client->irq,
- kxcjk1013_data_rdy_trig_poll,
- kxcjk1013_event_handler,
- IRQF_TRIGGER_RISING,
- KXCJK1013_IRQ_NAME,
- indio_dev);
- if (ret)
- goto err_poweroff;
- data->dready_trig = devm_iio_trigger_alloc(&client->dev,
- "%s-dev%d",
- indio_dev->name,
- iio_device_id(indio_dev));
- if (!data->dready_trig) {
- ret = -ENOMEM;
- goto err_poweroff;
- }
- data->motion_trig = devm_iio_trigger_alloc(&client->dev,
- "%s-any-motion-dev%d",
- indio_dev->name,
- iio_device_id(indio_dev));
- if (!data->motion_trig) {
- ret = -ENOMEM;
- goto err_poweroff;
- }
- data->dready_trig->ops = &kxcjk1013_trigger_ops;
- iio_trigger_set_drvdata(data->dready_trig, indio_dev);
- ret = iio_trigger_register(data->dready_trig);
- if (ret)
- goto err_poweroff;
- indio_dev->trig = iio_trigger_get(data->dready_trig);
- data->motion_trig->ops = &kxcjk1013_trigger_ops;
- iio_trigger_set_drvdata(data->motion_trig, indio_dev);
- ret = iio_trigger_register(data->motion_trig);
- if (ret) {
- data->motion_trig = NULL;
- goto err_trigger_unregister;
- }
- }
- ret = iio_triggered_buffer_setup(indio_dev,
- &iio_pollfunc_store_time,
- kxcjk1013_trigger_handler,
- &kxcjk1013_buffer_setup_ops);
- if (ret < 0) {
- dev_err(&client->dev, "iio triggered buffer setup failed\n");
- goto err_trigger_unregister;
- }
- ret = pm_runtime_set_active(&client->dev);
- if (ret)
- goto err_buffer_cleanup;
- pm_runtime_enable(&client->dev);
- pm_runtime_set_autosuspend_delay(&client->dev,
- KXCJK1013_SLEEP_DELAY_MS);
- pm_runtime_use_autosuspend(&client->dev);
- ret = iio_device_register(indio_dev);
- if (ret < 0) {
- dev_err(&client->dev, "unable to register iio device\n");
- goto err_pm_cleanup;
- }
- return 0;
- err_pm_cleanup:
- pm_runtime_dont_use_autosuspend(&client->dev);
- pm_runtime_disable(&client->dev);
- err_buffer_cleanup:
- iio_triggered_buffer_cleanup(indio_dev);
- err_trigger_unregister:
- if (data->dready_trig)
- iio_trigger_unregister(data->dready_trig);
- if (data->motion_trig)
- iio_trigger_unregister(data->motion_trig);
- err_poweroff:
- kxcjk1013_set_mode(data, STANDBY);
- return ret;
- }
- static void kxcjk1013_remove(struct i2c_client *client)
- {
- struct iio_dev *indio_dev = i2c_get_clientdata(client);
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- iio_device_unregister(indio_dev);
- pm_runtime_disable(&client->dev);
- pm_runtime_set_suspended(&client->dev);
- iio_triggered_buffer_cleanup(indio_dev);
- if (data->dready_trig) {
- iio_trigger_unregister(data->dready_trig);
- iio_trigger_unregister(data->motion_trig);
- }
- mutex_lock(&data->mutex);
- kxcjk1013_set_mode(data, STANDBY);
- mutex_unlock(&data->mutex);
- }
- #ifdef CONFIG_PM_SLEEP
- static int kxcjk1013_suspend(struct device *dev)
- {
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- mutex_lock(&data->mutex);
- ret = kxcjk1013_set_mode(data, STANDBY);
- mutex_unlock(&data->mutex);
- return ret;
- }
- static int kxcjk1013_resume(struct device *dev)
- {
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret = 0;
- mutex_lock(&data->mutex);
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret == 0)
- ret = kxcjk1013_set_range(data, data->range);
- mutex_unlock(&data->mutex);
- return ret;
- }
- #endif
- #ifdef CONFIG_PM
- static int kxcjk1013_runtime_suspend(struct device *dev)
- {
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- ret = kxcjk1013_set_mode(data, STANDBY);
- if (ret < 0) {
- dev_err(&data->client->dev, "powering off device failed\n");
- return -EAGAIN;
- }
- return 0;
- }
- static int kxcjk1013_runtime_resume(struct device *dev)
- {
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
- struct kxcjk1013_data *data = iio_priv(indio_dev);
- int ret;
- int sleep_val;
- ret = kxcjk1013_set_mode(data, OPERATION);
- if (ret < 0)
- return ret;
- sleep_val = kxcjk1013_get_startup_times(data);
- if (sleep_val < 20000)
- usleep_range(sleep_val, 20000);
- else
- msleep_interruptible(sleep_val/1000);
- return 0;
- }
- #endif
- static const struct dev_pm_ops kxcjk1013_pm_ops = {
- SET_SYSTEM_SLEEP_PM_OPS(kxcjk1013_suspend, kxcjk1013_resume)
- SET_RUNTIME_PM_OPS(kxcjk1013_runtime_suspend,
- kxcjk1013_runtime_resume, NULL)
- };
- static const struct acpi_device_id kx_acpi_match[] = {
- {"KXCJ1013", KXCJK1013},
- {"KXCJ1008", KXCJ91008},
- {"KXCJ9000", KXCJ91008},
- {"KIOX0008", KXCJ91008},
- {"KIOX0009", KXTJ21009},
- {"KIOX000A", KXCJ91008},
- {"KIOX010A", KXCJ91008}, /* KXCJ91008 in the display of a yoga 2-in-1 */
- {"KIOX020A", KXCJ91008}, /* KXCJ91008 in the base of a yoga 2-in-1 */
- {"KXTJ1009", KXTJ21009},
- {"KXJ2109", KXTJ21009},
- {"SMO8500", KXCJ91008},
- { },
- };
- MODULE_DEVICE_TABLE(acpi, kx_acpi_match);
- static const struct i2c_device_id kxcjk1013_id[] = {
- {"kxcjk1013", KXCJK1013},
- {"kxcj91008", KXCJ91008},
- {"kxtj21009", KXTJ21009},
- {"kxtf9", KXTF9},
- {"kx023-1025", KX0231025},
- {"SMO8500", KXCJ91008},
- {}
- };
- MODULE_DEVICE_TABLE(i2c, kxcjk1013_id);
- static const struct of_device_id kxcjk1013_of_match[] = {
- { .compatible = "kionix,kxcjk1013", },
- { .compatible = "kionix,kxcj91008", },
- { .compatible = "kionix,kxtj21009", },
- { .compatible = "kionix,kxtf9", },
- { .compatible = "kionix,kx023-1025", },
- { }
- };
- MODULE_DEVICE_TABLE(of, kxcjk1013_of_match);
- static struct i2c_driver kxcjk1013_driver = {
- .driver = {
- .name = KXCJK1013_DRV_NAME,
- .acpi_match_table = ACPI_PTR(kx_acpi_match),
- .of_match_table = kxcjk1013_of_match,
- .pm = &kxcjk1013_pm_ops,
- },
- .probe = kxcjk1013_probe,
- .remove = kxcjk1013_remove,
- .id_table = kxcjk1013_id,
- };
- module_i2c_driver(kxcjk1013_driver);
- MODULE_AUTHOR("Srinivas Pandruvada <[email protected]>");
- MODULE_LICENSE("GPL v2");
- MODULE_DESCRIPTION("KXCJK1013 accelerometer driver");
|