Staging driver update for 4.4-rc1
Here's the big staging driver update for 4.4-rc1. If you were disappointed for 4.3-rc1 that we didn't contribute enough changesets, you should be happy with this pull request of over 2400 patches. But overall we removed more lines of code than we added, which is nice to see. Full details in the shortlog. All of these have been in linux-next for a while. Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> -----BEGIN PGP SIGNATURE----- Version: GnuPG v2 iEYEABECAAYFAlY6exwACgkQMUfUDdst+ymXiQCeNhbUB5Gv5FZtPevt25reX6wU IoUAn3+wAsQnwkXhOwaR+15UVJe7/7ua =s9E4 -----END PGP SIGNATURE----- Merge tag 'staging-4.4-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/staging Pull staging driver updates from Greg KH: "Here's the big staging driver update for 4.4-rc1. If you were disappointed for 4.3-rc1 that we didn't contribute enough changesets, you should be happy with this pull request of over 2400 patches. But overall we removed more lines of code than we added, which is nice to see. Full details in the shortlog. All of these have been in linux-next for a while" Greg, I've never been disappointed in how few commits Staging contributes to the kernel.. Never. * tag 'staging-4.4-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/staging: (2431 commits) Staging: rtl8192u: ieee80211: added missing blank lines Staging: rtl8192u: ieee80211: removed unnecessary braces Staging: rtl8192u: ieee80211: corrected block comments Staging: rtl8192u: ieee80211: corrected indent Staging: rtl8192u: ieee80211: added missing spaces after if Staging: rtl8192u: ieee80211: added missing space around '=' Staging: rtl8192u: ieee80211: fixed position of else statements Staging: rtl8192u: ieee80211: fixed open brace positions staging: rdma: ipath: Remove unneeded vairable. staging: rtl8188eu: pwrGrpCnt variable removed in store_pwrindex_offset function staging: rtl8188eu: new variable for hal_data->MCSTxPowerLevelOriginalOffset[pwrGrpCnt] in store_pwrindex_offset function staging: rtl8188eu: checkpatch fixes: 'Avoid CamelCase' in hal/bb_cfg.c staging: rtl8188eu: checkpatch fixes: line over 80 characters splited into two parts staging: rtl8188eu: checkpatch fixes: alignment should match open parenthesis staging: rtl8188eu: checkpatch fixes: unnecessary parentheses removed in hal/bb_cfg.c staging: rtl8188eu: checkpatch fixes: spaces preferred around that '|' in hal/bb_cfg.c staging: rtl8188eu: operator = replaced by += in loop increment staging: rtl8188eu: occurrence of the 5 GHz code marked staging: rtl8188eu: increment placed into for loop header staging: rtl8188eu: while loop replaced by for loop in rtw_restruct_wmm_ie ...
This commit is contained in:
commit
118c216e16
|
@ -581,6 +581,7 @@ What: /sys/.../iio:deviceX/events/in_voltageY_supply_thresh_rising_en
|
|||
What: /sys/.../iio:deviceX/events/in_voltageY_supply_thresh_falling_en
|
||||
What: /sys/.../iio:deviceX/events/in_voltageY_thresh_rising_en
|
||||
What: /sys/.../iio:deviceX/events/in_voltageY_thresh_falling_en
|
||||
What: /sys/.../iio:deviceX/events/in_voltageY_thresh_either_en
|
||||
What: /sys/.../iio:deviceX/events/in_tempY_thresh_rising_en
|
||||
What: /sys/.../iio:deviceX/events/in_tempY_thresh_falling_en
|
||||
KernelVersion: 2.6.37
|
||||
|
@ -1459,3 +1460,34 @@ Description:
|
|||
measurements and return the average value as output data. Each
|
||||
value resulted from <type>[_name]_oversampling_ratio measurements
|
||||
is considered as one sample for <type>[_name]_sampling_frequency.
|
||||
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentration_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentrationX_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentration_co2_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentrationX_co2_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentration_voc_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_concentrationX_voc_raw
|
||||
KernelVersion: 4.3
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
Raw (unscaled no offset etc.) percentage reading of a substance.
|
||||
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_resistance_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/in_resistanceX_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/out_resistance_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/out_resistanceX_raw
|
||||
KernelVersion: 4.3
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
Raw (unscaled no offset etc.) resistance reading that can be processed
|
||||
into an ohm value.
|
||||
|
||||
What: /sys/bus/iio/devices/iio:deviceX/heater_enable
|
||||
KernelVersion: 4.1.0
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
'1' (enable) or '0' (disable) specifying the enable
|
||||
of heater function. Same reading values apply
|
||||
This ABI is especially applicable for humidity sensors
|
||||
to heatup the device and get rid of any condensation
|
||||
in some humidity environment
|
||||
|
|
43
Documentation/ABI/testing/sysfs-bus-iio-adc-hi8435
Normal file
43
Documentation/ABI/testing/sysfs-bus-iio-adc-hi8435
Normal file
|
@ -0,0 +1,43 @@
|
|||
What: /sys/bus/iio/devices/iio:deviceX/in_voltageY_sensing_mode
|
||||
Date: August 2015
|
||||
KernelVersion: 4.2.0
|
||||
Contact: source@cogentembedded.com
|
||||
Description:
|
||||
Program sensor type for threshold detector inputs.
|
||||
Could be either "GND-Open" or "Supply-Open" mode. Y is a
|
||||
threshold detector input channel. Channels 0..7, 8..15, 16..23
|
||||
and 24..31 has common sensor types.
|
||||
|
||||
What: /sys/bus/iio/devices/iio:deviceX/events/in_voltageY_thresh_falling_value
|
||||
Date: August 2015
|
||||
KernelVersion: 4.2.0
|
||||
Contact: source@cogentembedded.com
|
||||
Description:
|
||||
Channel Y low voltage threshold. If sensor input voltage goes lower then
|
||||
this value then the threshold falling event is pushed.
|
||||
Depending on in_voltageY_sensing_mode the low voltage threshold
|
||||
is separately set for "GND-Open" and "Supply-Open" modes.
|
||||
Channels 0..31 have common low threshold values, but could have different
|
||||
sensing_modes.
|
||||
The low voltage threshold range is between 2..21V.
|
||||
Hysteresis between low and high thresholds can not be lower then 2 and
|
||||
can not be odd.
|
||||
If falling threshold results hysteresis to odd value then rising
|
||||
threshold is automatically subtracted by one.
|
||||
|
||||
What: /sys/bus/iio/devices/iio:deviceX/events/in_voltageY_thresh_rising_value
|
||||
Date: August 2015
|
||||
KernelVersion: 4.2.0
|
||||
Contact: source@cogentembedded.com
|
||||
Description:
|
||||
Channel Y high voltage threshold. If sensor input voltage goes higher then
|
||||
this value then the threshold rising event is pushed.
|
||||
Depending on in_voltageY_sensing_mode the high voltage threshold
|
||||
is separately set for "GND-Open" and "Supply-Open" modes.
|
||||
Channels 0..31 have common high threshold values, but could have different
|
||||
sensing_modes.
|
||||
The high voltage threshold range is between 3..22V.
|
||||
Hysteresis between low and high thresholds can not be lower then 2 and
|
||||
can not be odd.
|
||||
If rising threshold results hysteresis to odd value then falling
|
||||
threshold is automatically appended by one.
|
7
Documentation/ABI/testing/sysfs-bus-iio-chemical-vz89x
Normal file
7
Documentation/ABI/testing/sysfs-bus-iio-chemical-vz89x
Normal file
|
@ -0,0 +1,7 @@
|
|||
What: /sys/bus/iio/devices/iio:deviceX/in_concentration_VOC_short_raw
|
||||
Date: September 2015
|
||||
KernelVersion: 4.3
|
||||
Contact: Matt Ranostay <mranostay@gmail.com>
|
||||
Description:
|
||||
Get the raw calibration VOC value from the sensor.
|
||||
This value has little application outside of calibration.
|
9
Documentation/ABI/testing/sysfs-bus-iio-humidity-hdc100x
Normal file
9
Documentation/ABI/testing/sysfs-bus-iio-humidity-hdc100x
Normal file
|
@ -0,0 +1,9 @@
|
|||
What: /sys/bus/iio/devices/iio:deviceX/out_current_heater_raw
|
||||
What: /sys/bus/iio/devices/iio:deviceX/out_current_heater_raw_available
|
||||
KernelVersion: 4.3
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
Controls the heater device within the humidity sensor to get
|
||||
rid of excess condensation.
|
||||
|
||||
Valid control values are 0 = OFF, and 1 = ON.
|
8
Documentation/ABI/testing/sysfs-bus-iio-meas-spec
Normal file
8
Documentation/ABI/testing/sysfs-bus-iio-meas-spec
Normal file
|
@ -0,0 +1,8 @@
|
|||
What: /sys/bus/iio/devices/iio:deviceX/battery_low
|
||||
KernelVersion: 4.1.0
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
Reading returns either '1' or '0'. '1' means that the
|
||||
battery level supplied to sensor is below 2.25V.
|
||||
This ABI is available for tsys02d, htu21, ms8607
|
||||
This ABI is available for htu21, ms8607
|
|
@ -18,3 +18,25 @@ Description:
|
|||
trigger. In order to associate the trigger with an IIO device
|
||||
one should write this name string to
|
||||
/sys/bus/iio/devices/iio:deviceY/trigger/current_trigger.
|
||||
|
||||
What: /sys/bus/iio/devices/iio_sysfs_trigger/add_trigger
|
||||
KernelVersion: 2.6.39
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
This attribute is provided by the iio-trig-sysfs stand-alone
|
||||
driver and it is used to activate the creation of a new trigger.
|
||||
In order to achieve this, one should write a positive integer
|
||||
into the associated file, which will serve as the id of the
|
||||
trigger. If the trigger with the specified id is already present
|
||||
in the system, an invalid argument message will be returned.
|
||||
|
||||
What: /sys/bus/iio/devices/iio_sysfs_trigger/remove_trigger
|
||||
KernelVersion: 2.6.39
|
||||
Contact: linux-iio@vger.kernel.org
|
||||
Description:
|
||||
This attribute is used to unregister and delete a previously
|
||||
created trigger from the list of available triggers. In order to
|
||||
achieve this, one should write a positive integer into the
|
||||
associated file, representing the id of the trigger that needs
|
||||
to be removed. If the trigger can't be found, an invalid
|
||||
argument message will be returned to the user.
|
||||
|
|
|
@ -578,7 +578,7 @@
|
|||
work together.
|
||||
</para>
|
||||
<sect2 id="iiotrigbufsetup"> <title> IIO triggered buffer setup</title>
|
||||
!Edrivers/iio/industrialio-triggered-buffer.c
|
||||
!Edrivers/iio/buffer/industrialio-triggered-buffer.c
|
||||
!Finclude/linux/iio/iio.h iio_buffer_setup_ops
|
||||
|
||||
|
||||
|
|
|
@ -54,7 +54,6 @@ epson,rx8581 I2C-BUS INTERFACE REAL TIME CLOCK MODULE
|
|||
fsl,mag3110 MAG3110: Xtrinsic High Accuracy, 3D Magnetometer
|
||||
fsl,mc13892 MC13892: Power Management Integrated Circuit (PMIC) for i.MX35/51
|
||||
fsl,mma8450 MMA8450Q: Xtrinsic Low-power, 3-axis Xtrinsic Accelerometer
|
||||
fsl,mma8452 MMA8452Q: 3-axis 12-bit / 8-bit Digital Accelerometer
|
||||
fsl,mpr121 MPR121: Proximity Capacitive Touch Sensor Controller
|
||||
fsl,sgtl5000 SGTL5000: Ultra Low-Power Audio Codec
|
||||
gmt,g751 G751: Digital Temperature Sensor and Thermal Watchdog with Two-Wire Interface
|
||||
|
@ -80,6 +79,7 @@ oki,ml86v7667 OKI ML86V7667 video decoder
|
|||
ovti,ov5642 OV5642: Color CMOS QSXGA (5-megapixel) Image Sensor with OmniBSI and Embedded TrueFocus
|
||||
pericom,pt7c4338 Real-time Clock Module
|
||||
plx,pex8648 48-Lane, 12-Port PCI Express Gen 2 (5.0 GT/s) Switch
|
||||
pulsedlight,lidar-lite-v2 Pulsedlight LIDAR range-finding sensor
|
||||
ramtron,24c64 i2c serial eeprom (24cxx)
|
||||
ricoh,r2025sd I2C bus SERIAL INTERFACE REAL-TIME CLOCK IC
|
||||
ricoh,r2221tl I2C bus SERIAL INTERFACE REAL-TIME CLOCK IC
|
||||
|
@ -88,6 +88,7 @@ ricoh,rs5c372b I2C bus SERIAL INTERFACE REAL-TIME CLOCK IC
|
|||
ricoh,rv5c386 I2C bus SERIAL INTERFACE REAL-TIME CLOCK IC
|
||||
ricoh,rv5c387a I2C bus SERIAL INTERFACE REAL-TIME CLOCK IC
|
||||
samsung,24ad0xd1 S524AD0XF1 (128K/256K-bit Serial EEPROM for Low Power)
|
||||
sgx,vz89x SGX Sensortech VZ89X Sensors
|
||||
sii,s35390a 2-wire CMOS real-time clock
|
||||
skyworks,sky81452 Skyworks SKY81452: Six-Channel White LED Driver with Touch Panel Bias Supply
|
||||
st-micro,24c256 i2c serial eeprom (24cxx)
|
||||
|
|
24
Documentation/devicetree/bindings/iio/accel/mma8452.txt
Normal file
24
Documentation/devicetree/bindings/iio/accel/mma8452.txt
Normal file
|
@ -0,0 +1,24 @@
|
|||
Freescale MMA8452Q, MMA8453Q, MMA8652FC or MMA8653FC triaxial accelerometer
|
||||
|
||||
Required properties:
|
||||
|
||||
- compatible: should contain one of
|
||||
* "fsl,mma8452"
|
||||
* "fsl,mma8453"
|
||||
* "fsl,mma8652"
|
||||
* "fsl,mma8653"
|
||||
- reg: the I2C address of the chip
|
||||
|
||||
Optional properties:
|
||||
|
||||
- interrupt-parent: should be the phandle for the interrupt controller
|
||||
- interrupts: interrupt mapping for GPIO IRQ
|
||||
|
||||
Example:
|
||||
|
||||
mma8453fc@1d {
|
||||
compatible = "fsl,mma8453";
|
||||
reg = <0x1d>;
|
||||
interrupt-parent = <&gpio1>;
|
||||
interrupts = <5 0>;
|
||||
};
|
21
Documentation/devicetree/bindings/iio/adc/hi8435.txt
Normal file
21
Documentation/devicetree/bindings/iio/adc/hi8435.txt
Normal file
|
@ -0,0 +1,21 @@
|
|||
Holt Integrated Circuits HI-8435 threshold detector bindings
|
||||
|
||||
Required properties:
|
||||
- compatible: should be "holt,hi8435"
|
||||
- reg: spi chip select number for the device
|
||||
|
||||
Recommended properties:
|
||||
- spi-max-frequency: definition as per
|
||||
Documentation/devicetree/bindings/spi/spi-bus.txt
|
||||
|
||||
Optional properties:
|
||||
- gpios: GPIO used for controlling the reset pin
|
||||
|
||||
Example:
|
||||
sensor@0 {
|
||||
compatible = "holt,hi8435";
|
||||
reg = <0>;
|
||||
gpios = <&gpio6 1 0>;
|
||||
|
||||
spi-max-frequency = <1000000>;
|
||||
};
|
22
Documentation/devicetree/bindings/iio/light/apds9960.txt
Normal file
22
Documentation/devicetree/bindings/iio/light/apds9960.txt
Normal file
|
@ -0,0 +1,22 @@
|
|||
* Avago APDS9960 gesture/RGB/ALS/proximity sensor
|
||||
|
||||
http://www.avagotech.com/docs/AV02-4191EN
|
||||
|
||||
Required properties:
|
||||
|
||||
- compatible: must be "avago,apds9960"
|
||||
- reg: the I2c address of the sensor
|
||||
- interrupt-parent: should be the phandle for the interrupt controller
|
||||
- interrupts : the sole interrupt generated by the device
|
||||
|
||||
Refer to interrupt-controller/interrupts.txt for generic interrupt client
|
||||
node bindings.
|
||||
|
||||
Example:
|
||||
|
||||
apds9960@39 {
|
||||
compatible = "avago,apds9960";
|
||||
reg = <0x39>;
|
||||
interrupt-parent = <&gpio1>;
|
||||
interrupts = <16 1>;
|
||||
};
|
34
Documentation/devicetree/bindings/iio/light/us5182d.txt
Normal file
34
Documentation/devicetree/bindings/iio/light/us5182d.txt
Normal file
|
@ -0,0 +1,34 @@
|
|||
* UPISEMI us5182d I2C ALS and Proximity sensor
|
||||
|
||||
Required properties:
|
||||
- compatible: must be "upisemi,usd5182"
|
||||
- reg: the I2C address of the device
|
||||
|
||||
Optional properties:
|
||||
- upisemi,glass-coef: glass attenuation factor - compensation factor of
|
||||
resolution 1000 for material transmittance.
|
||||
- upisemi,dark-ths: array of 8 elements containing 16-bit thresholds (adc
|
||||
counts) corresponding to every scale.
|
||||
- upisemi,upper-dark-gain: 8-bit dark gain compensation factor(4 int and 4
|
||||
fractional bits - Q4.4) applied when light > threshold
|
||||
- upisemi,lower-dark-gain: 8-bit dark gain compensation factor(4 int and 4
|
||||
fractional bits - Q4.4) applied when light < threshold
|
||||
|
||||
If the optional properties are not specified these factors will default to the
|
||||
values in the below example.
|
||||
The glass-coef defaults to no compensation for the covering material.
|
||||
The threshold array defaults to experimental values that work with US5182D
|
||||
sensor on evaluation board - roughly between 12-32 lux.
|
||||
There will be no dark-gain compensation by default when ALS > thresh
|
||||
(0 * dark-gain), and a 1.35 compensation factor when ALS < thresh.
|
||||
|
||||
Example:
|
||||
|
||||
usd5182@39 {
|
||||
compatible = "upisemi,usd5182";
|
||||
reg = <0x39>;
|
||||
upisemi,glass-coef = < 1000 >;
|
||||
upisemi,dark-ths = /bits/ 16 <170 200 512 512 800 2000 4000 8000>;
|
||||
upisemi,upper-dark-gain = /bits/ 8 <0x00>;
|
||||
upisemi,lower-dark-gain = /bits/ 8 <0x16>;
|
||||
};
|
|
@ -101,6 +101,7 @@ himax Himax Technologies, Inc.
|
|||
hisilicon Hisilicon Limited.
|
||||
hit Hitachi Ltd.
|
||||
hitex Hitex Development Tools
|
||||
holt Holt Integrated Circuits, Inc.
|
||||
honeywell Honeywell
|
||||
hp Hewlett Packard
|
||||
i2se I2SE GmbH
|
||||
|
@ -169,6 +170,7 @@ phytec PHYTEC Messtechnik GmbH
|
|||
picochip Picochip Ltd
|
||||
plathome Plat'Home Co., Ltd.
|
||||
pixcir PIXCIR MICROELECTRONICS Co., Ltd
|
||||
pulsedlight PulsedLight, Inc
|
||||
powervr PowerVR (deprecated, use img)
|
||||
qca Qualcomm Atheros, Inc.
|
||||
qcom Qualcomm Technologies, Inc
|
||||
|
@ -191,6 +193,7 @@ sbs Smart Battery System
|
|||
schindler Schindler
|
||||
seagate Seagate Technology PLC
|
||||
semtech Semtech Corporation
|
||||
sgx SGX Sensortech
|
||||
sharp Sharp Corporation
|
||||
sil Silicon Image
|
||||
silabs Silicon Laboratories
|
||||
|
@ -223,6 +226,7 @@ toshiba Toshiba Corporation
|
|||
toumaz Toumaz
|
||||
tplink TP-LINK Technologies Co., Ltd.
|
||||
truly Truly Semiconductors Limited
|
||||
upisemi uPI Semiconductor Corp.
|
||||
usi Universal Scientific Industrial Co., Ltd.
|
||||
v3 V3 Semiconductor
|
||||
variscite Variscite Ltd.
|
||||
|
|
19
MAINTAINERS
19
MAINTAINERS
|
@ -6740,6 +6740,12 @@ W: http://linuxtv.org
|
|||
S: Maintained
|
||||
F: drivers/media/radio/radio-maxiradio*
|
||||
|
||||
MCP4531 MICROCHIP DIGITAL POTENTIOMETER DRIVER
|
||||
M: Peter Rosin <peda@axentia.se>
|
||||
L: linux-iio@vger.kernel.org
|
||||
S: Maintained
|
||||
F: drivers/iio/potentiometer/mcp4531.c
|
||||
|
||||
MEDIA DRIVERS FOR RENESAS - VSP1
|
||||
M: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
|
||||
L: linux-media@vger.kernel.org
|
||||
|
@ -6975,6 +6981,13 @@ S: Supported
|
|||
F: include/linux/mlx5/
|
||||
F: drivers/infiniband/hw/mlx5/
|
||||
|
||||
MELEXIS MLX90614 DRIVER
|
||||
M: Crt Mori <cmo@melexis.com>
|
||||
L: linux-iio@vger.kernel.org
|
||||
W: http://www.melexis.com
|
||||
S: Supported
|
||||
F: drivers/iio/temperature/mlx90614.c
|
||||
|
||||
MN88472 MEDIA DRIVER
|
||||
M: Antti Palosaari <crope@iki.fi>
|
||||
L: linux-media@vger.kernel.org
|
||||
|
@ -10069,9 +10082,11 @@ F: drivers/staging/vt665?/
|
|||
|
||||
STAGING - WILC1000 WIFI DRIVER
|
||||
M: Johnny Kim <johnny.kim@atmel.com>
|
||||
M: Rachel Kim <rachel.kim@atmel.com>
|
||||
M: Dean Lee <dean.lee@atmel.com>
|
||||
M: Austin Shin <austin.shin@atmel.com>
|
||||
M: Chris Park <chris.park@atmel.com>
|
||||
M: Tony Cho <tony.cho@atmel.com>
|
||||
M: Glen Lee <glen.lee@atmel.com>
|
||||
M: Leo Kim <leo.kim@atmel.com>
|
||||
L: linux-wireless@vger.kernel.org
|
||||
S: Supported
|
||||
F: drivers/staging/wilc1000/
|
||||
|
|
|
@ -19,27 +19,7 @@ config IIO_BUFFER
|
|||
acquisition methods.
|
||||
|
||||
if IIO_BUFFER
|
||||
|
||||
config IIO_BUFFER_CB
|
||||
bool "IIO callback buffer used for push in-kernel interfaces"
|
||||
help
|
||||
Should be selected by any drivers that do in-kernel push
|
||||
usage. That is, those where the data is pushed to the consumer.
|
||||
|
||||
config IIO_KFIFO_BUF
|
||||
tristate "Industrial I/O buffering based on kfifo"
|
||||
help
|
||||
A simple fifo based on kfifo. Note that this currently provides
|
||||
no buffer events so it is up to userspace to work out how
|
||||
often to read from the buffer.
|
||||
|
||||
config IIO_TRIGGERED_BUFFER
|
||||
tristate
|
||||
select IIO_TRIGGER
|
||||
select IIO_KFIFO_BUF
|
||||
help
|
||||
Provides helper functions for setting up triggered buffers.
|
||||
|
||||
source "drivers/iio/buffer/Kconfig"
|
||||
endif # IIO_BUFFER
|
||||
|
||||
config IIO_TRIGGER
|
||||
|
@ -58,9 +38,16 @@ config IIO_CONSUMERS_PER_TRIGGER
|
|||
This value controls the maximum number of consumers that a
|
||||
given trigger may handle. Default is 2.
|
||||
|
||||
config IIO_TRIGGERED_EVENT
|
||||
tristate
|
||||
select IIO_TRIGGER
|
||||
help
|
||||
Provides helper functions for setting up triggered events.
|
||||
|
||||
source "drivers/iio/accel/Kconfig"
|
||||
source "drivers/iio/adc/Kconfig"
|
||||
source "drivers/iio/amplifiers/Kconfig"
|
||||
source "drivers/iio/chemical/Kconfig"
|
||||
source "drivers/iio/common/Kconfig"
|
||||
source "drivers/iio/dac/Kconfig"
|
||||
source "drivers/iio/frequency/Kconfig"
|
||||
|
@ -73,6 +60,7 @@ source "drivers/iio/orientation/Kconfig"
|
|||
if IIO_TRIGGER
|
||||
source "drivers/iio/trigger/Kconfig"
|
||||
endif #IIO_TRIGGER
|
||||
source "drivers/iio/potentiometer/Kconfig"
|
||||
source "drivers/iio/pressure/Kconfig"
|
||||
source "drivers/iio/proximity/Kconfig"
|
||||
source "drivers/iio/temperature/Kconfig"
|
||||
|
|
|
@ -6,14 +6,14 @@ obj-$(CONFIG_IIO) += industrialio.o
|
|||
industrialio-y := industrialio-core.o industrialio-event.o inkern.o
|
||||
industrialio-$(CONFIG_IIO_BUFFER) += industrialio-buffer.o
|
||||
industrialio-$(CONFIG_IIO_TRIGGER) += industrialio-trigger.o
|
||||
industrialio-$(CONFIG_IIO_BUFFER_CB) += buffer_cb.o
|
||||
|
||||
obj-$(CONFIG_IIO_TRIGGERED_BUFFER) += industrialio-triggered-buffer.o
|
||||
obj-$(CONFIG_IIO_KFIFO_BUF) += kfifo_buf.o
|
||||
obj-$(CONFIG_IIO_TRIGGERED_EVENT) += industrialio-triggered-event.o
|
||||
|
||||
obj-y += accel/
|
||||
obj-y += adc/
|
||||
obj-y += amplifiers/
|
||||
obj-y += buffer/
|
||||
obj-y += chemical/
|
||||
obj-y += common/
|
||||
obj-y += dac/
|
||||
obj-y += gyro/
|
||||
|
@ -23,6 +23,7 @@ obj-y += imu/
|
|||
obj-y += light/
|
||||
obj-y += magnetometer/
|
||||
obj-y += orientation/
|
||||
obj-y += potentiometer/
|
||||
obj-y += pressure/
|
||||
obj-y += proximity/
|
||||
obj-y += temperature/
|
||||
|
|
|
@ -19,19 +19,27 @@ config BMA180
|
|||
|
||||
config BMC150_ACCEL
|
||||
tristate "Bosch BMC150 Accelerometer Driver"
|
||||
depends on I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
select REGMAP
|
||||
select BMC150_ACCEL_I2C if I2C
|
||||
select BMC150_ACCEL_SPI if SPI
|
||||
help
|
||||
Say yes here to build support for the following Bosch accelerometers:
|
||||
BMC150, BMI055, BMA250E, BMA222E, BMA255, BMA280.
|
||||
|
||||
Currently this only supports the device via an i2c interface.
|
||||
|
||||
This is a combo module with both accelerometer and magnetometer.
|
||||
This driver is only implementing accelerometer part, which has
|
||||
its own address and register map.
|
||||
|
||||
config BMC150_ACCEL_I2C
|
||||
tristate
|
||||
select REGMAP_I2C
|
||||
|
||||
config BMC150_ACCEL_SPI
|
||||
tristate
|
||||
select REGMAP_SPI
|
||||
|
||||
config HID_SENSOR_ACCEL_3D
|
||||
depends on HID_SENSOR_HUB
|
||||
select IIO_BUFFER
|
||||
|
@ -100,13 +108,13 @@ config KXCJK1013
|
|||
be called kxcjk-1013.
|
||||
|
||||
config MMA8452
|
||||
tristate "Freescale MMA8452Q Accelerometer Driver"
|
||||
tristate "Freescale MMA8452Q and similar Accelerometers Driver"
|
||||
depends on I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to build support for the Freescale MMA8452Q 3-axis
|
||||
accelerometer.
|
||||
Say yes here to build support for the following Freescale 3-axis
|
||||
accelerometers: MMA8452Q, MMA8453Q, MMA8652FC, MMA8653FC.
|
||||
|
||||
To compile this driver as a module, choose M here: the module
|
||||
will be called mma8452.
|
||||
|
@ -137,6 +145,19 @@ config MMA9553
|
|||
To compile this driver as a module, choose M here: the module
|
||||
will be called mma9553.
|
||||
|
||||
config MXC4005
|
||||
tristate "Memsic MXC4005XC 3-Axis Accelerometer Driver"
|
||||
depends on I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
select REGMAP_I2C
|
||||
help
|
||||
Say yes here to build support for the Memsic MXC4005XC 3-axis
|
||||
accelerometer.
|
||||
|
||||
To compile this driver as a module, choose M. The module will be
|
||||
called mxc4005.
|
||||
|
||||
config STK8312
|
||||
tristate "Sensortek STK8312 3-Axis Accelerometer Driver"
|
||||
depends on I2C
|
||||
|
|
|
@ -4,7 +4,9 @@
|
|||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_BMA180) += bma180.o
|
||||
obj-$(CONFIG_BMC150_ACCEL) += bmc150-accel.o
|
||||
obj-$(CONFIG_BMC150_ACCEL) += bmc150-accel-core.o
|
||||
obj-$(CONFIG_BMC150_ACCEL_I2C) += bmc150-accel-i2c.o
|
||||
obj-$(CONFIG_BMC150_ACCEL_SPI) += bmc150-accel-spi.o
|
||||
obj-$(CONFIG_HID_SENSOR_ACCEL_3D) += hid-sensor-accel-3d.o
|
||||
obj-$(CONFIG_KXCJK1013) += kxcjk-1013.o
|
||||
obj-$(CONFIG_KXSD9) += kxsd9.o
|
||||
|
@ -14,6 +16,8 @@ obj-$(CONFIG_MMA9551_CORE) += mma9551_core.o
|
|||
obj-$(CONFIG_MMA9551) += mma9551.o
|
||||
obj-$(CONFIG_MMA9553) += mma9553.o
|
||||
|
||||
obj-$(CONFIG_MXC4005) += mxc4005.o
|
||||
|
||||
obj-$(CONFIG_STK8312) += stk8312.o
|
||||
obj-$(CONFIG_STK8BA50) += stk8ba50.o
|
||||
|
||||
|
|
|
@ -35,10 +35,12 @@
|
|||
#include <linux/iio/trigger.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
#include <linux/iio/triggered_buffer.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
#include "bmc150-accel.h"
|
||||
|
||||
#define BMC150_ACCEL_DRV_NAME "bmc150_accel"
|
||||
#define BMC150_ACCEL_IRQ_NAME "bmc150_accel_event"
|
||||
#define BMC150_ACCEL_GPIO_NAME "bmc150_accel_int"
|
||||
|
||||
#define BMC150_ACCEL_REG_CHIP_ID 0x00
|
||||
|
||||
|
@ -185,7 +187,9 @@ enum bmc150_accel_trigger_id {
|
|||
};
|
||||
|
||||
struct bmc150_accel_data {
|
||||
struct i2c_client *client;
|
||||
struct regmap *regmap;
|
||||
struct device *dev;
|
||||
int irq;
|
||||
struct bmc150_accel_interrupt interrupts[BMC150_ACCEL_INTERRUPTS];
|
||||
atomic_t active_intr;
|
||||
struct bmc150_accel_trigger triggers[BMC150_ACCEL_TRIGGERS];
|
||||
|
@ -242,6 +246,12 @@ static const struct {
|
|||
{500000, BMC150_ACCEL_SLEEP_500_MS},
|
||||
{1000000, BMC150_ACCEL_SLEEP_1_SEC} };
|
||||
|
||||
static const struct regmap_config bmc150_i2c_regmap_conf = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
.max_register = 0x3f,
|
||||
};
|
||||
|
||||
static int bmc150_accel_set_mode(struct bmc150_accel_data *data,
|
||||
enum bmc150_power_modes mode,
|
||||
int dur_us)
|
||||
|
@ -269,12 +279,11 @@ static int bmc150_accel_set_mode(struct bmc150_accel_data *data,
|
|||
lpw_bits = mode << BMC150_ACCEL_PMU_MODE_SHIFT;
|
||||
lpw_bits |= (dur_val << BMC150_ACCEL_PMU_BIT_SLEEP_DUR_SHIFT);
|
||||
|
||||
dev_dbg(&data->client->dev, "Set Mode bits %x\n", lpw_bits);
|
||||
dev_dbg(data->dev, "Set Mode bits %x\n", lpw_bits);
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_PMU_LPW, lpw_bits);
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_PMU_LPW, lpw_bits);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_pmu_lpw\n");
|
||||
dev_err(data->dev, "Error writing reg_pmu_lpw\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -290,8 +299,7 @@ static int bmc150_accel_set_bw(struct bmc150_accel_data *data, int val,
|
|||
for (i = 0; i < ARRAY_SIZE(bmc150_accel_samp_freq_table); ++i) {
|
||||
if (bmc150_accel_samp_freq_table[i].val == val &&
|
||||
bmc150_accel_samp_freq_table[i].val2 == val2) {
|
||||
ret = i2c_smbus_write_byte_data(
|
||||
data->client,
|
||||
ret = regmap_write(data->regmap,
|
||||
BMC150_ACCEL_REG_PMU_BW,
|
||||
bmc150_accel_samp_freq_table[i].bw_bits);
|
||||
if (ret < 0)
|
||||
|
@ -308,30 +316,23 @@ static int bmc150_accel_set_bw(struct bmc150_accel_data *data, int val,
|
|||
|
||||
static int bmc150_accel_update_slope(struct bmc150_accel_data *data)
|
||||
{
|
||||
int ret, val;
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, BMC150_ACCEL_REG_INT_6,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_6,
|
||||
data->slope_thres);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_6\n");
|
||||
dev_err(data->dev, "Error writing reg_int_6\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_INT_5);
|
||||
ret = regmap_update_bits(data->regmap, BMC150_ACCEL_REG_INT_5,
|
||||
BMC150_ACCEL_SLOPE_DUR_MASK, data->slope_dur);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_5\n");
|
||||
dev_err(data->dev, "Error updating reg_int_5\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
val = (ret & ~BMC150_ACCEL_SLOPE_DUR_MASK) | data->slope_dur;
|
||||
ret = i2c_smbus_write_byte_data(data->client, BMC150_ACCEL_REG_INT_5,
|
||||
val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error write reg_int_5\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_dbg(&data->client->dev, "%s: %x %x\n", __func__, data->slope_thres,
|
||||
dev_dbg(data->dev, "%s: %x %x\n", __func__, data->slope_thres,
|
||||
data->slope_dur);
|
||||
|
||||
return ret;
|
||||
|
@ -380,17 +381,17 @@ static int bmc150_accel_set_power_state(struct bmc150_accel_data *data, bool on)
|
|||
int ret;
|
||||
|
||||
if (on) {
|
||||
ret = pm_runtime_get_sync(&data->client->dev);
|
||||
ret = pm_runtime_get_sync(data->dev);
|
||||
} else {
|
||||
pm_runtime_mark_last_busy(&data->client->dev);
|
||||
ret = pm_runtime_put_autosuspend(&data->client->dev);
|
||||
pm_runtime_mark_last_busy(data->dev);
|
||||
ret = pm_runtime_put_autosuspend(data->dev);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Failed: bmc150_accel_set_power_state for %d\n", on);
|
||||
if (on)
|
||||
pm_runtime_put_noidle(&data->client->dev);
|
||||
pm_runtime_put_noidle(data->dev);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
@ -470,38 +471,18 @@ static int bmc150_accel_set_interrupt(struct bmc150_accel_data *data, int i,
|
|||
return ret;
|
||||
|
||||
/* map the interrupt to the appropriate pins */
|
||||
ret = i2c_smbus_read_byte_data(data->client, info->map_reg);
|
||||
ret = regmap_update_bits(data->regmap, info->map_reg, info->map_bitmask,
|
||||
(state ? info->map_bitmask : 0));
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_map\n");
|
||||
goto out_fix_power_state;
|
||||
}
|
||||
if (state)
|
||||
ret |= info->map_bitmask;
|
||||
else
|
||||
ret &= ~info->map_bitmask;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, info->map_reg,
|
||||
ret);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_map\n");
|
||||
dev_err(data->dev, "Error updating reg_int_map\n");
|
||||
goto out_fix_power_state;
|
||||
}
|
||||
|
||||
/* enable/disable the interrupt */
|
||||
ret = i2c_smbus_read_byte_data(data->client, info->en_reg);
|
||||
ret = regmap_update_bits(data->regmap, info->en_reg, info->en_bitmask,
|
||||
(state ? info->en_bitmask : 0));
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_en\n");
|
||||
goto out_fix_power_state;
|
||||
}
|
||||
|
||||
if (state)
|
||||
ret |= info->en_bitmask;
|
||||
else
|
||||
ret &= ~info->en_bitmask;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, info->en_reg, ret);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_en\n");
|
||||
dev_err(data->dev, "Error updating reg_int_en\n");
|
||||
goto out_fix_power_state;
|
||||
}
|
||||
|
||||
|
@ -523,12 +504,11 @@ static int bmc150_accel_set_scale(struct bmc150_accel_data *data, int val)
|
|||
|
||||
for (i = 0; i < ARRAY_SIZE(data->chip_info->scale_table); ++i) {
|
||||
if (data->chip_info->scale_table[i].scale == val) {
|
||||
ret = i2c_smbus_write_byte_data(
|
||||
data->client,
|
||||
ret = regmap_write(data->regmap,
|
||||
BMC150_ACCEL_REG_PMU_RANGE,
|
||||
data->chip_info->scale_table[i].reg_range);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing pmu_range\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -544,16 +524,17 @@ static int bmc150_accel_set_scale(struct bmc150_accel_data *data, int val)
|
|||
static int bmc150_accel_get_temp(struct bmc150_accel_data *data, int *val)
|
||||
{
|
||||
int ret;
|
||||
unsigned int value;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_TEMP);
|
||||
ret = regmap_read(data->regmap, BMC150_ACCEL_REG_TEMP, &value);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_temp\n");
|
||||
dev_err(data->dev, "Error reading reg_temp\n");
|
||||
mutex_unlock(&data->mutex);
|
||||
return ret;
|
||||
}
|
||||
*val = sign_extend32(ret, 7);
|
||||
*val = sign_extend32(value, 7);
|
||||
|
||||
mutex_unlock(&data->mutex);
|
||||
|
||||
|
@ -566,6 +547,7 @@ static int bmc150_accel_get_axis(struct bmc150_accel_data *data,
|
|||
{
|
||||
int ret;
|
||||
int axis = chan->scan_index;
|
||||
unsigned int raw_val;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
ret = bmc150_accel_set_power_state(data, true);
|
||||
|
@ -574,15 +556,15 @@ static int bmc150_accel_get_axis(struct bmc150_accel_data *data,
|
|||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_read_word_data(data->client,
|
||||
BMC150_ACCEL_AXIS_TO_REG(axis));
|
||||
ret = regmap_bulk_read(data->regmap, BMC150_ACCEL_AXIS_TO_REG(axis),
|
||||
&raw_val, 2);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading axis %d\n", axis);
|
||||
dev_err(data->dev, "Error reading axis %d\n", axis);
|
||||
bmc150_accel_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
return ret;
|
||||
}
|
||||
*val = sign_extend32(ret >> chan->scan_type.shift,
|
||||
*val = sign_extend32(raw_val >> chan->scan_type.shift,
|
||||
chan->scan_type.realbits - 1);
|
||||
ret = bmc150_accel_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
|
@ -846,52 +828,34 @@ static int bmc150_accel_set_watermark(struct iio_dev *indio_dev, unsigned val)
|
|||
* We must read at least one full frame in one burst, otherwise the rest of the
|
||||
* frame data is discarded.
|
||||
*/
|
||||
static int bmc150_accel_fifo_transfer(const struct i2c_client *client,
|
||||
static int bmc150_accel_fifo_transfer(struct bmc150_accel_data *data,
|
||||
char *buffer, int samples)
|
||||
{
|
||||
int sample_length = 3 * 2;
|
||||
u8 reg_fifo_data = BMC150_ACCEL_REG_FIFO_DATA;
|
||||
int ret = -EIO;
|
||||
int ret;
|
||||
int total_length = samples * sample_length;
|
||||
int i;
|
||||
size_t step = regmap_get_raw_read_max(data->regmap);
|
||||
|
||||
if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
||||
struct i2c_msg msg[2] = {
|
||||
{
|
||||
.addr = client->addr,
|
||||
.flags = 0,
|
||||
.buf = ®_fifo_data,
|
||||
.len = sizeof(reg_fifo_data),
|
||||
},
|
||||
{
|
||||
.addr = client->addr,
|
||||
.flags = I2C_M_RD,
|
||||
.buf = (u8 *)buffer,
|
||||
.len = samples * sample_length,
|
||||
}
|
||||
};
|
||||
if (!step || step > total_length)
|
||||
step = total_length;
|
||||
else if (step < total_length)
|
||||
step = sample_length;
|
||||
|
||||
ret = i2c_transfer(client->adapter, msg, 2);
|
||||
if (ret != 2)
|
||||
ret = -EIO;
|
||||
else
|
||||
ret = 0;
|
||||
} else {
|
||||
int i, step = I2C_SMBUS_BLOCK_MAX / sample_length;
|
||||
|
||||
for (i = 0; i < samples * sample_length; i += step) {
|
||||
ret = i2c_smbus_read_i2c_block_data(client,
|
||||
reg_fifo_data, step,
|
||||
&buffer[i]);
|
||||
if (ret != step) {
|
||||
ret = -EIO;
|
||||
/*
|
||||
* Seems we have a bus with size limitation so we have to execute
|
||||
* multiple reads
|
||||
*/
|
||||
for (i = 0; i < total_length; i += step) {
|
||||
ret = regmap_raw_read(data->regmap, BMC150_ACCEL_REG_FIFO_DATA,
|
||||
&buffer[i], step);
|
||||
if (ret)
|
||||
break;
|
||||
}
|
||||
|
||||
ret = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret)
|
||||
dev_err(&client->dev, "Error transferring data from fifo\n");
|
||||
dev_err(data->dev, "Error transferring data from fifo in single steps of %zu\n",
|
||||
step);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
@ -905,15 +869,15 @@ static int __bmc150_accel_fifo_flush(struct iio_dev *indio_dev,
|
|||
u16 buffer[BMC150_ACCEL_FIFO_LENGTH * 3];
|
||||
int64_t tstamp;
|
||||
uint64_t sample_period;
|
||||
unsigned int val;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_FIFO_STATUS);
|
||||
ret = regmap_read(data->regmap, BMC150_ACCEL_REG_FIFO_STATUS, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_fifo_status\n");
|
||||
dev_err(data->dev, "Error reading reg_fifo_status\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
count = ret & 0x7F;
|
||||
count = val & 0x7F;
|
||||
|
||||
if (!count)
|
||||
return 0;
|
||||
|
@ -952,7 +916,7 @@ static int __bmc150_accel_fifo_flush(struct iio_dev *indio_dev,
|
|||
if (samples && count > samples)
|
||||
count = samples;
|
||||
|
||||
ret = bmc150_accel_fifo_transfer(data->client, (u8 *)buffer, count);
|
||||
ret = bmc150_accel_fifo_transfer(data, (u8 *)buffer, count);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
|
@ -1052,15 +1016,6 @@ static const struct iio_chan_spec bmc150_accel_channels[] =
|
|||
static const struct iio_chan_spec bma280_accel_channels[] =
|
||||
BMC150_ACCEL_CHANNELS(14);
|
||||
|
||||
enum {
|
||||
bmc150,
|
||||
bmi055,
|
||||
bma255,
|
||||
bma250e,
|
||||
bma222e,
|
||||
bma280,
|
||||
};
|
||||
|
||||
static const struct bmc150_accel_chip_info bmc150_accel_chip_info_tbl[] = {
|
||||
[bmc150] = {
|
||||
.name = "BMC150A",
|
||||
|
@ -1155,17 +1110,19 @@ static irqreturn_t bmc150_accel_trigger_handler(int irq, void *p)
|
|||
struct iio_dev *indio_dev = pf->indio_dev;
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
int bit, ret, i = 0;
|
||||
unsigned int raw_val;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
for_each_set_bit(bit, indio_dev->active_scan_mask,
|
||||
indio_dev->masklength) {
|
||||
ret = i2c_smbus_read_word_data(data->client,
|
||||
BMC150_ACCEL_AXIS_TO_REG(bit));
|
||||
ret = regmap_bulk_read(data->regmap,
|
||||
BMC150_ACCEL_AXIS_TO_REG(bit), &raw_val,
|
||||
2);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&data->mutex);
|
||||
goto err_read;
|
||||
}
|
||||
data->buffer[i++] = ret;
|
||||
data->buffer[i++] = raw_val;
|
||||
}
|
||||
mutex_unlock(&data->mutex);
|
||||
|
||||
|
@ -1189,13 +1146,12 @@ static int bmc150_accel_trig_try_reen(struct iio_trigger *trig)
|
|||
|
||||
mutex_lock(&data->mutex);
|
||||
/* clear any latched interrupt */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
BMC150_ACCEL_INT_MODE_LATCH_INT |
|
||||
BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
||||
mutex_unlock(&data->mutex);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_int_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -1249,20 +1205,20 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
int dir;
|
||||
int ret;
|
||||
unsigned int val;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_INT_STATUS_2);
|
||||
ret = regmap_read(data->regmap, BMC150_ACCEL_REG_INT_STATUS_2, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_status_2\n");
|
||||
dev_err(data->dev, "Error reading reg_int_status_2\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (ret & BMC150_ACCEL_ANY_MOTION_BIT_SIGN)
|
||||
if (val & BMC150_ACCEL_ANY_MOTION_BIT_SIGN)
|
||||
dir = IIO_EV_DIR_FALLING;
|
||||
else
|
||||
dir = IIO_EV_DIR_RISING;
|
||||
|
||||
if (ret & BMC150_ACCEL_ANY_MOTION_BIT_X)
|
||||
if (val & BMC150_ACCEL_ANY_MOTION_BIT_X)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
||||
0,
|
||||
|
@ -1271,7 +1227,7 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|||
dir),
|
||||
data->timestamp);
|
||||
|
||||
if (ret & BMC150_ACCEL_ANY_MOTION_BIT_Y)
|
||||
if (val & BMC150_ACCEL_ANY_MOTION_BIT_Y)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
||||
0,
|
||||
|
@ -1280,7 +1236,7 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|||
dir),
|
||||
data->timestamp);
|
||||
|
||||
if (ret & BMC150_ACCEL_ANY_MOTION_BIT_Z)
|
||||
if (val & BMC150_ACCEL_ANY_MOTION_BIT_Z)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
||||
0,
|
||||
|
@ -1315,13 +1271,11 @@ static irqreturn_t bmc150_accel_irq_thread_handler(int irq, void *private)
|
|||
}
|
||||
|
||||
if (ack) {
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
BMC150_ACCEL_INT_MODE_LATCH_INT |
|
||||
BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
||||
if (ret)
|
||||
dev_err(&data->client->dev,
|
||||
"Error writing reg_int_rst_latch\n");
|
||||
dev_err(data->dev, "Error writing reg_int_rst_latch\n");
|
||||
|
||||
ret = IRQ_HANDLED;
|
||||
} else {
|
||||
|
@ -1360,32 +1314,6 @@ static irqreturn_t bmc150_accel_irq_handler(int irq, void *private)
|
|||
return IRQ_NONE;
|
||||
}
|
||||
|
||||
static int bmc150_accel_gpio_probe(struct i2c_client *client,
|
||||
struct bmc150_accel_data *data)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, BMC150_ACCEL_GPIO_NAME, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "Failed: gpio get index\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct {
|
||||
int intr;
|
||||
const char *name;
|
||||
|
@ -1423,7 +1351,7 @@ static int bmc150_accel_triggers_setup(struct iio_dev *indio_dev,
|
|||
for (i = 0; i < BMC150_ACCEL_TRIGGERS; i++) {
|
||||
struct bmc150_accel_trigger *t = &data->triggers[i];
|
||||
|
||||
t->indio_trig = devm_iio_trigger_alloc(&data->client->dev,
|
||||
t->indio_trig = devm_iio_trigger_alloc(data->dev,
|
||||
bmc150_accel_triggers[i].name,
|
||||
indio_dev->name,
|
||||
indio_dev->id);
|
||||
|
@ -1432,7 +1360,7 @@ static int bmc150_accel_triggers_setup(struct iio_dev *indio_dev,
|
|||
break;
|
||||
}
|
||||
|
||||
t->indio_trig->dev.parent = &data->client->dev;
|
||||
t->indio_trig->dev.parent = data->dev;
|
||||
t->indio_trig->ops = &bmc150_accel_trigger_ops;
|
||||
t->intr = bmc150_accel_triggers[i].intr;
|
||||
t->data = data;
|
||||
|
@ -1459,20 +1387,19 @@ static int bmc150_accel_fifo_set_mode(struct bmc150_accel_data *data)
|
|||
u8 reg = BMC150_ACCEL_REG_FIFO_CONFIG1;
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, reg, data->fifo_mode);
|
||||
ret = regmap_write(data->regmap, reg, data->fifo_mode);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_fifo_config1\n");
|
||||
dev_err(data->dev, "Error writing reg_fifo_config1\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (!data->fifo_mode)
|
||||
return 0;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_FIFO_CONFIG0,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_FIFO_CONFIG0,
|
||||
data->watermark);
|
||||
if (ret < 0)
|
||||
dev_err(&data->client->dev, "Error writing reg_fifo_config0\n");
|
||||
dev_err(data->dev, "Error writing reg_fifo_config0\n");
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
@ -1557,23 +1484,25 @@ static const struct iio_buffer_setup_ops bmc150_accel_buffer_ops = {
|
|||
static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
||||
{
|
||||
int ret, i;
|
||||
unsigned int val;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_CHIP_ID);
|
||||
ret = regmap_read(data->regmap, BMC150_ACCEL_REG_CHIP_ID, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error: Reading chip id\n");
|
||||
dev_err(data->dev,
|
||||
"Error: Reading chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_dbg(&data->client->dev, "Chip Id %x\n", ret);
|
||||
dev_dbg(data->dev, "Chip Id %x\n", val);
|
||||
for (i = 0; i < ARRAY_SIZE(bmc150_accel_chip_info_tbl); i++) {
|
||||
if (bmc150_accel_chip_info_tbl[i].chip_id == ret) {
|
||||
if (bmc150_accel_chip_info_tbl[i].chip_id == val) {
|
||||
data->chip_info = &bmc150_accel_chip_info_tbl[i];
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!data->chip_info) {
|
||||
dev_err(&data->client->dev, "Unsupported chip %x\n", ret);
|
||||
dev_err(data->dev, "Invalid chip %x\n", val);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
|
@ -1587,11 +1516,11 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|||
return ret;
|
||||
|
||||
/* Set Default Range */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_PMU_RANGE,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_PMU_RANGE,
|
||||
BMC150_ACCEL_DEF_RANGE_4G);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_pmu_range\n");
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_pmu_range\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -1605,12 +1534,11 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|||
return ret;
|
||||
|
||||
/* Set default as latched interrupts */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
BMC150_ACCEL_INT_MODE_LATCH_INT |
|
||||
BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_int_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -1618,24 +1546,23 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int bmc150_accel_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
int bmc150_accel_core_probe(struct device *dev, struct regmap *regmap, int irq,
|
||||
const char *name, bool block_supported)
|
||||
{
|
||||
struct bmc150_accel_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
int ret;
|
||||
const char *name = NULL;
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||||
indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
data = iio_priv(indio_dev);
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
data->client = client;
|
||||
dev_set_drvdata(dev, indio_dev);
|
||||
data->dev = dev;
|
||||
data->irq = irq;
|
||||
|
||||
if (id)
|
||||
name = id->name;
|
||||
data->regmap = regmap;
|
||||
|
||||
ret = bmc150_accel_chip_init(data);
|
||||
if (ret < 0)
|
||||
|
@ -1643,7 +1570,7 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|||
|
||||
mutex_init(&data->mutex);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->dev.parent = dev;
|
||||
indio_dev->channels = data->chip_info->channels;
|
||||
indio_dev->num_channels = data->chip_info->num_channels;
|
||||
indio_dev->name = name ? name : data->chip_info->name;
|
||||
|
@ -1655,16 +1582,13 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|||
bmc150_accel_trigger_handler,
|
||||
&bmc150_accel_buffer_ops);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Failed: iio triggered buffer setup\n");
|
||||
dev_err(data->dev, "Failed: iio triggered buffer setup\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = bmc150_accel_gpio_probe(client, data);
|
||||
|
||||
if (client->irq > 0) {
|
||||
if (data->irq > 0) {
|
||||
ret = devm_request_threaded_irq(
|
||||
&client->dev, client->irq,
|
||||
data->dev, data->irq,
|
||||
bmc150_accel_irq_handler,
|
||||
bmc150_accel_irq_thread_handler,
|
||||
IRQF_TRIGGER_RISING,
|
||||
|
@ -1679,11 +1603,10 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|||
* want to use latch mode when we can to prevent interrupt
|
||||
* flooding.
|
||||
*/
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
||||
BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_rst_latch\n");
|
||||
dev_err(data->dev, "Error writing reg_int_rst_latch\n");
|
||||
goto err_buffer_cleanup;
|
||||
}
|
||||
|
||||
|
@ -1693,9 +1616,7 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|||
if (ret)
|
||||
goto err_buffer_cleanup;
|
||||
|
||||
if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) ||
|
||||
i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
|
||||
if (block_supported) {
|
||||
indio_dev->modes |= INDIO_BUFFER_SOFTWARE;
|
||||
indio_dev->info = &bmc150_accel_info_fifo;
|
||||
indio_dev->buffer->attrs = bmc150_accel_fifo_attributes;
|
||||
|
@ -1704,18 +1625,17 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Unable to register iio device\n");
|
||||
dev_err(dev, "Unable to register iio device\n");
|
||||
goto err_trigger_unregister;
|
||||
}
|
||||
|
||||
ret = pm_runtime_set_active(&client->dev);
|
||||
ret = pm_runtime_set_active(dev);
|
||||
if (ret)
|
||||
goto err_iio_unregister;
|
||||
|
||||
pm_runtime_enable(&client->dev);
|
||||
pm_runtime_set_autosuspend_delay(&client->dev,
|
||||
BMC150_AUTO_SUSPEND_DELAY_MS);
|
||||
pm_runtime_use_autosuspend(&client->dev);
|
||||
pm_runtime_enable(dev);
|
||||
pm_runtime_set_autosuspend_delay(dev, BMC150_AUTO_SUSPEND_DELAY_MS);
|
||||
pm_runtime_use_autosuspend(dev);
|
||||
|
||||
return 0;
|
||||
|
||||
|
@ -1728,15 +1648,16 @@ err_buffer_cleanup:
|
|||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(bmc150_accel_core_probe);
|
||||
|
||||
static int bmc150_accel_remove(struct i2c_client *client)
|
||||
int bmc150_accel_core_remove(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
|
||||
pm_runtime_disable(&client->dev);
|
||||
pm_runtime_set_suspended(&client->dev);
|
||||
pm_runtime_put_noidle(&client->dev);
|
||||
pm_runtime_disable(data->dev);
|
||||
pm_runtime_set_suspended(data->dev);
|
||||
pm_runtime_put_noidle(data->dev);
|
||||
|
||||
iio_device_unregister(indio_dev);
|
||||
|
||||
|
@ -1750,11 +1671,12 @@ static int bmc150_accel_remove(struct i2c_client *client)
|
|||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(bmc150_accel_core_remove);
|
||||
|
||||
#ifdef CONFIG_PM_SLEEP
|
||||
static int bmc150_accel_suspend(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
|
@ -1766,7 +1688,7 @@ static int bmc150_accel_suspend(struct device *dev)
|
|||
|
||||
static int bmc150_accel_resume(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
|
@ -1782,11 +1704,11 @@ static int bmc150_accel_resume(struct device *dev)
|
|||
#ifdef CONFIG_PM
|
||||
static int bmc150_accel_runtime_suspend(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
dev_dbg(&data->client->dev, __func__);
|
||||
dev_dbg(data->dev, __func__);
|
||||
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_SUSPEND, 0);
|
||||
if (ret < 0)
|
||||
return -EAGAIN;
|
||||
|
@ -1796,12 +1718,12 @@ static int bmc150_accel_runtime_suspend(struct device *dev)
|
|||
|
||||
static int bmc150_accel_runtime_resume(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
int sleep_val;
|
||||
|
||||
dev_dbg(&data->client->dev, __func__);
|
||||
dev_dbg(data->dev, __func__);
|
||||
|
||||
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_NORMAL, 0);
|
||||
if (ret < 0)
|
||||
|
@ -1820,47 +1742,12 @@ static int bmc150_accel_runtime_resume(struct device *dev)
|
|||
}
|
||||
#endif
|
||||
|
||||
static const struct dev_pm_ops bmc150_accel_pm_ops = {
|
||||
const struct dev_pm_ops bmc150_accel_pm_ops = {
|
||||
SET_SYSTEM_SLEEP_PM_OPS(bmc150_accel_suspend, bmc150_accel_resume)
|
||||
SET_RUNTIME_PM_OPS(bmc150_accel_runtime_suspend,
|
||||
bmc150_accel_runtime_resume, NULL)
|
||||
};
|
||||
|
||||
static const struct acpi_device_id bmc150_accel_acpi_match[] = {
|
||||
{"BSBA0150", bmc150},
|
||||
{"BMC150A", bmc150},
|
||||
{"BMI055A", bmi055},
|
||||
{"BMA0255", bma255},
|
||||
{"BMA250E", bma250e},
|
||||
{"BMA222E", bma222e},
|
||||
{"BMA0280", bma280},
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(acpi, bmc150_accel_acpi_match);
|
||||
|
||||
static const struct i2c_device_id bmc150_accel_id[] = {
|
||||
{"bmc150_accel", bmc150},
|
||||
{"bmi055_accel", bmi055},
|
||||
{"bma255", bma255},
|
||||
{"bma250e", bma250e},
|
||||
{"bma222e", bma222e},
|
||||
{"bma280", bma280},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, bmc150_accel_id);
|
||||
|
||||
static struct i2c_driver bmc150_accel_driver = {
|
||||
.driver = {
|
||||
.name = BMC150_ACCEL_DRV_NAME,
|
||||
.acpi_match_table = ACPI_PTR(bmc150_accel_acpi_match),
|
||||
.pm = &bmc150_accel_pm_ops,
|
||||
},
|
||||
.probe = bmc150_accel_probe,
|
||||
.remove = bmc150_accel_remove,
|
||||
.id_table = bmc150_accel_id,
|
||||
};
|
||||
module_i2c_driver(bmc150_accel_driver);
|
||||
EXPORT_SYMBOL_GPL(bmc150_accel_pm_ops);
|
||||
|
||||
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
102
drivers/iio/accel/bmc150-accel-i2c.c
Normal file
102
drivers/iio/accel/bmc150-accel-i2c.c
Normal file
|
@ -0,0 +1,102 @@
|
|||
/*
|
||||
* 3-axis accelerometer driver supporting following I2C Bosch-Sensortec chips:
|
||||
* - BMC150
|
||||
* - BMI055
|
||||
* - BMA255
|
||||
* - BMA250E
|
||||
* - BMA222E
|
||||
* - BMA280
|
||||
*
|
||||
* Copyright (c) 2014, Intel Corporation.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope 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.
|
||||
*/
|
||||
|
||||
#include <linux/device.h>
|
||||
#include <linux/mod_devicetable.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/acpi.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
#include "bmc150-accel.h"
|
||||
|
||||
static const struct regmap_config bmc150_i2c_regmap_conf = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
};
|
||||
|
||||
static int bmc150_accel_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct regmap *regmap;
|
||||
const char *name = NULL;
|
||||
bool block_supported =
|
||||
i2c_check_functionality(client->adapter, I2C_FUNC_I2C) ||
|
||||
i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_READ_I2C_BLOCK);
|
||||
|
||||
regmap = devm_regmap_init_i2c(client, &bmc150_i2c_regmap_conf);
|
||||
if (IS_ERR(regmap)) {
|
||||
dev_err(&client->dev, "Failed to initialize i2c regmap\n");
|
||||
return PTR_ERR(regmap);
|
||||
}
|
||||
|
||||
if (id)
|
||||
name = id->name;
|
||||
|
||||
return bmc150_accel_core_probe(&client->dev, regmap, client->irq, name,
|
||||
block_supported);
|
||||
}
|
||||
|
||||
static int bmc150_accel_remove(struct i2c_client *client)
|
||||
{
|
||||
return bmc150_accel_core_remove(&client->dev);
|
||||
}
|
||||
|
||||
static const struct acpi_device_id bmc150_accel_acpi_match[] = {
|
||||
{"BSBA0150", bmc150},
|
||||
{"BMC150A", bmc150},
|
||||
{"BMI055A", bmi055},
|
||||
{"BMA0255", bma255},
|
||||
{"BMA250E", bma250e},
|
||||
{"BMA222E", bma222e},
|
||||
{"BMA0280", bma280},
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(acpi, bmc150_accel_acpi_match);
|
||||
|
||||
static const struct i2c_device_id bmc150_accel_id[] = {
|
||||
{"bmc150_accel", bmc150},
|
||||
{"bmi055_accel", bmi055},
|
||||
{"bma255", bma255},
|
||||
{"bma250e", bma250e},
|
||||
{"bma222e", bma222e},
|
||||
{"bma280", bma280},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, bmc150_accel_id);
|
||||
|
||||
static struct i2c_driver bmc150_accel_driver = {
|
||||
.driver = {
|
||||
.name = "bmc150_accel_i2c",
|
||||
.acpi_match_table = ACPI_PTR(bmc150_accel_acpi_match),
|
||||
.pm = &bmc150_accel_pm_ops,
|
||||
},
|
||||
.probe = bmc150_accel_probe,
|
||||
.remove = bmc150_accel_remove,
|
||||
.id_table = bmc150_accel_id,
|
||||
};
|
||||
module_i2c_driver(bmc150_accel_driver);
|
||||
|
||||
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("BMC150 I2C accelerometer driver");
|
91
drivers/iio/accel/bmc150-accel-spi.c
Normal file
91
drivers/iio/accel/bmc150-accel-spi.c
Normal file
|
@ -0,0 +1,91 @@
|
|||
/*
|
||||
* 3-axis accelerometer driver supporting SPI Bosch-Sensortec accelerometer chip
|
||||
* Copyright © 2015 Pengutronix, Markus Pargmann <mpa@pengutronix.de>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <linux/device.h>
|
||||
#include <linux/mod_devicetable.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/acpi.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/spi/spi.h>
|
||||
|
||||
#include "bmc150-accel.h"
|
||||
|
||||
static const struct regmap_config bmc150_spi_regmap_conf = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
.max_register = 0x3f,
|
||||
};
|
||||
|
||||
static int bmc150_accel_probe(struct spi_device *spi)
|
||||
{
|
||||
struct regmap *regmap;
|
||||
const struct spi_device_id *id = spi_get_device_id(spi);
|
||||
|
||||
regmap = devm_regmap_init_spi(spi, &bmc150_spi_regmap_conf);
|
||||
if (IS_ERR(regmap)) {
|
||||
dev_err(&spi->dev, "Failed to initialize spi regmap\n");
|
||||
return PTR_ERR(regmap);
|
||||
}
|
||||
|
||||
return bmc150_accel_core_probe(&spi->dev, regmap, spi->irq, id->name,
|
||||
true);
|
||||
}
|
||||
|
||||
static int bmc150_accel_remove(struct spi_device *spi)
|
||||
{
|
||||
return bmc150_accel_core_remove(&spi->dev);
|
||||
}
|
||||
|
||||
static const struct acpi_device_id bmc150_accel_acpi_match[] = {
|
||||
{"BSBA0150", bmc150},
|
||||
{"BMC150A", bmc150},
|
||||
{"BMI055A", bmi055},
|
||||
{"BMA0255", bma255},
|
||||
{"BMA250E", bma250e},
|
||||
{"BMA222E", bma222e},
|
||||
{"BMA0280", bma280},
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(acpi, bmc150_accel_acpi_match);
|
||||
|
||||
static const struct spi_device_id bmc150_accel_id[] = {
|
||||
{"bmc150_accel", bmc150},
|
||||
{"bmi055_accel", bmi055},
|
||||
{"bma255", bma255},
|
||||
{"bma250e", bma250e},
|
||||
{"bma222e", bma222e},
|
||||
{"bma280", bma280},
|
||||
{}
|
||||
};
|
||||
MODULE_DEVICE_TABLE(spi, bmc150_accel_id);
|
||||
|
||||
static struct spi_driver bmc150_accel_driver = {
|
||||
.driver = {
|
||||
.name = "bmc150_accel_spi",
|
||||
.acpi_match_table = ACPI_PTR(bmc150_accel_acpi_match),
|
||||
.pm = &bmc150_accel_pm_ops,
|
||||
},
|
||||
.probe = bmc150_accel_probe,
|
||||
.remove = bmc150_accel_remove,
|
||||
.id_table = bmc150_accel_id,
|
||||
};
|
||||
module_spi_driver(bmc150_accel_driver);
|
||||
|
||||
MODULE_AUTHOR("Markus Pargmann <mpa@pengutronix.de>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("BMC150 SPI accelerometer driver");
|
20
drivers/iio/accel/bmc150-accel.h
Normal file
20
drivers/iio/accel/bmc150-accel.h
Normal file
|
@ -0,0 +1,20 @@
|
|||
#ifndef _BMC150_ACCEL_H_
|
||||
#define _BMC150_ACCEL_H_
|
||||
|
||||
struct regmap;
|
||||
|
||||
enum {
|
||||
bmc150,
|
||||
bmi055,
|
||||
bma255,
|
||||
bma250e,
|
||||
bma222e,
|
||||
bma280,
|
||||
};
|
||||
|
||||
int bmc150_accel_core_probe(struct device *dev, struct regmap *regmap, int irq,
|
||||
const char *name, bool block_supported);
|
||||
int bmc150_accel_core_remove(struct device *dev);
|
||||
extern const struct dev_pm_ops bmc150_accel_pm_ops;
|
||||
|
||||
#endif /* _BMC150_ACCEL_H_ */
|
|
@ -1162,35 +1162,6 @@ static const char *kxcjk1013_match_acpi_device(struct device *dev,
|
|||
return dev_name(dev);
|
||||
}
|
||||
|
||||
static int kxcjk1013_gpio_probe(struct i2c_client *client,
|
||||
struct kxcjk1013_data *data)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
if (data->is_smo8500_device)
|
||||
return -ENOTSUPP;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, "kxcjk1013_int", 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "acpi gpio get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int kxcjk1013_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
|
@ -1237,10 +1208,7 @@ static int kxcjk1013_probe(struct i2c_client *client,
|
|||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &kxcjk1013_info;
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = kxcjk1013_gpio_probe(client, data);
|
||||
|
||||
if (client->irq > 0) {
|
||||
if (client->irq > 0 && !data->is_smo8500_device) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
kxcjk1013_data_rdy_trig_poll,
|
||||
kxcjk1013_event_handler,
|
||||
|
|
|
@ -1,6 +1,12 @@
|
|||
/*
|
||||
* mma8452.c - Support for Freescale MMA8452Q 3-axis 12-bit accelerometer
|
||||
* mma8452.c - Support for following Freescale 3-axis accelerometers:
|
||||
*
|
||||
* MMA8452Q (12 bit)
|
||||
* MMA8453Q (10 bit)
|
||||
* MMA8652FC (12 bit)
|
||||
* MMA8653FC (10 bit)
|
||||
*
|
||||
* Copyright 2015 Martin Kepplinger <martin.kepplinger@theobroma-systems.com>
|
||||
* Copyright 2014 Peter Meerwald <pmeerw@pmeerw.net>
|
||||
*
|
||||
* This file is subject to the terms and conditions of version 2 of
|
||||
|
@ -22,10 +28,11 @@
|
|||
#include <linux/iio/triggered_buffer.h>
|
||||
#include <linux/iio/events.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/of_device.h>
|
||||
|
||||
#define MMA8452_STATUS 0x00
|
||||
#define MMA8452_STATUS_DRDY (BIT(2) | BIT(1) | BIT(0))
|
||||
#define MMA8452_OUT_X 0x01 /* MSB first, 12-bit */
|
||||
#define MMA8452_OUT_X 0x01 /* MSB first */
|
||||
#define MMA8452_OUT_Y 0x03
|
||||
#define MMA8452_OUT_Z 0x05
|
||||
#define MMA8452_INT_SRC 0x0c
|
||||
|
@ -38,6 +45,16 @@
|
|||
#define MMA8452_DATA_CFG_HPF_MASK BIT(4)
|
||||
#define MMA8452_HP_FILTER_CUTOFF 0x0f
|
||||
#define MMA8452_HP_FILTER_CUTOFF_SEL_MASK GENMASK(1, 0)
|
||||
#define MMA8452_FF_MT_CFG 0x15
|
||||
#define MMA8452_FF_MT_CFG_OAE BIT(6)
|
||||
#define MMA8452_FF_MT_CFG_ELE BIT(7)
|
||||
#define MMA8452_FF_MT_SRC 0x16
|
||||
#define MMA8452_FF_MT_SRC_XHE BIT(1)
|
||||
#define MMA8452_FF_MT_SRC_YHE BIT(3)
|
||||
#define MMA8452_FF_MT_SRC_ZHE BIT(5)
|
||||
#define MMA8452_FF_MT_THS 0x17
|
||||
#define MMA8452_FF_MT_THS_MASK 0x7f
|
||||
#define MMA8452_FF_MT_COUNT 0x18
|
||||
#define MMA8452_TRANSIENT_CFG 0x1d
|
||||
#define MMA8452_TRANSIENT_CFG_HPF_BYP BIT(0)
|
||||
#define MMA8452_TRANSIENT_CFG_CHAN(chan) BIT(chan + 1)
|
||||
|
@ -65,15 +82,65 @@
|
|||
#define MMA8452_MAX_REG 0x31
|
||||
|
||||
#define MMA8452_INT_DRDY BIT(0)
|
||||
#define MMA8452_INT_FF_MT BIT(2)
|
||||
#define MMA8452_INT_TRANS BIT(5)
|
||||
|
||||
#define MMA8452_DEVICE_ID 0x2a
|
||||
#define MMA8453_DEVICE_ID 0x3a
|
||||
#define MMA8652_DEVICE_ID 0x4a
|
||||
#define MMA8653_DEVICE_ID 0x5a
|
||||
|
||||
struct mma8452_data {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
u8 ctrl_reg1;
|
||||
u8 data_cfg;
|
||||
const struct mma_chip_info *chip_info;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct mma_chip_info - chip specific data for Freescale's accelerometers
|
||||
* @chip_id: WHO_AM_I register's value
|
||||
* @channels: struct iio_chan_spec matching the device's
|
||||
* capabilities
|
||||
* @num_channels: number of channels
|
||||
* @mma_scales: scale factors for converting register values
|
||||
* to m/s^2; 3 modes: 2g, 4g, 8g; 2 integers
|
||||
* per mode: m/s^2 and micro m/s^2
|
||||
* @ev_cfg: event config register address
|
||||
* @ev_cfg_ele: latch bit in event config register
|
||||
* @ev_cfg_chan_shift: number of the bit to enable events in X
|
||||
* direction; in event config register
|
||||
* @ev_src: event source register address
|
||||
* @ev_src_xe: bit in event source register that indicates
|
||||
* an event in X direction
|
||||
* @ev_src_ye: bit in event source register that indicates
|
||||
* an event in Y direction
|
||||
* @ev_src_ze: bit in event source register that indicates
|
||||
* an event in Z direction
|
||||
* @ev_ths: event threshold register address
|
||||
* @ev_ths_mask: mask for the threshold value
|
||||
* @ev_count: event count (period) register address
|
||||
*
|
||||
* Since not all chips supported by the driver support comparing high pass
|
||||
* filtered data for events (interrupts), different interrupt sources are
|
||||
* used for different chips and the relevant registers are included here.
|
||||
*/
|
||||
struct mma_chip_info {
|
||||
u8 chip_id;
|
||||
const struct iio_chan_spec *channels;
|
||||
int num_channels;
|
||||
const int mma_scales[3][2];
|
||||
u8 ev_cfg;
|
||||
u8 ev_cfg_ele;
|
||||
u8 ev_cfg_chan_shift;
|
||||
u8 ev_src;
|
||||
u8 ev_src_xe;
|
||||
u8 ev_src_ye;
|
||||
u8 ev_src_ze;
|
||||
u8 ev_ths;
|
||||
u8 ev_ths_mask;
|
||||
u8 ev_count;
|
||||
};
|
||||
|
||||
static int mma8452_drdy(struct mma8452_data *data)
|
||||
|
@ -143,16 +210,6 @@ static const int mma8452_samp_freq[8][2] = {
|
|||
{6, 250000}, {1, 560000}
|
||||
};
|
||||
|
||||
/*
|
||||
* Hardware has fullscale of -2G, -4G, -8G corresponding to raw value -2048
|
||||
* The userspace interface uses m/s^2 and we declare micro units
|
||||
* So scale factor is given by:
|
||||
* g * N * 1000000 / 2048 for N = 2, 4, 8 and g = 9.80665
|
||||
*/
|
||||
static const int mma8452_scales[3][2] = {
|
||||
{0, 9577}, {0, 19154}, {0, 38307}
|
||||
};
|
||||
|
||||
/* Datasheet table 35 (step time vs sample frequency) */
|
||||
static const int mma8452_transient_time_step_us[8] = {
|
||||
1250,
|
||||
|
@ -189,8 +246,11 @@ static ssize_t mma8452_show_scale_avail(struct device *dev,
|
|||
struct device_attribute *attr,
|
||||
char *buf)
|
||||
{
|
||||
return mma8452_show_int_plus_micros(buf, mma8452_scales,
|
||||
ARRAY_SIZE(mma8452_scales));
|
||||
struct mma8452_data *data = iio_priv(i2c_get_clientdata(
|
||||
to_i2c_client(dev)));
|
||||
|
||||
return mma8452_show_int_plus_micros(buf, data->chip_info->mma_scales,
|
||||
ARRAY_SIZE(data->chip_info->mma_scales));
|
||||
}
|
||||
|
||||
static ssize_t mma8452_show_hp_cutoff_avail(struct device *dev,
|
||||
|
@ -221,9 +281,8 @@ static int mma8452_get_samp_freq_index(struct mma8452_data *data,
|
|||
|
||||
static int mma8452_get_scale_index(struct mma8452_data *data, int val, int val2)
|
||||
{
|
||||
return mma8452_get_int_plus_micros_index(mma8452_scales,
|
||||
ARRAY_SIZE(mma8452_scales),
|
||||
val, val2);
|
||||
return mma8452_get_int_plus_micros_index(data->chip_info->mma_scales,
|
||||
ARRAY_SIZE(data->chip_info->mma_scales), val, val2);
|
||||
}
|
||||
|
||||
static int mma8452_get_hp_filter_index(struct mma8452_data *data,
|
||||
|
@ -270,14 +329,15 @@ static int mma8452_read_raw(struct iio_dev *indio_dev,
|
|||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = sign_extend32(be16_to_cpu(buffer[chan->scan_index]) >> 4,
|
||||
11);
|
||||
*val = sign_extend32(be16_to_cpu(
|
||||
buffer[chan->scan_index]) >> chan->scan_type.shift,
|
||||
chan->scan_type.realbits - 1);
|
||||
|
||||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
i = data->data_cfg & MMA8452_DATA_CFG_FS_MASK;
|
||||
*val = mma8452_scales[i][0];
|
||||
*val2 = mma8452_scales[i][1];
|
||||
*val = data->chip_info->mma_scales[i][0];
|
||||
*val2 = data->chip_info->mma_scales[i][1];
|
||||
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||
|
@ -439,17 +499,17 @@ static int mma8452_read_thresh(struct iio_dev *indio_dev,
|
|||
switch (info) {
|
||||
case IIO_EV_INFO_VALUE:
|
||||
ret = i2c_smbus_read_byte_data(data->client,
|
||||
MMA8452_TRANSIENT_THS);
|
||||
data->chip_info->ev_ths);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = ret & MMA8452_TRANSIENT_THS_MASK;
|
||||
*val = ret & data->chip_info->ev_ths_mask;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
|
||||
case IIO_EV_INFO_PERIOD:
|
||||
ret = i2c_smbus_read_byte_data(data->client,
|
||||
MMA8452_TRANSIENT_COUNT);
|
||||
data->chip_info->ev_count);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
|
@ -497,7 +557,8 @@ static int mma8452_write_thresh(struct iio_dev *indio_dev,
|
|||
if (val < 0 || val > MMA8452_TRANSIENT_THS_MASK)
|
||||
return -EINVAL;
|
||||
|
||||
return mma8452_change_config(data, MMA8452_TRANSIENT_THS, val);
|
||||
return mma8452_change_config(data, data->chip_info->ev_ths,
|
||||
val);
|
||||
|
||||
case IIO_EV_INFO_PERIOD:
|
||||
steps = (val * USEC_PER_SEC + val2) /
|
||||
|
@ -507,7 +568,7 @@ static int mma8452_write_thresh(struct iio_dev *indio_dev,
|
|||
if (steps < 0 || steps > 0xff)
|
||||
return -EINVAL;
|
||||
|
||||
return mma8452_change_config(data, MMA8452_TRANSIENT_COUNT,
|
||||
return mma8452_change_config(data, data->chip_info->ev_count,
|
||||
steps);
|
||||
|
||||
case IIO_EV_INFO_HIGH_PASS_FILTER_3DB:
|
||||
|
@ -538,13 +599,15 @@ static int mma8452_read_event_config(struct iio_dev *indio_dev,
|
|||
enum iio_event_direction dir)
|
||||
{
|
||||
struct mma8452_data *data = iio_priv(indio_dev);
|
||||
const struct mma_chip_info *chip = data->chip_info;
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_CFG);
|
||||
ret = i2c_smbus_read_byte_data(data->client,
|
||||
data->chip_info->ev_cfg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return ret & MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index) ? 1 : 0;
|
||||
return !!(ret & BIT(chan->scan_index + chip->ev_cfg_chan_shift));
|
||||
}
|
||||
|
||||
static int mma8452_write_event_config(struct iio_dev *indio_dev,
|
||||
|
@ -554,20 +617,22 @@ static int mma8452_write_event_config(struct iio_dev *indio_dev,
|
|||
int state)
|
||||
{
|
||||
struct mma8452_data *data = iio_priv(indio_dev);
|
||||
const struct mma_chip_info *chip = data->chip_info;
|
||||
int val;
|
||||
|
||||
val = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_CFG);
|
||||
val = i2c_smbus_read_byte_data(data->client, chip->ev_cfg);
|
||||
if (val < 0)
|
||||
return val;
|
||||
|
||||
if (state)
|
||||
val |= MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index);
|
||||
val |= BIT(chan->scan_index + chip->ev_cfg_chan_shift);
|
||||
else
|
||||
val &= ~MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index);
|
||||
val &= ~BIT(chan->scan_index + chip->ev_cfg_chan_shift);
|
||||
|
||||
val |= MMA8452_TRANSIENT_CFG_ELE;
|
||||
val |= chip->ev_cfg_ele;
|
||||
val |= MMA8452_FF_MT_CFG_OAE;
|
||||
|
||||
return mma8452_change_config(data, MMA8452_TRANSIENT_CFG, val);
|
||||
return mma8452_change_config(data, chip->ev_cfg, val);
|
||||
}
|
||||
|
||||
static void mma8452_transient_interrupt(struct iio_dev *indio_dev)
|
||||
|
@ -576,25 +641,25 @@ static void mma8452_transient_interrupt(struct iio_dev *indio_dev)
|
|||
s64 ts = iio_get_time_ns();
|
||||
int src;
|
||||
|
||||
src = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_SRC);
|
||||
src = i2c_smbus_read_byte_data(data->client, data->chip_info->ev_src);
|
||||
if (src < 0)
|
||||
return;
|
||||
|
||||
if (src & MMA8452_TRANSIENT_SRC_XTRANSE)
|
||||
if (src & data->chip_info->ev_src_xe)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X,
|
||||
IIO_EV_TYPE_MAG,
|
||||
IIO_EV_DIR_RISING),
|
||||
ts);
|
||||
|
||||
if (src & MMA8452_TRANSIENT_SRC_YTRANSE)
|
||||
if (src & data->chip_info->ev_src_ye)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_Y,
|
||||
IIO_EV_TYPE_MAG,
|
||||
IIO_EV_DIR_RISING),
|
||||
ts);
|
||||
|
||||
if (src & MMA8452_TRANSIENT_SRC_ZTRANSE)
|
||||
if (src & data->chip_info->ev_src_ze)
|
||||
iio_push_event(indio_dev,
|
||||
IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_Z,
|
||||
IIO_EV_TYPE_MAG,
|
||||
|
@ -606,6 +671,7 @@ static irqreturn_t mma8452_interrupt(int irq, void *p)
|
|||
{
|
||||
struct iio_dev *indio_dev = p;
|
||||
struct mma8452_data *data = iio_priv(indio_dev);
|
||||
const struct mma_chip_info *chip = data->chip_info;
|
||||
int ret = IRQ_NONE;
|
||||
int src;
|
||||
|
||||
|
@ -618,7 +684,10 @@ static irqreturn_t mma8452_interrupt(int irq, void *p)
|
|||
ret = IRQ_HANDLED;
|
||||
}
|
||||
|
||||
if (src & MMA8452_INT_TRANS) {
|
||||
if ((src & MMA8452_INT_TRANS &&
|
||||
chip->ev_src == MMA8452_TRANSIENT_SRC) ||
|
||||
(src & MMA8452_INT_FF_MT &&
|
||||
chip->ev_src == MMA8452_FF_MT_SRC)) {
|
||||
mma8452_transient_interrupt(indio_dev);
|
||||
ret = IRQ_HANDLED;
|
||||
}
|
||||
|
@ -680,6 +749,16 @@ static const struct iio_event_spec mma8452_transient_event[] = {
|
|||
},
|
||||
};
|
||||
|
||||
static const struct iio_event_spec mma8452_motion_event[] = {
|
||||
{
|
||||
.type = IIO_EV_TYPE_MAG,
|
||||
.dir = IIO_EV_DIR_RISING,
|
||||
.mask_separate = BIT(IIO_EV_INFO_ENABLE),
|
||||
.mask_shared_by_type = BIT(IIO_EV_INFO_VALUE) |
|
||||
BIT(IIO_EV_INFO_PERIOD)
|
||||
},
|
||||
};
|
||||
|
||||
/*
|
||||
* Threshold is configured in fixed 8G/127 steps regardless of
|
||||
* currently selected scale for measurement.
|
||||
|
@ -693,10 +772,9 @@ static struct attribute *mma8452_event_attributes[] = {
|
|||
|
||||
static struct attribute_group mma8452_event_attribute_group = {
|
||||
.attrs = mma8452_event_attributes,
|
||||
.name = "events",
|
||||
};
|
||||
|
||||
#define MMA8452_CHANNEL(axis, idx) { \
|
||||
#define MMA8452_CHANNEL(axis, idx, bits) { \
|
||||
.type = IIO_ACCEL, \
|
||||
.modified = 1, \
|
||||
.channel2 = IIO_MOD_##axis, \
|
||||
|
@ -708,22 +786,144 @@ static struct attribute_group mma8452_event_attribute_group = {
|
|||
.scan_index = idx, \
|
||||
.scan_type = { \
|
||||
.sign = 's', \
|
||||
.realbits = 12, \
|
||||
.realbits = (bits), \
|
||||
.storagebits = 16, \
|
||||
.shift = 4, \
|
||||
.shift = 16 - (bits), \
|
||||
.endianness = IIO_BE, \
|
||||
}, \
|
||||
.event_spec = mma8452_transient_event, \
|
||||
.num_event_specs = ARRAY_SIZE(mma8452_transient_event), \
|
||||
}
|
||||
|
||||
#define MMA8652_CHANNEL(axis, idx, bits) { \
|
||||
.type = IIO_ACCEL, \
|
||||
.modified = 1, \
|
||||
.channel2 = IIO_MOD_##axis, \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||||
BIT(IIO_CHAN_INFO_CALIBBIAS), \
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \
|
||||
BIT(IIO_CHAN_INFO_SCALE), \
|
||||
.scan_index = idx, \
|
||||
.scan_type = { \
|
||||
.sign = 's', \
|
||||
.realbits = (bits), \
|
||||
.storagebits = 16, \
|
||||
.shift = 16 - (bits), \
|
||||
.endianness = IIO_BE, \
|
||||
}, \
|
||||
.event_spec = mma8452_motion_event, \
|
||||
.num_event_specs = ARRAY_SIZE(mma8452_motion_event), \
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec mma8452_channels[] = {
|
||||
MMA8452_CHANNEL(X, 0),
|
||||
MMA8452_CHANNEL(Y, 1),
|
||||
MMA8452_CHANNEL(Z, 2),
|
||||
MMA8452_CHANNEL(X, 0, 12),
|
||||
MMA8452_CHANNEL(Y, 1, 12),
|
||||
MMA8452_CHANNEL(Z, 2, 12),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(3),
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec mma8453_channels[] = {
|
||||
MMA8452_CHANNEL(X, 0, 10),
|
||||
MMA8452_CHANNEL(Y, 1, 10),
|
||||
MMA8452_CHANNEL(Z, 2, 10),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(3),
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec mma8652_channels[] = {
|
||||
MMA8652_CHANNEL(X, 0, 12),
|
||||
MMA8652_CHANNEL(Y, 1, 12),
|
||||
MMA8652_CHANNEL(Z, 2, 12),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(3),
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec mma8653_channels[] = {
|
||||
MMA8652_CHANNEL(X, 0, 10),
|
||||
MMA8652_CHANNEL(Y, 1, 10),
|
||||
MMA8652_CHANNEL(Z, 2, 10),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(3),
|
||||
};
|
||||
|
||||
enum {
|
||||
mma8452,
|
||||
mma8453,
|
||||
mma8652,
|
||||
mma8653,
|
||||
};
|
||||
|
||||
static const struct mma_chip_info mma_chip_info_table[] = {
|
||||
[mma8452] = {
|
||||
.chip_id = MMA8452_DEVICE_ID,
|
||||
.channels = mma8452_channels,
|
||||
.num_channels = ARRAY_SIZE(mma8452_channels),
|
||||
/*
|
||||
* Hardware has fullscale of -2G, -4G, -8G corresponding to
|
||||
* raw value -2048 for 12 bit or -512 for 10 bit.
|
||||
* The userspace interface uses m/s^2 and we declare micro units
|
||||
* So scale factor for 12 bit here is given by:
|
||||
* g * N * 1000000 / 2048 for N = 2, 4, 8 and g=9.80665
|
||||
*/
|
||||
.mma_scales = { {0, 9577}, {0, 19154}, {0, 38307} },
|
||||
.ev_cfg = MMA8452_TRANSIENT_CFG,
|
||||
.ev_cfg_ele = MMA8452_TRANSIENT_CFG_ELE,
|
||||
.ev_cfg_chan_shift = 1,
|
||||
.ev_src = MMA8452_TRANSIENT_SRC,
|
||||
.ev_src_xe = MMA8452_TRANSIENT_SRC_XTRANSE,
|
||||
.ev_src_ye = MMA8452_TRANSIENT_SRC_YTRANSE,
|
||||
.ev_src_ze = MMA8452_TRANSIENT_SRC_ZTRANSE,
|
||||
.ev_ths = MMA8452_TRANSIENT_THS,
|
||||
.ev_ths_mask = MMA8452_TRANSIENT_THS_MASK,
|
||||
.ev_count = MMA8452_TRANSIENT_COUNT,
|
||||
},
|
||||
[mma8453] = {
|
||||
.chip_id = MMA8453_DEVICE_ID,
|
||||
.channels = mma8453_channels,
|
||||
.num_channels = ARRAY_SIZE(mma8453_channels),
|
||||
.mma_scales = { {0, 38307}, {0, 76614}, {0, 153228} },
|
||||
.ev_cfg = MMA8452_TRANSIENT_CFG,
|
||||
.ev_cfg_ele = MMA8452_TRANSIENT_CFG_ELE,
|
||||
.ev_cfg_chan_shift = 1,
|
||||
.ev_src = MMA8452_TRANSIENT_SRC,
|
||||
.ev_src_xe = MMA8452_TRANSIENT_SRC_XTRANSE,
|
||||
.ev_src_ye = MMA8452_TRANSIENT_SRC_YTRANSE,
|
||||
.ev_src_ze = MMA8452_TRANSIENT_SRC_ZTRANSE,
|
||||
.ev_ths = MMA8452_TRANSIENT_THS,
|
||||
.ev_ths_mask = MMA8452_TRANSIENT_THS_MASK,
|
||||
.ev_count = MMA8452_TRANSIENT_COUNT,
|
||||
},
|
||||
[mma8652] = {
|
||||
.chip_id = MMA8652_DEVICE_ID,
|
||||
.channels = mma8652_channels,
|
||||
.num_channels = ARRAY_SIZE(mma8652_channels),
|
||||
.mma_scales = { {0, 9577}, {0, 19154}, {0, 38307} },
|
||||
.ev_cfg = MMA8452_FF_MT_CFG,
|
||||
.ev_cfg_ele = MMA8452_FF_MT_CFG_ELE,
|
||||
.ev_cfg_chan_shift = 3,
|
||||
.ev_src = MMA8452_FF_MT_SRC,
|
||||
.ev_src_xe = MMA8452_FF_MT_SRC_XHE,
|
||||
.ev_src_ye = MMA8452_FF_MT_SRC_YHE,
|
||||
.ev_src_ze = MMA8452_FF_MT_SRC_ZHE,
|
||||
.ev_ths = MMA8452_FF_MT_THS,
|
||||
.ev_ths_mask = MMA8452_FF_MT_THS_MASK,
|
||||
.ev_count = MMA8452_FF_MT_COUNT,
|
||||
},
|
||||
[mma8653] = {
|
||||
.chip_id = MMA8653_DEVICE_ID,
|
||||
.channels = mma8653_channels,
|
||||
.num_channels = ARRAY_SIZE(mma8653_channels),
|
||||
.mma_scales = { {0, 38307}, {0, 76614}, {0, 153228} },
|
||||
.ev_cfg = MMA8452_FF_MT_CFG,
|
||||
.ev_cfg_ele = MMA8452_FF_MT_CFG_ELE,
|
||||
.ev_cfg_chan_shift = 3,
|
||||
.ev_src = MMA8452_FF_MT_SRC,
|
||||
.ev_src_xe = MMA8452_FF_MT_SRC_XHE,
|
||||
.ev_src_ye = MMA8452_FF_MT_SRC_YHE,
|
||||
.ev_src_ze = MMA8452_FF_MT_SRC_ZHE,
|
||||
.ev_ths = MMA8452_FF_MT_THS,
|
||||
.ev_ths_mask = MMA8452_FF_MT_THS_MASK,
|
||||
.ev_count = MMA8452_FF_MT_COUNT,
|
||||
},
|
||||
};
|
||||
|
||||
static struct attribute *mma8452_attributes[] = {
|
||||
&iio_dev_attr_sampling_frequency_available.dev_attr.attr,
|
||||
&iio_dev_attr_in_accel_scale_available.dev_attr.attr,
|
||||
|
@ -841,18 +1041,28 @@ static int mma8452_reset(struct i2c_client *client)
|
|||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static const struct of_device_id mma8452_dt_ids[] = {
|
||||
{ .compatible = "fsl,mma8452", .data = &mma_chip_info_table[mma8452] },
|
||||
{ .compatible = "fsl,mma8453", .data = &mma_chip_info_table[mma8453] },
|
||||
{ .compatible = "fsl,mma8652", .data = &mma_chip_info_table[mma8652] },
|
||||
{ .compatible = "fsl,mma8653", .data = &mma_chip_info_table[mma8653] },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, mma8452_dt_ids);
|
||||
|
||||
static int mma8452_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct mma8452_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
int ret;
|
||||
const struct of_device_id *match;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(client, MMA8452_WHO_AM_I);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
if (ret != MMA8452_DEVICE_ID)
|
||||
match = of_match_device(mma8452_dt_ids, &client->dev);
|
||||
if (!match) {
|
||||
dev_err(&client->dev, "unknown device model\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
|
@ -861,14 +1071,33 @@ static int mma8452_probe(struct i2c_client *client,
|
|||
data = iio_priv(indio_dev);
|
||||
data->client = client;
|
||||
mutex_init(&data->lock);
|
||||
data->chip_info = match->data;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(client, MMA8452_WHO_AM_I);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
switch (ret) {
|
||||
case MMA8452_DEVICE_ID:
|
||||
case MMA8453_DEVICE_ID:
|
||||
case MMA8652_DEVICE_ID:
|
||||
case MMA8653_DEVICE_ID:
|
||||
if (ret == data->chip_info->chip_id)
|
||||
break;
|
||||
default:
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
dev_info(&client->dev, "registering %s accelerometer; ID 0x%x\n",
|
||||
match->compatible, data->chip_info->chip_id);
|
||||
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
indio_dev->info = &mma8452_info;
|
||||
indio_dev->name = id->name;
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->channels = mma8452_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(mma8452_channels);
|
||||
indio_dev->channels = data->chip_info->channels;
|
||||
indio_dev->num_channels = data->chip_info->num_channels;
|
||||
indio_dev->available_scan_masks = mma8452_scan_masks;
|
||||
|
||||
ret = mma8452_reset(client);
|
||||
|
@ -892,13 +1121,15 @@ static int mma8452_probe(struct i2c_client *client,
|
|||
|
||||
if (client->irq) {
|
||||
/*
|
||||
* Although we enable the transient interrupt source once and
|
||||
* for all here the transient event detection itself is not
|
||||
* enabled until userspace asks for it by
|
||||
* mma8452_write_event_config()
|
||||
* Although we enable the interrupt sources once and for
|
||||
* all here the event detection itself is not enabled until
|
||||
* userspace asks for it by mma8452_write_event_config()
|
||||
*/
|
||||
int supported_interrupts = MMA8452_INT_DRDY | MMA8452_INT_TRANS;
|
||||
int enabled_interrupts = MMA8452_INT_TRANS;
|
||||
int supported_interrupts = MMA8452_INT_DRDY |
|
||||
MMA8452_INT_TRANS |
|
||||
MMA8452_INT_FF_MT;
|
||||
int enabled_interrupts = MMA8452_INT_TRANS |
|
||||
MMA8452_INT_FF_MT;
|
||||
|
||||
/* Assume wired to INT1 pin */
|
||||
ret = i2c_smbus_write_byte_data(client,
|
||||
|
@ -987,17 +1218,14 @@ static SIMPLE_DEV_PM_OPS(mma8452_pm_ops, mma8452_suspend, mma8452_resume);
|
|||
#endif
|
||||
|
||||
static const struct i2c_device_id mma8452_id[] = {
|
||||
{ "mma8452", 0 },
|
||||
{ "mma8452", mma8452 },
|
||||
{ "mma8453", mma8453 },
|
||||
{ "mma8652", mma8652 },
|
||||
{ "mma8653", mma8653 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, mma8452_id);
|
||||
|
||||
static const struct of_device_id mma8452_dt_ids[] = {
|
||||
{ .compatible = "fsl,mma8452" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, mma8452_dt_ids);
|
||||
|
||||
static struct i2c_driver mma8452_driver = {
|
||||
.driver = {
|
||||
.name = "mma8452",
|
||||
|
|
|
@ -26,7 +26,6 @@
|
|||
|
||||
#define MMA9553_DRV_NAME "mma9553"
|
||||
#define MMA9553_IRQ_NAME "mma9553_event"
|
||||
#define MMA9553_GPIO_NAME "mma9553_int"
|
||||
|
||||
/* Pedometer configuration registers (R/W) */
|
||||
#define MMA9553_REG_CONF_SLEEPMIN 0x00
|
||||
|
@ -1073,31 +1072,6 @@ static irqreturn_t mma9553_event_handler(int irq, void *private)
|
|||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int mma9553_gpio_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready GPIO interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, MMA9553_GPIO_NAME, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "ACPI GPIO get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const char *mma9553_match_acpi_device(struct device *dev)
|
||||
{
|
||||
const struct acpi_device_id *id;
|
||||
|
@ -1146,9 +1120,6 @@ static int mma9553_probe(struct i2c_client *client,
|
|||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &mma9553_info;
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = mma9553_gpio_probe(client);
|
||||
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
mma9553_irq_handler,
|
||||
|
|
567
drivers/iio/accel/mxc4005.c
Normal file
567
drivers/iio/accel/mxc4005.c
Normal file
|
@ -0,0 +1,567 @@
|
|||
/*
|
||||
* 3-axis accelerometer driver for MXC4005XC Memsic sensor
|
||||
*
|
||||
* Copyright (c) 2014, Intel Corporation.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope 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.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/acpi.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/iio/trigger.h>
|
||||
#include <linux/iio/buffer.h>
|
||||
#include <linux/iio/triggered_buffer.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
|
||||
#define MXC4005_DRV_NAME "mxc4005"
|
||||
#define MXC4005_IRQ_NAME "mxc4005_event"
|
||||
#define MXC4005_REGMAP_NAME "mxc4005_regmap"
|
||||
|
||||
#define MXC4005_REG_XOUT_UPPER 0x03
|
||||
#define MXC4005_REG_XOUT_LOWER 0x04
|
||||
#define MXC4005_REG_YOUT_UPPER 0x05
|
||||
#define MXC4005_REG_YOUT_LOWER 0x06
|
||||
#define MXC4005_REG_ZOUT_UPPER 0x07
|
||||
#define MXC4005_REG_ZOUT_LOWER 0x08
|
||||
|
||||
#define MXC4005_REG_INT_MASK1 0x0B
|
||||
#define MXC4005_REG_INT_MASK1_BIT_DRDYE 0x01
|
||||
|
||||
#define MXC4005_REG_INT_CLR1 0x01
|
||||
#define MXC4005_REG_INT_CLR1_BIT_DRDYC 0x01
|
||||
|
||||
#define MXC4005_REG_CONTROL 0x0D
|
||||
#define MXC4005_REG_CONTROL_MASK_FSR GENMASK(6, 5)
|
||||
#define MXC4005_CONTROL_FSR_SHIFT 5
|
||||
|
||||
#define MXC4005_REG_DEVICE_ID 0x0E
|
||||
|
||||
enum mxc4005_axis {
|
||||
AXIS_X,
|
||||
AXIS_Y,
|
||||
AXIS_Z,
|
||||
};
|
||||
|
||||
enum mxc4005_range {
|
||||
MXC4005_RANGE_2G,
|
||||
MXC4005_RANGE_4G,
|
||||
MXC4005_RANGE_8G,
|
||||
};
|
||||
|
||||
struct mxc4005_data {
|
||||
struct device *dev;
|
||||
struct mutex mutex;
|
||||
struct regmap *regmap;
|
||||
struct iio_trigger *dready_trig;
|
||||
__be16 buffer[8];
|
||||
bool trigger_enabled;
|
||||
};
|
||||
|
||||
/*
|
||||
* MXC4005 can operate in the following ranges:
|
||||
* +/- 2G, 4G, 8G (the default +/-2G)
|
||||
*
|
||||
* (2 + 2) * 9.81 / (2^12 - 1) = 0.009582
|
||||
* (4 + 4) * 9.81 / (2^12 - 1) = 0.019164
|
||||
* (8 + 8) * 9.81 / (2^12 - 1) = 0.038329
|
||||
*/
|
||||
static const struct {
|
||||
u8 range;
|
||||
int scale;
|
||||
} mxc4005_scale_table[] = {
|
||||
{MXC4005_RANGE_2G, 9582},
|
||||
{MXC4005_RANGE_4G, 19164},
|
||||
{MXC4005_RANGE_8G, 38329},
|
||||
};
|
||||
|
||||
|
||||
static IIO_CONST_ATTR(in_accel_scale_available, "0.009582 0.019164 0.038329");
|
||||
|
||||
static struct attribute *mxc4005_attributes[] = {
|
||||
&iio_const_attr_in_accel_scale_available.dev_attr.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group mxc4005_attrs_group = {
|
||||
.attrs = mxc4005_attributes,
|
||||
};
|
||||
|
||||
static bool mxc4005_is_readable_reg(struct device *dev, unsigned int reg)
|
||||
{
|
||||
switch (reg) {
|
||||
case MXC4005_REG_XOUT_UPPER:
|
||||
case MXC4005_REG_XOUT_LOWER:
|
||||
case MXC4005_REG_YOUT_UPPER:
|
||||
case MXC4005_REG_YOUT_LOWER:
|
||||
case MXC4005_REG_ZOUT_UPPER:
|
||||
case MXC4005_REG_ZOUT_LOWER:
|
||||
case MXC4005_REG_DEVICE_ID:
|
||||
case MXC4005_REG_CONTROL:
|
||||
return true;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static bool mxc4005_is_writeable_reg(struct device *dev, unsigned int reg)
|
||||
{
|
||||
switch (reg) {
|
||||
case MXC4005_REG_INT_CLR1:
|
||||
case MXC4005_REG_INT_MASK1:
|
||||
case MXC4005_REG_CONTROL:
|
||||
return true;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct regmap_config mxc4005_regmap_config = {
|
||||
.name = MXC4005_REGMAP_NAME,
|
||||
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
|
||||
.max_register = MXC4005_REG_DEVICE_ID,
|
||||
|
||||
.readable_reg = mxc4005_is_readable_reg,
|
||||
.writeable_reg = mxc4005_is_writeable_reg,
|
||||
};
|
||||
|
||||
static int mxc4005_read_xyz(struct mxc4005_data *data)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = regmap_bulk_read(data->regmap, MXC4005_REG_XOUT_UPPER,
|
||||
(u8 *) data->buffer, sizeof(data->buffer));
|
||||
if (ret < 0) {
|
||||
dev_err(data->dev, "failed to read axes\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mxc4005_read_axis(struct mxc4005_data *data,
|
||||
unsigned int addr)
|
||||
{
|
||||
__be16 reg;
|
||||
int ret;
|
||||
|
||||
ret = regmap_bulk_read(data->regmap, addr, (u8 *) ®, sizeof(reg));
|
||||
if (ret < 0) {
|
||||
dev_err(data->dev, "failed to read reg %02x\n", addr);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return be16_to_cpu(reg);
|
||||
}
|
||||
|
||||
static int mxc4005_read_scale(struct mxc4005_data *data)
|
||||
{
|
||||
unsigned int reg;
|
||||
int ret;
|
||||
int i;
|
||||
|
||||
ret = regmap_read(data->regmap, MXC4005_REG_CONTROL, ®);
|
||||
if (ret < 0) {
|
||||
dev_err(data->dev, "failed to read reg_control\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
i = reg >> MXC4005_CONTROL_FSR_SHIFT;
|
||||
|
||||
if (i < 0 || i >= ARRAY_SIZE(mxc4005_scale_table))
|
||||
return -EINVAL;
|
||||
|
||||
return mxc4005_scale_table[i].scale;
|
||||
}
|
||||
|
||||
static int mxc4005_set_scale(struct mxc4005_data *data, int val)
|
||||
{
|
||||
unsigned int reg;
|
||||
int i;
|
||||
int ret;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(mxc4005_scale_table); i++) {
|
||||
if (mxc4005_scale_table[i].scale == val) {
|
||||
reg = i << MXC4005_CONTROL_FSR_SHIFT;
|
||||
ret = regmap_update_bits(data->regmap,
|
||||
MXC4005_REG_CONTROL,
|
||||
MXC4005_REG_CONTROL_MASK_FSR,
|
||||
reg);
|
||||
if (ret < 0)
|
||||
dev_err(data->dev,
|
||||
"failed to write reg_control\n");
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int mxc4005_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int *val, int *val2, long mask)
|
||||
{
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
switch (chan->type) {
|
||||
case IIO_ACCEL:
|
||||
if (iio_buffer_enabled(indio_dev))
|
||||
return -EBUSY;
|
||||
|
||||
ret = mxc4005_read_axis(data, chan->address);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
*val = sign_extend32(ret >> chan->scan_type.shift,
|
||||
chan->scan_type.realbits - 1);
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
ret = mxc4005_read_scale(data);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = 0;
|
||||
*val2 = ret;
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int mxc4005_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (val != 0)
|
||||
return -EINVAL;
|
||||
|
||||
return mxc4005_set_scale(data, val2);
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct iio_info mxc4005_info = {
|
||||
.driver_module = THIS_MODULE,
|
||||
.read_raw = mxc4005_read_raw,
|
||||
.write_raw = mxc4005_write_raw,
|
||||
.attrs = &mxc4005_attrs_group,
|
||||
};
|
||||
|
||||
static const unsigned long mxc4005_scan_masks[] = {
|
||||
BIT(AXIS_X) | BIT(AXIS_Y) | BIT(AXIS_Z),
|
||||
0
|
||||
};
|
||||
|
||||
#define MXC4005_CHANNEL(_axis, _addr) { \
|
||||
.type = IIO_ACCEL, \
|
||||
.modified = 1, \
|
||||
.channel2 = IIO_MOD_##_axis, \
|
||||
.address = _addr, \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
|
||||
.scan_index = AXIS_##_axis, \
|
||||
.scan_type = { \
|
||||
.sign = 's', \
|
||||
.realbits = 12, \
|
||||
.storagebits = 16, \
|
||||
.shift = 4, \
|
||||
.endianness = IIO_BE, \
|
||||
}, \
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec mxc4005_channels[] = {
|
||||
MXC4005_CHANNEL(X, MXC4005_REG_XOUT_UPPER),
|
||||
MXC4005_CHANNEL(Y, MXC4005_REG_YOUT_UPPER),
|
||||
MXC4005_CHANNEL(Z, MXC4005_REG_ZOUT_UPPER),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(3),
|
||||
};
|
||||
|
||||
static irqreturn_t mxc4005_trigger_handler(int irq, void *private)
|
||||
{
|
||||
struct iio_poll_func *pf = private;
|
||||
struct iio_dev *indio_dev = pf->indio_dev;
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
ret = mxc4005_read_xyz(data);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
iio_push_to_buffers_with_timestamp(indio_dev, data->buffer,
|
||||
pf->timestamp);
|
||||
|
||||
err:
|
||||
iio_trigger_notify_done(indio_dev->trig);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int mxc4005_clr_intr(struct mxc4005_data *data)
|
||||
{
|
||||
int ret;
|
||||
|
||||
/* clear interrupt */
|
||||
ret = regmap_write(data->regmap, MXC4005_REG_INT_CLR1,
|
||||
MXC4005_REG_INT_CLR1_BIT_DRDYC);
|
||||
if (ret < 0) {
|
||||
dev_err(data->dev, "failed to write to reg_int_clr1\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mxc4005_set_trigger_state(struct iio_trigger *trig,
|
||||
bool state)
|
||||
{
|
||||
struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
if (state) {
|
||||
ret = regmap_write(data->regmap, MXC4005_REG_INT_MASK1,
|
||||
MXC4005_REG_INT_MASK1_BIT_DRDYE);
|
||||
} else {
|
||||
ret = regmap_write(data->regmap, MXC4005_REG_INT_MASK1,
|
||||
~MXC4005_REG_INT_MASK1_BIT_DRDYE);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&data->mutex);
|
||||
dev_err(data->dev, "failed to update reg_int_mask1");
|
||||
return ret;
|
||||
}
|
||||
|
||||
data->trigger_enabled = state;
|
||||
mutex_unlock(&data->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mxc4005_trigger_try_reen(struct iio_trigger *trig)
|
||||
{
|
||||
struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
|
||||
if (!data->dready_trig)
|
||||
return 0;
|
||||
|
||||
return mxc4005_clr_intr(data);
|
||||
}
|
||||
|
||||
static const struct iio_trigger_ops mxc4005_trigger_ops = {
|
||||
.set_trigger_state = mxc4005_set_trigger_state,
|
||||
.try_reenable = mxc4005_trigger_try_reen,
|
||||
.owner = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int mxc4005_gpio_probe(struct i2c_client *client,
|
||||
struct mxc4005_data *data)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
gpio = devm_gpiod_get_index(dev, "mxc4005_int", 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "failed to get acpi gpio index\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mxc4005_chip_init(struct mxc4005_data *data)
|
||||
{
|
||||
int ret;
|
||||
unsigned int reg;
|
||||
|
||||
ret = regmap_read(data->regmap, MXC4005_REG_DEVICE_ID, ®);
|
||||
if (ret < 0) {
|
||||
dev_err(data->dev, "failed to read chip id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_dbg(data->dev, "MXC4005 chip id %02x\n", reg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mxc4005_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct mxc4005_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
struct regmap *regmap;
|
||||
int ret;
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
regmap = devm_regmap_init_i2c(client, &mxc4005_regmap_config);
|
||||
if (IS_ERR(regmap)) {
|
||||
dev_err(&client->dev, "failed to initialize regmap\n");
|
||||
return PTR_ERR(regmap);
|
||||
}
|
||||
|
||||
data = iio_priv(indio_dev);
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
data->dev = &client->dev;
|
||||
data->regmap = regmap;
|
||||
|
||||
ret = mxc4005_chip_init(data);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "failed to initialize chip\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
mutex_init(&data->mutex);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->channels = mxc4005_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(mxc4005_channels);
|
||||
indio_dev->available_scan_masks = mxc4005_scan_masks;
|
||||
indio_dev->name = MXC4005_DRV_NAME;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &mxc4005_info;
|
||||
|
||||
ret = iio_triggered_buffer_setup(indio_dev,
|
||||
iio_pollfunc_store_time,
|
||||
mxc4005_trigger_handler,
|
||||
NULL);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev,
|
||||
"failed to setup iio triggered buffer\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = mxc4005_gpio_probe(client, data);
|
||||
|
||||
if (client->irq > 0) {
|
||||
data->dready_trig = devm_iio_trigger_alloc(&client->dev,
|
||||
"%s-dev%d",
|
||||
indio_dev->name,
|
||||
indio_dev->id);
|
||||
if (!data->dready_trig)
|
||||
return -ENOMEM;
|
||||
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
iio_trigger_generic_data_rdy_poll,
|
||||
NULL,
|
||||
IRQF_TRIGGER_FALLING |
|
||||
IRQF_ONESHOT,
|
||||
MXC4005_IRQ_NAME,
|
||||
data->dready_trig);
|
||||
if (ret) {
|
||||
dev_err(&client->dev,
|
||||
"failed to init threaded irq\n");
|
||||
goto err_buffer_cleanup;
|
||||
}
|
||||
|
||||
data->dready_trig->dev.parent = &client->dev;
|
||||
data->dready_trig->ops = &mxc4005_trigger_ops;
|
||||
iio_trigger_set_drvdata(data->dready_trig, indio_dev);
|
||||
indio_dev->trig = data->dready_trig;
|
||||
iio_trigger_get(indio_dev->trig);
|
||||
ret = iio_trigger_register(data->dready_trig);
|
||||
if (ret) {
|
||||
dev_err(&client->dev,
|
||||
"failed to register trigger\n");
|
||||
goto err_trigger_unregister;
|
||||
}
|
||||
}
|
||||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev,
|
||||
"unable to register iio device %d\n", ret);
|
||||
goto err_buffer_cleanup;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_trigger_unregister:
|
||||
iio_trigger_unregister(data->dready_trig);
|
||||
err_buffer_cleanup:
|
||||
iio_triggered_buffer_cleanup(indio_dev);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mxc4005_remove(struct i2c_client *client)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||||
struct mxc4005_data *data = iio_priv(indio_dev);
|
||||
|
||||
iio_device_unregister(indio_dev);
|
||||
|
||||
iio_triggered_buffer_cleanup(indio_dev);
|
||||
if (data->dready_trig)
|
||||
iio_trigger_unregister(data->dready_trig);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct acpi_device_id mxc4005_acpi_match[] = {
|
||||
{"MXC4005", 0},
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(acpi, mxc4005_acpi_match);
|
||||
|
||||
static const struct i2c_device_id mxc4005_id[] = {
|
||||
{"mxc4005", 0},
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, mxc4005_id);
|
||||
|
||||
static struct i2c_driver mxc4005_driver = {
|
||||
.driver = {
|
||||
.name = MXC4005_DRV_NAME,
|
||||
.acpi_match_table = ACPI_PTR(mxc4005_acpi_match),
|
||||
},
|
||||
.probe = mxc4005_probe,
|
||||
.remove = mxc4005_remove,
|
||||
.id_table = mxc4005_id,
|
||||
};
|
||||
|
||||
module_i2c_driver(mxc4005_driver);
|
||||
|
||||
MODULE_AUTHOR("Teodora Baluta <teodora.baluta@intel.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("MXC4005 3-axis accelerometer driver");
|
|
@ -612,6 +612,7 @@ static const struct iio_info accel_info = {
|
|||
.attrs = &st_accel_attribute_group,
|
||||
.read_raw = &st_accel_read_raw,
|
||||
.write_raw = &st_accel_write_raw,
|
||||
.debugfs_reg_access = &st_sensors_debugfs_reg_access,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_IIO_TRIGGER
|
||||
|
|
|
@ -50,7 +50,6 @@
|
|||
#define STK8312_ALL_CHANNEL_SIZE 3
|
||||
|
||||
#define STK8312_DRIVER_NAME "stk8312"
|
||||
#define STK8312_GPIO "stk8312_gpio"
|
||||
#define STK8312_IRQ_NAME "stk8312_event"
|
||||
|
||||
/*
|
||||
|
@ -504,30 +503,6 @@ static const struct iio_buffer_setup_ops stk8312_buffer_setup_ops = {
|
|||
.postdisable = stk8312_buffer_postdisable,
|
||||
};
|
||||
|
||||
static int stk8312_gpio_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, STK8312_GPIO, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "acpi gpio get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int stk8312_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
|
@ -569,10 +544,7 @@ static int stk8312_probe(struct i2c_client *client,
|
|||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = stk8312_gpio_probe(client);
|
||||
|
||||
if (client->irq >= 0) {
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
stk8312_data_rdy_trig_poll,
|
||||
NULL,
|
||||
|
|
|
@ -45,7 +45,6 @@
|
|||
#define STK8BA50_ALL_CHANNEL_SIZE 6
|
||||
|
||||
#define STK8BA50_DRIVER_NAME "stk8ba50"
|
||||
#define STK8BA50_GPIO "stk8ba50_gpio"
|
||||
#define STK8BA50_IRQ_NAME "stk8ba50_event"
|
||||
|
||||
#define STK8BA50_SCALE_AVAIL "0.0384 0.0767 0.1534 0.3069"
|
||||
|
@ -388,30 +387,6 @@ static const struct iio_buffer_setup_ops stk8ba50_buffer_setup_ops = {
|
|||
.postdisable = stk8ba50_buffer_postdisable,
|
||||
};
|
||||
|
||||
static int stk8ba50_gpio_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, STK8BA50_GPIO, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "acpi gpio get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int stk8ba50_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
|
@ -465,10 +440,7 @@ static int stk8ba50_probe(struct i2c_client *client,
|
|||
goto err_power_off;
|
||||
}
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = stk8ba50_gpio_probe(client);
|
||||
|
||||
if (client->irq >= 0) {
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
stk8ba50_data_rdy_trig_poll,
|
||||
NULL,
|
||||
|
|
|
@ -149,6 +149,17 @@ config BERLIN2_ADC
|
|||
Marvell Berlin2 ADC driver. This ADC has 8 channels, with one used for
|
||||
temperature measurement.
|
||||
|
||||
config CC10001_ADC
|
||||
tristate "Cosmic Circuits 10001 ADC driver"
|
||||
depends on HAS_IOMEM && HAVE_CLK && REGULATOR
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to build support for Cosmic Circuits 10001 ADC.
|
||||
|
||||
This driver can also be built as a module. If so, the module will be
|
||||
called cc10001_adc.
|
||||
|
||||
config DA9150_GPADC
|
||||
tristate "Dialog DA9150 GPADC driver support"
|
||||
depends on MFD_DA9150
|
||||
|
@ -161,17 +172,6 @@ config DA9150_GPADC
|
|||
To compile this driver as a module, choose M here: the module will be
|
||||
called berlin2-adc.
|
||||
|
||||
config CC10001_ADC
|
||||
tristate "Cosmic Circuits 10001 ADC driver"
|
||||
depends on HAS_IOMEM && HAVE_CLK && REGULATOR
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to build support for Cosmic Circuits 10001 ADC.
|
||||
|
||||
This driver can also be built as a module. If so, the module will be
|
||||
called cc10001_adc.
|
||||
|
||||
config EXYNOS_ADC
|
||||
tristate "Exynos ADC driver support"
|
||||
depends on ARCH_EXYNOS || ARCH_S3C24XX || ARCH_S3C64XX || (OF && COMPILE_TEST)
|
||||
|
@ -183,6 +183,17 @@ config EXYNOS_ADC
|
|||
To compile this driver as a module, choose M here: the module will be
|
||||
called exynos_adc.
|
||||
|
||||
config HI8435
|
||||
tristate "Holt Integrated Circuits HI-8435 threshold detector"
|
||||
select IIO_TRIGGERED_EVENT
|
||||
depends on SPI
|
||||
help
|
||||
If you say yes here you get support for Holt Integrated Circuits
|
||||
HI-8435 chip.
|
||||
|
||||
This driver can also be built as a module. If so, the module will be
|
||||
called hi8435.
|
||||
|
||||
config LP8788_ADC
|
||||
tristate "LP8788 ADC driver"
|
||||
depends on MFD_LP8788
|
||||
|
@ -361,6 +372,8 @@ config TWL6030_GPADC
|
|||
config VF610_ADC
|
||||
tristate "Freescale vf610 ADC driver"
|
||||
depends on OF
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to support for Vybrid board analog-to-digital converter.
|
||||
Since the IP is used for i.MX6SLX, the driver also support i.MX6SLX.
|
||||
|
|
|
@ -16,9 +16,10 @@ obj-$(CONFIG_AD799X) += ad799x.o
|
|||
obj-$(CONFIG_AT91_ADC) += at91_adc.o
|
||||
obj-$(CONFIG_AXP288_ADC) += axp288_adc.o
|
||||
obj-$(CONFIG_BERLIN2_ADC) += berlin2-adc.o
|
||||
obj-$(CONFIG_DA9150_GPADC) += da9150-gpadc.o
|
||||
obj-$(CONFIG_CC10001_ADC) += cc10001_adc.o
|
||||
obj-$(CONFIG_DA9150_GPADC) += da9150-gpadc.o
|
||||
obj-$(CONFIG_EXYNOS_ADC) += exynos_adc.o
|
||||
obj-$(CONFIG_HI8435) += hi8435.o
|
||||
obj-$(CONFIG_LP8788_ADC) += lp8788_adc.o
|
||||
obj-$(CONFIG_MAX1027) += max1027.o
|
||||
obj-$(CONFIG_MAX1363) += max1363.o
|
||||
|
|
|
@ -528,7 +528,6 @@ static struct attribute *ad799x_event_attributes[] = {
|
|||
|
||||
static struct attribute_group ad799x_event_attrs_group = {
|
||||
.attrs = ad799x_event_attributes,
|
||||
.name = "events",
|
||||
};
|
||||
|
||||
static const struct iio_info ad7991_info = {
|
||||
|
|
|
@ -27,13 +27,13 @@
|
|||
#define BERLIN2_SM_CTRL_SM_SOC_INT BIT(1)
|
||||
#define BERLIN2_SM_CTRL_SOC_SM_INT BIT(2)
|
||||
#define BERLIN2_SM_CTRL_ADC_SEL(x) ((x) << 5) /* 0-15 */
|
||||
#define BERLIN2_SM_CTRL_ADC_SEL_MASK (0xf << 5)
|
||||
#define BERLIN2_SM_CTRL_ADC_SEL_MASK GENMASK(8, 5)
|
||||
#define BERLIN2_SM_CTRL_ADC_POWER BIT(9)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV2 (0x0 << 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV3 (0x1 << 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV4 (0x2 << 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_DIV8 (0x3 << 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_MASK (0x3 << 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_CLKSEL_MASK GENMASK(11, 10)
|
||||
#define BERLIN2_SM_CTRL_ADC_START BIT(12)
|
||||
#define BERLIN2_SM_CTRL_ADC_RESET BIT(13)
|
||||
#define BERLIN2_SM_CTRL_ADC_BANDGAP_RDY BIT(14)
|
||||
|
@ -50,7 +50,7 @@
|
|||
#define BERLIN2_SM_CTRL_TSEN_MODE_10_50 (0x1 << 22) /* 10-50 C */
|
||||
#define BERLIN2_SM_CTRL_TSEN_RESET BIT(29)
|
||||
#define BERLIN2_SM_ADC_DATA 0x20
|
||||
#define BERLIN2_SM_ADC_MASK 0x3ff
|
||||
#define BERLIN2_SM_ADC_MASK GENMASK(9, 0)
|
||||
#define BERLIN2_SM_ADC_STATUS 0x1c
|
||||
#define BERLIN2_SM_ADC_STATUS_DATA_RDY(x) BIT(x) /* 0-15 */
|
||||
#define BERLIN2_SM_ADC_STATUS_DATA_RDY_MASK GENMASK(15, 0)
|
||||
|
@ -65,9 +65,9 @@
|
|||
#define BERLIN2_SM_TSEN_CTRL_START BIT(8)
|
||||
#define BERLIN2_SM_TSEN_CTRL_SETTLING_4 (0x0 << 21) /* 4 us */
|
||||
#define BERLIN2_SM_TSEN_CTRL_SETTLING_12 (0x1 << 21) /* 12 us */
|
||||
#define BERLIN2_SM_TSEN_CTRL_SETTLING_MASK (0x1 << 21)
|
||||
#define BERLIN2_SM_TSEN_CTRL_SETTLING_MASK BIT(21)
|
||||
#define BERLIN2_SM_TSEN_CTRL_TRIM(x) ((x) << 22)
|
||||
#define BERLIN2_SM_TSEN_CTRL_TRIM_MASK (0xf << 22)
|
||||
#define BERLIN2_SM_TSEN_CTRL_TRIM_MASK GENMASK(25, 22)
|
||||
|
||||
struct berlin2_adc_priv {
|
||||
struct regmap *regmap;
|
||||
|
@ -111,11 +111,17 @@ static int berlin2_adc_read(struct iio_dev *indio_dev, int channel)
|
|||
|
||||
mutex_lock(&priv->lock);
|
||||
|
||||
/* Enable the interrupts */
|
||||
regmap_write(priv->regmap, BERLIN2_SM_ADC_STATUS,
|
||||
BERLIN2_SM_ADC_STATUS_INT_EN(channel));
|
||||
|
||||
/* Configure the ADC */
|
||||
regmap_update_bits(priv->regmap, BERLIN2_SM_CTRL,
|
||||
BERLIN2_SM_CTRL_ADC_RESET | BERLIN2_SM_CTRL_ADC_SEL_MASK
|
||||
| BERLIN2_SM_CTRL_ADC_START,
|
||||
BERLIN2_SM_CTRL_ADC_SEL(channel) | BERLIN2_SM_CTRL_ADC_START);
|
||||
BERLIN2_SM_CTRL_ADC_RESET |
|
||||
BERLIN2_SM_CTRL_ADC_SEL_MASK |
|
||||
BERLIN2_SM_CTRL_ADC_START,
|
||||
BERLIN2_SM_CTRL_ADC_SEL(channel) |
|
||||
BERLIN2_SM_CTRL_ADC_START);
|
||||
|
||||
ret = wait_event_interruptible_timeout(priv->wq, priv->data_available,
|
||||
msecs_to_jiffies(1000));
|
||||
|
@ -149,17 +155,24 @@ static int berlin2_adc_tsen_read(struct iio_dev *indio_dev)
|
|||
|
||||
mutex_lock(&priv->lock);
|
||||
|
||||
/* Enable interrupts */
|
||||
regmap_write(priv->regmap, BERLIN2_SM_TSEN_STATUS,
|
||||
BERLIN2_SM_TSEN_STATUS_INT_EN);
|
||||
|
||||
/* Configure the ADC */
|
||||
regmap_update_bits(priv->regmap, BERLIN2_SM_CTRL,
|
||||
BERLIN2_SM_CTRL_TSEN_RESET | BERLIN2_SM_CTRL_ADC_ROTATE,
|
||||
BERLIN2_SM_CTRL_TSEN_RESET |
|
||||
BERLIN2_SM_CTRL_ADC_ROTATE,
|
||||
BERLIN2_SM_CTRL_ADC_ROTATE);
|
||||
|
||||
/* Configure the temperature sensor */
|
||||
regmap_update_bits(priv->regmap, BERLIN2_SM_TSEN_CTRL,
|
||||
BERLIN2_SM_TSEN_CTRL_TRIM_MASK | BERLIN2_SM_TSEN_CTRL_SETTLING_MASK
|
||||
| BERLIN2_SM_TSEN_CTRL_START,
|
||||
BERLIN2_SM_TSEN_CTRL_TRIM(3) | BERLIN2_SM_TSEN_CTRL_SETTLING_12
|
||||
| BERLIN2_SM_TSEN_CTRL_START);
|
||||
BERLIN2_SM_TSEN_CTRL_TRIM_MASK |
|
||||
BERLIN2_SM_TSEN_CTRL_SETTLING_MASK |
|
||||
BERLIN2_SM_TSEN_CTRL_START,
|
||||
BERLIN2_SM_TSEN_CTRL_TRIM(3) |
|
||||
BERLIN2_SM_TSEN_CTRL_SETTLING_12 |
|
||||
BERLIN2_SM_TSEN_CTRL_START);
|
||||
|
||||
ret = wait_event_interruptible_timeout(priv->wq, priv->data_available,
|
||||
msecs_to_jiffies(1000));
|
||||
|
@ -187,10 +200,9 @@ static int berlin2_adc_tsen_read(struct iio_dev *indio_dev)
|
|||
}
|
||||
|
||||
static int berlin2_adc_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int *val, int *val2,
|
||||
long mask)
|
||||
struct iio_chan_spec const *chan, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
struct berlin2_adc_priv *priv = iio_priv(indio_dev);
|
||||
int temp;
|
||||
|
||||
switch (mask) {
|
||||
|
@ -198,10 +210,6 @@ static int berlin2_adc_read_raw(struct iio_dev *indio_dev,
|
|||
if (chan->type != IIO_VOLTAGE)
|
||||
return -EINVAL;
|
||||
|
||||
/* Enable the interrupts */
|
||||
regmap_write(priv->regmap, BERLIN2_SM_ADC_STATUS,
|
||||
BERLIN2_SM_ADC_STATUS_INT_EN(chan->channel));
|
||||
|
||||
*val = berlin2_adc_read(indio_dev, chan->channel);
|
||||
if (*val < 0)
|
||||
return *val;
|
||||
|
@ -211,10 +219,6 @@ static int berlin2_adc_read_raw(struct iio_dev *indio_dev,
|
|||
if (chan->type != IIO_TEMP)
|
||||
return -EINVAL;
|
||||
|
||||
/* Enable interrupts */
|
||||
regmap_write(priv->regmap, BERLIN2_SM_TSEN_STATUS,
|
||||
BERLIN2_SM_TSEN_STATUS_INT_EN);
|
||||
|
||||
temp = berlin2_adc_tsen_read(indio_dev);
|
||||
if (temp < 0)
|
||||
return temp;
|
||||
|
@ -328,7 +332,8 @@ static int berlin2_adc_probe(struct platform_device *pdev)
|
|||
|
||||
/* Power up the ADC */
|
||||
regmap_update_bits(priv->regmap, BERLIN2_SM_CTRL,
|
||||
BERLIN2_SM_CTRL_ADC_POWER, BERLIN2_SM_CTRL_ADC_POWER);
|
||||
BERLIN2_SM_CTRL_ADC_POWER,
|
||||
BERLIN2_SM_CTRL_ADC_POWER);
|
||||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret) {
|
||||
|
|
534
drivers/iio/adc/hi8435.c
Normal file
534
drivers/iio/adc/hi8435.c
Normal file
|
@ -0,0 +1,534 @@
|
|||
/*
|
||||
* Holt Integrated Circuits HI-8435 threshold detector driver
|
||||
*
|
||||
* Copyright (C) 2015 Zodiac Inflight Innovations
|
||||
* Copyright (C) 2015 Cogent Embedded, Inc.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/iio/events.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/iio/trigger.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
#include <linux/iio/triggered_event.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#include <linux/spi/spi.h>
|
||||
#include <linux/gpio/consumer.h>
|
||||
|
||||
#define DRV_NAME "hi8435"
|
||||
|
||||
/* Register offsets for HI-8435 */
|
||||
#define HI8435_CTRL_REG 0x02
|
||||
#define HI8435_PSEN_REG 0x04
|
||||
#define HI8435_TMDATA_REG 0x1E
|
||||
#define HI8435_GOCENHYS_REG 0x3A
|
||||
#define HI8435_SOCENHYS_REG 0x3C
|
||||
#define HI8435_SO7_0_REG 0x10
|
||||
#define HI8435_SO15_8_REG 0x12
|
||||
#define HI8435_SO23_16_REG 0x14
|
||||
#define HI8435_SO31_24_REG 0x16
|
||||
#define HI8435_SO31_0_REG 0x78
|
||||
|
||||
#define HI8435_WRITE_OPCODE 0x00
|
||||
#define HI8435_READ_OPCODE 0x80
|
||||
|
||||
/* CTRL register bits */
|
||||
#define HI8435_CTRL_TEST 0x01
|
||||
#define HI8435_CTRL_SRST 0x02
|
||||
|
||||
struct hi8435_priv {
|
||||
struct spi_device *spi;
|
||||
struct mutex lock;
|
||||
|
||||
unsigned long event_scan_mask; /* soft mask/unmask channels events */
|
||||
unsigned int event_prev_val;
|
||||
|
||||
unsigned threshold_lo[2]; /* GND-Open and Supply-Open thresholds */
|
||||
unsigned threshold_hi[2]; /* GND-Open and Supply-Open thresholds */
|
||||
u8 reg_buffer[3] ____cacheline_aligned;
|
||||
};
|
||||
|
||||
static int hi8435_readb(struct hi8435_priv *priv, u8 reg, u8 *val)
|
||||
{
|
||||
reg |= HI8435_READ_OPCODE;
|
||||
return spi_write_then_read(priv->spi, ®, 1, val, 1);
|
||||
}
|
||||
|
||||
static int hi8435_readw(struct hi8435_priv *priv, u8 reg, u16 *val)
|
||||
{
|
||||
int ret;
|
||||
__be16 be_val;
|
||||
|
||||
reg |= HI8435_READ_OPCODE;
|
||||
ret = spi_write_then_read(priv->spi, ®, 1, &be_val, 2);
|
||||
*val = be16_to_cpu(be_val);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hi8435_readl(struct hi8435_priv *priv, u8 reg, u32 *val)
|
||||
{
|
||||
int ret;
|
||||
__be32 be_val;
|
||||
|
||||
reg |= HI8435_READ_OPCODE;
|
||||
ret = spi_write_then_read(priv->spi, ®, 1, &be_val, 4);
|
||||
*val = be32_to_cpu(be_val);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hi8435_writeb(struct hi8435_priv *priv, u8 reg, u8 val)
|
||||
{
|
||||
priv->reg_buffer[0] = reg | HI8435_WRITE_OPCODE;
|
||||
priv->reg_buffer[1] = val;
|
||||
|
||||
return spi_write(priv->spi, priv->reg_buffer, 2);
|
||||
}
|
||||
|
||||
static int hi8435_writew(struct hi8435_priv *priv, u8 reg, u16 val)
|
||||
{
|
||||
priv->reg_buffer[0] = reg | HI8435_WRITE_OPCODE;
|
||||
priv->reg_buffer[1] = (val >> 8) & 0xff;
|
||||
priv->reg_buffer[2] = val & 0xff;
|
||||
|
||||
return spi_write(priv->spi, priv->reg_buffer, 3);
|
||||
}
|
||||
|
||||
static int hi8435_read_event_config(struct iio_dev *idev,
|
||||
const struct iio_chan_spec *chan,
|
||||
enum iio_event_type type,
|
||||
enum iio_event_direction dir)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
|
||||
return !!(priv->event_scan_mask & BIT(chan->channel));
|
||||
}
|
||||
|
||||
static int hi8435_write_event_config(struct iio_dev *idev,
|
||||
const struct iio_chan_spec *chan,
|
||||
enum iio_event_type type,
|
||||
enum iio_event_direction dir, int state)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
|
||||
priv->event_scan_mask &= ~BIT(chan->channel);
|
||||
if (state)
|
||||
priv->event_scan_mask |= BIT(chan->channel);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hi8435_read_event_value(struct iio_dev *idev,
|
||||
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 hi8435_priv *priv = iio_priv(idev);
|
||||
int ret;
|
||||
u8 mode, psen;
|
||||
u16 reg;
|
||||
|
||||
ret = hi8435_readb(priv, HI8435_PSEN_REG, &psen);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
/* Supply-Open or GND-Open sensing mode */
|
||||
mode = !!(psen & BIT(chan->channel / 8));
|
||||
|
||||
ret = hi8435_readw(priv, mode ? HI8435_SOCENHYS_REG :
|
||||
HI8435_GOCENHYS_REG, ®);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (dir == IIO_EV_DIR_FALLING)
|
||||
*val = ((reg & 0xff) - (reg >> 8)) / 2;
|
||||
else if (dir == IIO_EV_DIR_RISING)
|
||||
*val = ((reg & 0xff) + (reg >> 8)) / 2;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
}
|
||||
|
||||
static int hi8435_write_event_value(struct iio_dev *idev,
|
||||
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 hi8435_priv *priv = iio_priv(idev);
|
||||
int ret;
|
||||
u8 mode, psen;
|
||||
u16 reg;
|
||||
|
||||
ret = hi8435_readb(priv, HI8435_PSEN_REG, &psen);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
/* Supply-Open or GND-Open sensing mode */
|
||||
mode = !!(psen & BIT(chan->channel / 8));
|
||||
|
||||
ret = hi8435_readw(priv, mode ? HI8435_SOCENHYS_REG :
|
||||
HI8435_GOCENHYS_REG, ®);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (dir == IIO_EV_DIR_FALLING) {
|
||||
/* falling threshold range 2..21V, hysteresis minimum 2V */
|
||||
if (val < 2 || val > 21 || (val + 2) > priv->threshold_hi[mode])
|
||||
return -EINVAL;
|
||||
|
||||
if (val == priv->threshold_lo[mode])
|
||||
return 0;
|
||||
|
||||
priv->threshold_lo[mode] = val;
|
||||
|
||||
/* hysteresis must not be odd */
|
||||
if ((priv->threshold_hi[mode] - priv->threshold_lo[mode]) % 2)
|
||||
priv->threshold_hi[mode]--;
|
||||
} else if (dir == IIO_EV_DIR_RISING) {
|
||||
/* rising threshold range 3..22V, hysteresis minimum 2V */
|
||||
if (val < 3 || val > 22 || val < (priv->threshold_lo[mode] + 2))
|
||||
return -EINVAL;
|
||||
|
||||
if (val == priv->threshold_hi[mode])
|
||||
return 0;
|
||||
|
||||
priv->threshold_hi[mode] = val;
|
||||
|
||||
/* hysteresis must not be odd */
|
||||
if ((priv->threshold_hi[mode] - priv->threshold_lo[mode]) % 2)
|
||||
priv->threshold_lo[mode]++;
|
||||
}
|
||||
|
||||
/* program thresholds */
|
||||
mutex_lock(&priv->lock);
|
||||
|
||||
ret = hi8435_readw(priv, mode ? HI8435_SOCENHYS_REG :
|
||||
HI8435_GOCENHYS_REG, ®);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&priv->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* hysteresis */
|
||||
reg = priv->threshold_hi[mode] - priv->threshold_lo[mode];
|
||||
reg <<= 8;
|
||||
/* threshold center */
|
||||
reg |= (priv->threshold_hi[mode] + priv->threshold_lo[mode]);
|
||||
|
||||
ret = hi8435_writew(priv, mode ? HI8435_SOCENHYS_REG :
|
||||
HI8435_GOCENHYS_REG, reg);
|
||||
|
||||
mutex_unlock(&priv->lock);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hi8435_debugfs_reg_access(struct iio_dev *idev,
|
||||
unsigned reg, unsigned writeval,
|
||||
unsigned *readval)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
int ret;
|
||||
u8 val;
|
||||
|
||||
if (readval != NULL) {
|
||||
ret = hi8435_readb(priv, reg, &val);
|
||||
*readval = val;
|
||||
} else {
|
||||
val = (u8)writeval;
|
||||
ret = hi8435_writeb(priv, reg, val);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct iio_event_spec hi8435_events[] = {
|
||||
{
|
||||
.type = IIO_EV_TYPE_THRESH,
|
||||
.dir = IIO_EV_DIR_RISING,
|
||||
.mask_separate = BIT(IIO_EV_INFO_VALUE),
|
||||
}, {
|
||||
.type = IIO_EV_TYPE_THRESH,
|
||||
.dir = IIO_EV_DIR_FALLING,
|
||||
.mask_separate = BIT(IIO_EV_INFO_VALUE),
|
||||
}, {
|
||||
.type = IIO_EV_TYPE_THRESH,
|
||||
.dir = IIO_EV_DIR_EITHER,
|
||||
.mask_separate = BIT(IIO_EV_INFO_ENABLE),
|
||||
},
|
||||
};
|
||||
|
||||
static int hi8435_get_sensing_mode(struct iio_dev *idev,
|
||||
const struct iio_chan_spec *chan)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
int ret;
|
||||
u8 reg;
|
||||
|
||||
ret = hi8435_readb(priv, HI8435_PSEN_REG, ®);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return !!(reg & BIT(chan->channel / 8));
|
||||
}
|
||||
|
||||
static int hi8435_set_sensing_mode(struct iio_dev *idev,
|
||||
const struct iio_chan_spec *chan,
|
||||
unsigned int mode)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
int ret;
|
||||
u8 reg;
|
||||
|
||||
mutex_lock(&priv->lock);
|
||||
|
||||
ret = hi8435_readb(priv, HI8435_PSEN_REG, ®);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&priv->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
reg &= ~BIT(chan->channel / 8);
|
||||
if (mode)
|
||||
reg |= BIT(chan->channel / 8);
|
||||
|
||||
ret = hi8435_writeb(priv, HI8435_PSEN_REG, reg);
|
||||
|
||||
mutex_unlock(&priv->lock);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const char * const hi8435_sensing_modes[] = { "GND-Open",
|
||||
"Supply-Open" };
|
||||
|
||||
static const struct iio_enum hi8435_sensing_mode = {
|
||||
.items = hi8435_sensing_modes,
|
||||
.num_items = ARRAY_SIZE(hi8435_sensing_modes),
|
||||
.get = hi8435_get_sensing_mode,
|
||||
.set = hi8435_set_sensing_mode,
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec_ext_info hi8435_ext_info[] = {
|
||||
IIO_ENUM("sensing_mode", IIO_SEPARATE, &hi8435_sensing_mode),
|
||||
{},
|
||||
};
|
||||
|
||||
#define HI8435_VOLTAGE_CHANNEL(num) \
|
||||
{ \
|
||||
.type = IIO_VOLTAGE, \
|
||||
.indexed = 1, \
|
||||
.channel = num, \
|
||||
.event_spec = hi8435_events, \
|
||||
.num_event_specs = ARRAY_SIZE(hi8435_events), \
|
||||
.ext_info = hi8435_ext_info, \
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec hi8435_channels[] = {
|
||||
HI8435_VOLTAGE_CHANNEL(0),
|
||||
HI8435_VOLTAGE_CHANNEL(1),
|
||||
HI8435_VOLTAGE_CHANNEL(2),
|
||||
HI8435_VOLTAGE_CHANNEL(3),
|
||||
HI8435_VOLTAGE_CHANNEL(4),
|
||||
HI8435_VOLTAGE_CHANNEL(5),
|
||||
HI8435_VOLTAGE_CHANNEL(6),
|
||||
HI8435_VOLTAGE_CHANNEL(7),
|
||||
HI8435_VOLTAGE_CHANNEL(8),
|
||||
HI8435_VOLTAGE_CHANNEL(9),
|
||||
HI8435_VOLTAGE_CHANNEL(10),
|
||||
HI8435_VOLTAGE_CHANNEL(11),
|
||||
HI8435_VOLTAGE_CHANNEL(12),
|
||||
HI8435_VOLTAGE_CHANNEL(13),
|
||||
HI8435_VOLTAGE_CHANNEL(14),
|
||||
HI8435_VOLTAGE_CHANNEL(15),
|
||||
HI8435_VOLTAGE_CHANNEL(16),
|
||||
HI8435_VOLTAGE_CHANNEL(17),
|
||||
HI8435_VOLTAGE_CHANNEL(18),
|
||||
HI8435_VOLTAGE_CHANNEL(19),
|
||||
HI8435_VOLTAGE_CHANNEL(20),
|
||||
HI8435_VOLTAGE_CHANNEL(21),
|
||||
HI8435_VOLTAGE_CHANNEL(22),
|
||||
HI8435_VOLTAGE_CHANNEL(23),
|
||||
HI8435_VOLTAGE_CHANNEL(24),
|
||||
HI8435_VOLTAGE_CHANNEL(25),
|
||||
HI8435_VOLTAGE_CHANNEL(26),
|
||||
HI8435_VOLTAGE_CHANNEL(27),
|
||||
HI8435_VOLTAGE_CHANNEL(28),
|
||||
HI8435_VOLTAGE_CHANNEL(29),
|
||||
HI8435_VOLTAGE_CHANNEL(30),
|
||||
HI8435_VOLTAGE_CHANNEL(31),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(32),
|
||||
};
|
||||
|
||||
static const struct iio_info hi8435_info = {
|
||||
.driver_module = THIS_MODULE,
|
||||
.read_event_config = &hi8435_read_event_config,
|
||||
.write_event_config = hi8435_write_event_config,
|
||||
.read_event_value = &hi8435_read_event_value,
|
||||
.write_event_value = &hi8435_write_event_value,
|
||||
.debugfs_reg_access = &hi8435_debugfs_reg_access,
|
||||
};
|
||||
|
||||
static void hi8435_iio_push_event(struct iio_dev *idev, unsigned int val)
|
||||
{
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
enum iio_event_direction dir;
|
||||
unsigned int i;
|
||||
unsigned int status = priv->event_prev_val ^ val;
|
||||
|
||||
if (!status)
|
||||
return;
|
||||
|
||||
for_each_set_bit(i, &priv->event_scan_mask, 32) {
|
||||
if (status & BIT(i)) {
|
||||
dir = val & BIT(i) ? IIO_EV_DIR_RISING :
|
||||
IIO_EV_DIR_FALLING;
|
||||
iio_push_event(idev,
|
||||
IIO_UNMOD_EVENT_CODE(IIO_VOLTAGE, i,
|
||||
IIO_EV_TYPE_THRESH, dir),
|
||||
iio_get_time_ns());
|
||||
}
|
||||
}
|
||||
|
||||
priv->event_prev_val = val;
|
||||
}
|
||||
|
||||
static irqreturn_t hi8435_trigger_handler(int irq, void *private)
|
||||
{
|
||||
struct iio_poll_func *pf = private;
|
||||
struct iio_dev *idev = pf->indio_dev;
|
||||
struct hi8435_priv *priv = iio_priv(idev);
|
||||
u32 val;
|
||||
int ret;
|
||||
|
||||
ret = hi8435_readl(priv, HI8435_SO31_0_REG, &val);
|
||||
if (ret < 0)
|
||||
goto err_read;
|
||||
|
||||
hi8435_iio_push_event(idev, val);
|
||||
|
||||
err_read:
|
||||
iio_trigger_notify_done(idev->trig);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int hi8435_probe(struct spi_device *spi)
|
||||
{
|
||||
struct iio_dev *idev;
|
||||
struct hi8435_priv *priv;
|
||||
struct gpio_desc *reset_gpio;
|
||||
int ret;
|
||||
|
||||
idev = devm_iio_device_alloc(&spi->dev, sizeof(*priv));
|
||||
if (!idev)
|
||||
return -ENOMEM;
|
||||
|
||||
priv = iio_priv(idev);
|
||||
priv->spi = spi;
|
||||
|
||||
reset_gpio = devm_gpiod_get(&spi->dev, NULL, GPIOD_OUT_LOW);
|
||||
if (IS_ERR(reset_gpio)) {
|
||||
/* chip s/w reset if h/w reset failed */
|
||||
hi8435_writeb(priv, HI8435_CTRL_REG, HI8435_CTRL_SRST);
|
||||
hi8435_writeb(priv, HI8435_CTRL_REG, 0);
|
||||
} else {
|
||||
udelay(5);
|
||||
gpiod_set_value(reset_gpio, 1);
|
||||
}
|
||||
|
||||
spi_set_drvdata(spi, idev);
|
||||
mutex_init(&priv->lock);
|
||||
|
||||
idev->dev.parent = &spi->dev;
|
||||
idev->name = spi_get_device_id(spi)->name;
|
||||
idev->modes = INDIO_DIRECT_MODE;
|
||||
idev->info = &hi8435_info;
|
||||
idev->channels = hi8435_channels;
|
||||
idev->num_channels = ARRAY_SIZE(hi8435_channels);
|
||||
|
||||
/* unmask all events */
|
||||
priv->event_scan_mask = ~(0);
|
||||
/*
|
||||
* There is a restriction in the chip - the hysteresis can not be odd.
|
||||
* If the hysteresis is set to odd value then chip gets into lock state
|
||||
* and not functional anymore.
|
||||
* After chip reset the thresholds are in undefined state, so we need to
|
||||
* initialize thresholds to some initial values and then prevent
|
||||
* userspace setting odd hysteresis.
|
||||
*
|
||||
* Set threshold low voltage to 2V, threshold high voltage to 4V
|
||||
* for both GND-Open and Supply-Open sensing modes.
|
||||
*/
|
||||
priv->threshold_lo[0] = priv->threshold_lo[1] = 2;
|
||||
priv->threshold_hi[0] = priv->threshold_hi[1] = 4;
|
||||
hi8435_writew(priv, HI8435_GOCENHYS_REG, 0x206);
|
||||
hi8435_writew(priv, HI8435_SOCENHYS_REG, 0x206);
|
||||
|
||||
ret = iio_triggered_event_setup(idev, NULL, hi8435_trigger_handler);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = iio_device_register(idev);
|
||||
if (ret < 0) {
|
||||
dev_err(&spi->dev, "unable to register device\n");
|
||||
goto unregister_triggered_event;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
unregister_triggered_event:
|
||||
iio_triggered_event_cleanup(idev);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hi8435_remove(struct spi_device *spi)
|
||||
{
|
||||
struct iio_dev *idev = spi_get_drvdata(spi);
|
||||
|
||||
iio_device_unregister(idev);
|
||||
iio_triggered_event_cleanup(idev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id hi8435_dt_ids[] = {
|
||||
{ .compatible = "holt,hi8435" },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, hi8435_dt_ids);
|
||||
|
||||
static const struct spi_device_id hi8435_id[] = {
|
||||
{ "hi8435", 0},
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(spi, hi8435_id);
|
||||
|
||||
static struct spi_driver hi8435_driver = {
|
||||
.driver = {
|
||||
.name = DRV_NAME,
|
||||
.of_match_table = of_match_ptr(hi8435_dt_ids),
|
||||
},
|
||||
.probe = hi8435_probe,
|
||||
.remove = hi8435_remove,
|
||||
.id_table = hi8435_id,
|
||||
};
|
||||
module_spi_driver(hi8435_driver);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Vladimir Barinov");
|
||||
MODULE_DESCRIPTION("HI-8435 threshold detector");
|
|
@ -508,6 +508,7 @@ static int max1027_remove(struct spi_device *spi)
|
|||
static struct spi_driver max1027_driver = {
|
||||
.driver = {
|
||||
.name = "max1027",
|
||||
.of_match_table = of_match_ptr(max1027_adc_dt_ids),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = max1027_probe,
|
||||
|
|
|
@ -1007,7 +1007,6 @@ static struct attribute *max1363_event_attributes[] = {
|
|||
|
||||
static struct attribute_group max1363_event_attribute_group = {
|
||||
.attrs = max1363_event_attributes,
|
||||
.name = "events",
|
||||
};
|
||||
|
||||
static int max1363_update_scan_mode(struct iio_dev *indio_dev,
|
||||
|
|
|
@ -404,6 +404,7 @@ MODULE_DEVICE_TABLE(spi, mcp320x_id);
|
|||
static struct spi_driver mcp320x_driver = {
|
||||
.driver = {
|
||||
.name = "mcp320x",
|
||||
.of_match_table = of_match_ptr(mcp320x_dt_ids),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = mcp320x_probe,
|
||||
|
|
|
@ -174,6 +174,13 @@ static int adc128_remove(struct spi_device *spi)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id adc128_of_match[] = {
|
||||
{ .compatible = "ti,adc128s052", },
|
||||
{ .compatible = "ti,adc122s021", },
|
||||
{ /* sentinel */ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, adc128_of_match);
|
||||
|
||||
static const struct spi_device_id adc128_id[] = {
|
||||
{ "adc128s052", 0}, /* index into adc128_config */
|
||||
{ "adc122s021", 1},
|
||||
|
@ -184,6 +191,7 @@ MODULE_DEVICE_TABLE(spi, adc128_id);
|
|||
static struct spi_driver adc128_driver = {
|
||||
.driver = {
|
||||
.name = "adc128s052",
|
||||
.of_match_table = of_match_ptr(adc128_of_match),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = adc128_probe,
|
||||
|
|
|
@ -875,6 +875,7 @@ static const struct of_device_id of_twl6030_match_tbl[] = {
|
|||
},
|
||||
{ /* end */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, of_twl6030_match_tbl);
|
||||
|
||||
static int twl6030_gpadc_probe(struct platform_device *pdev)
|
||||
{
|
||||
|
|
|
@ -34,8 +34,11 @@
|
|||
#include <linux/err.h>
|
||||
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/buffer.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/iio/driver.h>
|
||||
#include <linux/iio/trigger.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
#include <linux/iio/triggered_buffer.h>
|
||||
|
||||
/* This will be the driver name the kernel reports */
|
||||
#define DRIVER_NAME "vf610-adc"
|
||||
|
@ -170,6 +173,7 @@ struct vf610_adc {
|
|||
u32 sample_freq_avail[5];
|
||||
|
||||
struct completion completion;
|
||||
u16 buffer[8];
|
||||
};
|
||||
|
||||
static const u32 vf610_hw_avgs[] = { 1, 4, 8, 16, 32 };
|
||||
|
@ -505,12 +509,24 @@ static const struct iio_chan_spec_ext_info vf610_ext_info[] = {
|
|||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
|
||||
BIT(IIO_CHAN_INFO_SAMP_FREQ), \
|
||||
.ext_info = vf610_ext_info, \
|
||||
.scan_index = (_idx), \
|
||||
.scan_type = { \
|
||||
.sign = 'u', \
|
||||
.realbits = 12, \
|
||||
.storagebits = 16, \
|
||||
}, \
|
||||
}
|
||||
|
||||
#define VF610_ADC_TEMPERATURE_CHAN(_idx, _chan_type) { \
|
||||
.type = (_chan_type), \
|
||||
.channel = (_idx), \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED), \
|
||||
.scan_index = (_idx), \
|
||||
.scan_type = { \
|
||||
.sign = 'u', \
|
||||
.realbits = 12, \
|
||||
.storagebits = 16, \
|
||||
}, \
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec vf610_adc_iio_channels[] = {
|
||||
|
@ -531,6 +547,7 @@ static const struct iio_chan_spec vf610_adc_iio_channels[] = {
|
|||
VF610_ADC_CHAN(14, IIO_VOLTAGE),
|
||||
VF610_ADC_CHAN(15, IIO_VOLTAGE),
|
||||
VF610_ADC_TEMPERATURE_CHAN(26, IIO_TEMP),
|
||||
IIO_CHAN_SOFT_TIMESTAMP(32),
|
||||
/* sentinel */
|
||||
};
|
||||
|
||||
|
@ -559,12 +576,19 @@ static int vf610_adc_read_data(struct vf610_adc *info)
|
|||
|
||||
static irqreturn_t vf610_adc_isr(int irq, void *dev_id)
|
||||
{
|
||||
struct vf610_adc *info = (struct vf610_adc *)dev_id;
|
||||
struct iio_dev *indio_dev = (struct iio_dev *)dev_id;
|
||||
struct vf610_adc *info = iio_priv(indio_dev);
|
||||
int coco;
|
||||
|
||||
coco = readl(info->regs + VF610_REG_ADC_HS);
|
||||
if (coco & VF610_ADC_HS_COCO0) {
|
||||
info->value = vf610_adc_read_data(info);
|
||||
if (iio_buffer_enabled(indio_dev)) {
|
||||
info->buffer[0] = info->value;
|
||||
iio_push_to_buffers_with_timestamp(indio_dev,
|
||||
info->buffer, iio_get_time_ns());
|
||||
iio_trigger_notify_done(indio_dev->trig);
|
||||
} else
|
||||
complete(&info->completion);
|
||||
}
|
||||
|
||||
|
@ -613,8 +637,12 @@ static int vf610_read_raw(struct iio_dev *indio_dev,
|
|||
case IIO_CHAN_INFO_RAW:
|
||||
case IIO_CHAN_INFO_PROCESSED:
|
||||
mutex_lock(&indio_dev->mlock);
|
||||
reinit_completion(&info->completion);
|
||||
if (iio_buffer_enabled(indio_dev)) {
|
||||
mutex_unlock(&indio_dev->mlock);
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
reinit_completion(&info->completion);
|
||||
hc_cfg = VF610_ADC_ADCHC(chan->channel);
|
||||
hc_cfg |= VF610_ADC_AIEN;
|
||||
writel(hc_cfg, info->regs + VF610_REG_ADC_HC0);
|
||||
|
@ -694,6 +722,56 @@ static int vf610_write_raw(struct iio_dev *indio_dev,
|
|||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int vf610_adc_buffer_postenable(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct vf610_adc *info = iio_priv(indio_dev);
|
||||
unsigned int channel;
|
||||
int ret;
|
||||
int val;
|
||||
|
||||
ret = iio_triggered_buffer_postenable(indio_dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
val = readl(info->regs + VF610_REG_ADC_GC);
|
||||
val |= VF610_ADC_ADCON;
|
||||
writel(val, info->regs + VF610_REG_ADC_GC);
|
||||
|
||||
channel = find_first_bit(indio_dev->active_scan_mask,
|
||||
indio_dev->masklength);
|
||||
|
||||
val = VF610_ADC_ADCHC(channel);
|
||||
val |= VF610_ADC_AIEN;
|
||||
|
||||
writel(val, info->regs + VF610_REG_ADC_HC0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int vf610_adc_buffer_predisable(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct vf610_adc *info = iio_priv(indio_dev);
|
||||
unsigned int hc_cfg = 0;
|
||||
int val;
|
||||
|
||||
val = readl(info->regs + VF610_REG_ADC_GC);
|
||||
val &= ~VF610_ADC_ADCON;
|
||||
writel(val, info->regs + VF610_REG_ADC_GC);
|
||||
|
||||
hc_cfg |= VF610_ADC_CONV_DISABLE;
|
||||
hc_cfg &= ~VF610_ADC_AIEN;
|
||||
|
||||
writel(hc_cfg, info->regs + VF610_REG_ADC_HC0);
|
||||
|
||||
return iio_triggered_buffer_predisable(indio_dev);
|
||||
}
|
||||
|
||||
static const struct iio_buffer_setup_ops iio_triggered_buffer_setup_ops = {
|
||||
.postenable = &vf610_adc_buffer_postenable,
|
||||
.predisable = &vf610_adc_buffer_predisable,
|
||||
.validate_scan_mask = &iio_validate_scan_mask_onehot,
|
||||
};
|
||||
|
||||
static int vf610_adc_reg_access(struct iio_dev *indio_dev,
|
||||
unsigned reg, unsigned writeval,
|
||||
unsigned *readval)
|
||||
|
@ -753,7 +831,7 @@ static int vf610_adc_probe(struct platform_device *pdev)
|
|||
|
||||
ret = devm_request_irq(info->dev, irq,
|
||||
vf610_adc_isr, 0,
|
||||
dev_name(&pdev->dev), info);
|
||||
dev_name(&pdev->dev), indio_dev);
|
||||
if (ret < 0) {
|
||||
dev_err(&pdev->dev, "failed requesting irq, irq = %d\n", irq);
|
||||
return ret;
|
||||
|
@ -806,15 +884,23 @@ static int vf610_adc_probe(struct platform_device *pdev)
|
|||
vf610_adc_cfg_init(info);
|
||||
vf610_adc_hw_init(info);
|
||||
|
||||
ret = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time,
|
||||
NULL, &iio_triggered_buffer_setup_ops);
|
||||
if (ret < 0) {
|
||||
dev_err(&pdev->dev, "Couldn't initialise the buffer\n");
|
||||
goto error_iio_device_register;
|
||||
}
|
||||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "Couldn't register the device.\n");
|
||||
goto error_iio_device_register;
|
||||
goto error_adc_buffer_init;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
error_adc_buffer_init:
|
||||
iio_triggered_buffer_cleanup(indio_dev);
|
||||
error_iio_device_register:
|
||||
clk_disable_unprepare(info->clk);
|
||||
error_adc_clk_enable:
|
||||
|
@ -829,6 +915,7 @@ static int vf610_adc_remove(struct platform_device *pdev)
|
|||
struct vf610_adc *info = iio_priv(indio_dev);
|
||||
|
||||
iio_device_unregister(indio_dev);
|
||||
iio_triggered_buffer_cleanup(indio_dev);
|
||||
regulator_disable(info->vref);
|
||||
clk_disable_unprepare(info->clk);
|
||||
|
||||
|
|
|
@ -273,33 +273,13 @@ static void xadc_zynq_unmask_worker(struct work_struct *work)
|
|||
schedule_delayed_work(&xadc->zynq_unmask_work,
|
||||
msecs_to_jiffies(XADC_ZYNQ_UNMASK_TIMEOUT));
|
||||
}
|
||||
}
|
||||
|
||||
static irqreturn_t xadc_zynq_threaded_interrupt_handler(int irq, void *devid)
|
||||
{
|
||||
struct iio_dev *indio_dev = devid;
|
||||
struct xadc *xadc = iio_priv(indio_dev);
|
||||
unsigned int alarm;
|
||||
|
||||
spin_lock_irq(&xadc->lock);
|
||||
alarm = xadc->zynq_alarm;
|
||||
xadc->zynq_alarm = 0;
|
||||
spin_unlock_irq(&xadc->lock);
|
||||
|
||||
xadc_handle_events(indio_dev, xadc_zynq_transform_alarm(alarm));
|
||||
|
||||
/* unmask the required interrupts in timer. */
|
||||
schedule_delayed_work(&xadc->zynq_unmask_work,
|
||||
msecs_to_jiffies(XADC_ZYNQ_UNMASK_TIMEOUT));
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static irqreturn_t xadc_zynq_interrupt_handler(int irq, void *devid)
|
||||
{
|
||||
struct iio_dev *indio_dev = devid;
|
||||
struct xadc *xadc = iio_priv(indio_dev);
|
||||
irqreturn_t ret = IRQ_HANDLED;
|
||||
uint32_t status;
|
||||
|
||||
xadc_read_reg(xadc, XADC_ZYNQ_REG_INTSTS, &status);
|
||||
|
@ -321,18 +301,23 @@ static irqreturn_t xadc_zynq_interrupt_handler(int irq, void *devid)
|
|||
|
||||
status &= XADC_ZYNQ_INT_ALARM_MASK;
|
||||
if (status) {
|
||||
xadc->zynq_alarm |= status;
|
||||
xadc->zynq_masked_alarm |= status;
|
||||
/*
|
||||
* mask the current event interrupt,
|
||||
* unmask it when the interrupt is no more active.
|
||||
*/
|
||||
xadc_zynq_update_intmsk(xadc, 0, 0);
|
||||
ret = IRQ_WAKE_THREAD;
|
||||
|
||||
xadc_handle_events(indio_dev,
|
||||
xadc_zynq_transform_alarm(status));
|
||||
|
||||
/* unmask the required interrupts in timer. */
|
||||
schedule_delayed_work(&xadc->zynq_unmask_work,
|
||||
msecs_to_jiffies(XADC_ZYNQ_UNMASK_TIMEOUT));
|
||||
}
|
||||
spin_unlock(&xadc->lock);
|
||||
|
||||
return ret;
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
#define XADC_ZYNQ_TCK_RATE_MAX 50000000
|
||||
|
@ -437,7 +422,6 @@ static const struct xadc_ops xadc_zynq_ops = {
|
|||
.setup = xadc_zynq_setup,
|
||||
.get_dclk_rate = xadc_zynq_get_dclk_rate,
|
||||
.interrupt_handler = xadc_zynq_interrupt_handler,
|
||||
.threaded_interrupt_handler = xadc_zynq_threaded_interrupt_handler,
|
||||
.update_alarm = xadc_zynq_update_alarm,
|
||||
};
|
||||
|
||||
|
@ -1225,9 +1209,8 @@ static int xadc_probe(struct platform_device *pdev)
|
|||
if (ret)
|
||||
goto err_free_samplerate_trigger;
|
||||
|
||||
ret = request_threaded_irq(irq, xadc->ops->interrupt_handler,
|
||||
xadc->ops->threaded_interrupt_handler,
|
||||
0, dev_name(&pdev->dev), indio_dev);
|
||||
ret = request_irq(irq, xadc->ops->interrupt_handler, 0,
|
||||
dev_name(&pdev->dev), indio_dev);
|
||||
if (ret)
|
||||
goto err_clk_disable_unprepare;
|
||||
|
||||
|
|
|
@ -60,7 +60,6 @@ struct xadc {
|
|||
|
||||
enum xadc_external_mux_mode external_mux_mode;
|
||||
|
||||
unsigned int zynq_alarm;
|
||||
unsigned int zynq_masked_alarm;
|
||||
unsigned int zynq_intmask;
|
||||
struct delayed_work zynq_unmask_work;
|
||||
|
@ -79,7 +78,6 @@ struct xadc_ops {
|
|||
void (*update_alarm)(struct xadc *, unsigned int);
|
||||
unsigned long (*get_dclk_rate)(struct xadc *);
|
||||
irqreturn_t (*interrupt_handler)(int, void *);
|
||||
irqreturn_t (*threaded_interrupt_handler)(int, void *);
|
||||
|
||||
unsigned int flags;
|
||||
};
|
||||
|
|
|
@ -195,6 +195,7 @@ static const struct spi_device_id ad8366_id[] = {
|
|||
{"ad8366", 0},
|
||||
{}
|
||||
};
|
||||
MODULE_DEVICE_TABLE(spi, ad8366_id);
|
||||
|
||||
static struct spi_driver ad8366_driver = {
|
||||
.driver = {
|
||||
|
|
24
drivers/iio/buffer/Kconfig
Normal file
24
drivers/iio/buffer/Kconfig
Normal file
|
@ -0,0 +1,24 @@
|
|||
#
|
||||
# Industrial I/O generic buffer implementations
|
||||
#
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
|
||||
config IIO_BUFFER_CB
|
||||
tristate "IIO callback buffer used for push in-kernel interfaces"
|
||||
help
|
||||
Should be selected by any drivers that do in-kernel push
|
||||
usage. That is, those where the data is pushed to the consumer.
|
||||
|
||||
config IIO_KFIFO_BUF
|
||||
tristate "Industrial I/O buffering based on kfifo"
|
||||
help
|
||||
A simple fifo based on kfifo. Note that this currently provides
|
||||
no buffer events so it is up to userspace to work out how
|
||||
often to read from the buffer.
|
||||
|
||||
config IIO_TRIGGERED_BUFFER
|
||||
tristate
|
||||
select IIO_TRIGGER
|
||||
select IIO_KFIFO_BUF
|
||||
help
|
||||
Provides helper functions for setting up triggered buffers.
|
8
drivers/iio/buffer/Makefile
Normal file
8
drivers/iio/buffer/Makefile
Normal file
|
@ -0,0 +1,8 @@
|
|||
#
|
||||
# Makefile for the industrial I/O buffer implementations
|
||||
#
|
||||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_IIO_BUFFER_CB) += industrialio-buffer-cb.o
|
||||
obj-$(CONFIG_IIO_TRIGGERED_BUFFER) += industrialio-triggered-buffer.o
|
||||
obj-$(CONFIG_IIO_KFIFO_BUF) += kfifo_buf.o
|
|
@ -1,4 +1,12 @@
|
|||
/* The industrial I/O callback buffer
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/export.h>
|
||||
|
@ -124,3 +132,7 @@ struct iio_channel
|
|||
return cb_buffer->channels;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(iio_channel_cb_get_channels);
|
||||
|
||||
MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>");
|
||||
MODULE_DESCRIPTION("Industrial I/O callback buffer");
|
||||
MODULE_LICENSE("GPL");
|
15
drivers/iio/chemical/Kconfig
Normal file
15
drivers/iio/chemical/Kconfig
Normal file
|
@ -0,0 +1,15 @@
|
|||
#
|
||||
# Chemical sensors
|
||||
#
|
||||
|
||||
menu "Chemical Sensors"
|
||||
|
||||
config VZ89X
|
||||
tristate "SGX Sensortech MiCS VZ89X VOC sensor"
|
||||
depends on I2C
|
||||
help
|
||||
Say Y here to build I2C interface support for the SGX
|
||||
Sensortech MiCS VZ89X VOC (Volatile Organic Compounds)
|
||||
sensors
|
||||
|
||||
endmenu
|
6
drivers/iio/chemical/Makefile
Normal file
6
drivers/iio/chemical/Makefile
Normal file
|
@ -0,0 +1,6 @@
|
|||
#
|
||||
# Makefile for IIO chemical sensors
|
||||
#
|
||||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_VZ89X) += vz89x.o
|
256
drivers/iio/chemical/vz89x.c
Normal file
256
drivers/iio/chemical/vz89x.c
Normal file
|
@ -0,0 +1,256 @@
|
|||
/*
|
||||
* vz89x.c - Support for SGX Sensortech MiCS VZ89X VOC sensors
|
||||
*
|
||||
* Copyright (C) 2015 Matt Ranostay <mranostay@gmail.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/i2c.h>
|
||||
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
|
||||
#define VZ89X_REG_MEASUREMENT 0x09
|
||||
#define VZ89X_REG_MEASUREMENT_SIZE 6
|
||||
|
||||
#define VZ89X_VOC_CO2_IDX 0
|
||||
#define VZ89X_VOC_SHORT_IDX 1
|
||||
#define VZ89X_VOC_TVOC_IDX 2
|
||||
#define VZ89X_VOC_RESISTANCE_IDX 3
|
||||
|
||||
struct vz89x_data {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
unsigned long last_update;
|
||||
|
||||
u8 buffer[VZ89X_REG_MEASUREMENT_SIZE];
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec vz89x_channels[] = {
|
||||
{
|
||||
.type = IIO_CONCENTRATION,
|
||||
.channel2 = IIO_MOD_CO2,
|
||||
.modified = 1,
|
||||
.info_mask_separate =
|
||||
BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
|
||||
.address = VZ89X_VOC_CO2_IDX,
|
||||
},
|
||||
{
|
||||
.type = IIO_CONCENTRATION,
|
||||
.channel2 = IIO_MOD_VOC,
|
||||
.modified = 1,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
||||
.address = VZ89X_VOC_SHORT_IDX,
|
||||
.extend_name = "short",
|
||||
},
|
||||
{
|
||||
.type = IIO_CONCENTRATION,
|
||||
.channel2 = IIO_MOD_VOC,
|
||||
.modified = 1,
|
||||
.info_mask_separate =
|
||||
BIT(IIO_CHAN_INFO_OFFSET) | BIT(IIO_CHAN_INFO_RAW),
|
||||
.address = VZ89X_VOC_TVOC_IDX,
|
||||
},
|
||||
{
|
||||
.type = IIO_RESISTANCE,
|
||||
.info_mask_separate =
|
||||
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
||||
.address = VZ89X_VOC_RESISTANCE_IDX,
|
||||
},
|
||||
};
|
||||
|
||||
static IIO_CONST_ATTR(in_concentration_co2_scale, "0.00000698689");
|
||||
static IIO_CONST_ATTR(in_concentration_voc_scale, "0.00000000436681223");
|
||||
|
||||
static struct attribute *vz89x_attributes[] = {
|
||||
&iio_const_attr_in_concentration_co2_scale.dev_attr.attr,
|
||||
&iio_const_attr_in_concentration_voc_scale.dev_attr.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group vz89x_attrs_group = {
|
||||
.attrs = vz89x_attributes,
|
||||
};
|
||||
|
||||
/*
|
||||
* Chipset sometime updates in the middle of a reading causing it to reset the
|
||||
* data pointer, and causing invalid reading of previous data.
|
||||
* We can check for this by reading MSB of the resistance reading that is
|
||||
* always zero, and by also confirming the VOC_short isn't zero.
|
||||
*/
|
||||
|
||||
static int vz89x_measurement_is_valid(struct vz89x_data *data)
|
||||
{
|
||||
if (data->buffer[VZ89X_VOC_SHORT_IDX] == 0)
|
||||
return 1;
|
||||
|
||||
return !!(data->buffer[VZ89X_REG_MEASUREMENT_SIZE - 1] > 0);
|
||||
}
|
||||
|
||||
static int vz89x_get_measurement(struct vz89x_data *data)
|
||||
{
|
||||
int ret;
|
||||
int i;
|
||||
|
||||
/* sensor can only be polled once a second max per datasheet */
|
||||
if (!time_after(jiffies, data->last_update + HZ))
|
||||
return 0;
|
||||
|
||||
ret = i2c_smbus_write_word_data(data->client,
|
||||
VZ89X_REG_MEASUREMENT, 0);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
for (i = 0; i < VZ89X_REG_MEASUREMENT_SIZE; i++) {
|
||||
ret = i2c_smbus_read_byte(data->client);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
data->buffer[i] = ret;
|
||||
}
|
||||
|
||||
ret = vz89x_measurement_is_valid(data);
|
||||
if (ret)
|
||||
return -EAGAIN;
|
||||
|
||||
data->last_update = jiffies;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int vz89x_get_resistance_reading(struct vz89x_data *data)
|
||||
{
|
||||
u8 *buf = &data->buffer[VZ89X_VOC_RESISTANCE_IDX];
|
||||
|
||||
return buf[0] | (buf[1] << 8);
|
||||
}
|
||||
|
||||
static int vz89x_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
struct vz89x_data *data = iio_priv(indio_dev);
|
||||
int ret = -EINVAL;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
mutex_lock(&data->lock);
|
||||
ret = vz89x_get_measurement(data);
|
||||
mutex_unlock(&data->lock);
|
||||
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
switch (chan->address) {
|
||||
case VZ89X_VOC_CO2_IDX:
|
||||
case VZ89X_VOC_SHORT_IDX:
|
||||
case VZ89X_VOC_TVOC_IDX:
|
||||
*val = data->buffer[chan->address];
|
||||
return IIO_VAL_INT;
|
||||
case VZ89X_VOC_RESISTANCE_IDX:
|
||||
*val = vz89x_get_resistance_reading(data);
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
switch (chan->type) {
|
||||
case IIO_RESISTANCE:
|
||||
*val = 10;
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_OFFSET:
|
||||
switch (chan->address) {
|
||||
case VZ89X_VOC_CO2_IDX:
|
||||
*val = 44;
|
||||
*val2 = 250000;
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
case VZ89X_VOC_TVOC_IDX:
|
||||
*val = -13;
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct iio_info vz89x_info = {
|
||||
.attrs = &vz89x_attrs_group,
|
||||
.read_raw = vz89x_read_raw,
|
||||
.driver_module = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int vz89x_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct iio_dev *indio_dev;
|
||||
struct vz89x_data *data;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_WORD_DATA |
|
||||
I2C_FUNC_SMBUS_BYTE))
|
||||
return -ENODEV;
|
||||
|
||||
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;
|
||||
data->last_update = jiffies - HZ;
|
||||
mutex_init(&data->lock);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->info = &vz89x_info,
|
||||
indio_dev->name = dev_name(&client->dev);
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
|
||||
indio_dev->channels = vz89x_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(vz89x_channels);
|
||||
|
||||
return devm_iio_device_register(&client->dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct i2c_device_id vz89x_id[] = {
|
||||
{ "vz89x", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, vz89x_id);
|
||||
|
||||
static const struct of_device_id vz89x_dt_ids[] = {
|
||||
{ .compatible = "sgx,vz89x" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, vz89x_dt_ids);
|
||||
|
||||
static struct i2c_driver vz89x_driver = {
|
||||
.driver = {
|
||||
.name = "vz89x",
|
||||
.of_match_table = of_match_ptr(vz89x_dt_ids),
|
||||
},
|
||||
.probe = vz89x_probe,
|
||||
.id_table = vz89x_id,
|
||||
};
|
||||
module_i2c_driver(vz89x_driver);
|
||||
|
||||
MODULE_AUTHOR("Matt Ranostay <mranostay@gmail.com>");
|
||||
MODULE_DESCRIPTION("SGX Sensortech MiCS VZ89X VOC sensors");
|
||||
MODULE_LICENSE("GPL v2");
|
|
@ -3,5 +3,6 @@
|
|||
#
|
||||
|
||||
source "drivers/iio/common/hid-sensors/Kconfig"
|
||||
source "drivers/iio/common/ms_sensors/Kconfig"
|
||||
source "drivers/iio/common/ssp_sensors/Kconfig"
|
||||
source "drivers/iio/common/st_sensors/Kconfig"
|
||||
|
|
|
@ -8,5 +8,6 @@
|
|||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-y += hid-sensors/
|
||||
obj-y += ms_sensors/
|
||||
obj-y += ssp_sensors/
|
||||
obj-y += st_sensors/
|
||||
|
|
6
drivers/iio/common/ms_sensors/Kconfig
Normal file
6
drivers/iio/common/ms_sensors/Kconfig
Normal file
|
@ -0,0 +1,6 @@
|
|||
#
|
||||
# Measurements Specialties sensors common library
|
||||
#
|
||||
|
||||
config IIO_MS_SENSORS_I2C
|
||||
tristate
|
5
drivers/iio/common/ms_sensors/Makefile
Normal file
5
drivers/iio/common/ms_sensors/Makefile
Normal file
|
@ -0,0 +1,5 @@
|
|||
#
|
||||
# Makefile for the Measurement Specialties sensor common modules.
|
||||
#
|
||||
|
||||
obj-$(CONFIG_IIO_MS_SENSORS_I2C) += ms_sensors_i2c.o
|
652
drivers/iio/common/ms_sensors/ms_sensors_i2c.c
Normal file
652
drivers/iio/common/ms_sensors/ms_sensors_i2c.c
Normal file
|
@ -0,0 +1,652 @@
|
|||
/*
|
||||
* Measurements Specialties driver common i2c functions
|
||||
*
|
||||
* Copyright (c) 2015 Measurement-Specialties
|
||||
*
|
||||
* Licensed under the GPL-2.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "ms_sensors_i2c.h"
|
||||
|
||||
/* Conversion times in us */
|
||||
static const u16 ms_sensors_ht_t_conversion_time[] = { 50000, 25000,
|
||||
13000, 7000 };
|
||||
static const u16 ms_sensors_ht_h_conversion_time[] = { 16000, 3000,
|
||||
5000, 8000 };
|
||||
static const u16 ms_sensors_tp_conversion_time[] = { 500, 1100, 2100,
|
||||
4100, 8220, 16440 };
|
||||
|
||||
#define MS_SENSORS_SERIAL_READ_MSB 0xFA0F
|
||||
#define MS_SENSORS_SERIAL_READ_LSB 0xFCC9
|
||||
#define MS_SENSORS_CONFIG_REG_WRITE 0xE6
|
||||
#define MS_SENSORS_CONFIG_REG_READ 0xE7
|
||||
#define MS_SENSORS_HT_T_CONVERSION_START 0xF3
|
||||
#define MS_SENSORS_HT_H_CONVERSION_START 0xF5
|
||||
|
||||
#define MS_SENSORS_TP_PROM_READ 0xA0
|
||||
#define MS_SENSORS_TP_T_CONVERSION_START 0x50
|
||||
#define MS_SENSORS_TP_P_CONVERSION_START 0x40
|
||||
#define MS_SENSORS_TP_ADC_READ 0x00
|
||||
|
||||
#define MS_SENSORS_NO_READ_CMD 0xFF
|
||||
|
||||
/**
|
||||
* ms_sensors_reset() - Reset function
|
||||
* @cli: pointer to device client
|
||||
* @cmd: reset cmd. Depends on device in use
|
||||
* @delay: usleep minimal delay after reset command is issued
|
||||
*
|
||||
* Generic I2C reset function for Measurement Specialties devices.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_reset(void *cli, u8 cmd, unsigned int delay)
|
||||
{
|
||||
int ret;
|
||||
struct i2c_client *client = cli;
|
||||
|
||||
ret = i2c_smbus_write_byte(client, cmd);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "Failed to reset device\n");
|
||||
return ret;
|
||||
}
|
||||
usleep_range(delay, delay + 1000);
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_reset);
|
||||
|
||||
/**
|
||||
* ms_sensors_read_prom_word() - PROM word read function
|
||||
* @cli: pointer to device client
|
||||
* @cmd: PROM read cmd. Depends on device and prom id
|
||||
* @word: pointer to word destination value
|
||||
*
|
||||
* Generic i2c prom word read function for Measurement Specialties devices.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_read_prom_word(void *cli, int cmd, u16 *word)
|
||||
{
|
||||
int ret;
|
||||
struct i2c_client *client = (struct i2c_client *)cli;
|
||||
|
||||
ret = i2c_smbus_read_word_swapped(client, cmd);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Failed to read prom word\n");
|
||||
return ret;
|
||||
}
|
||||
*word = ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_read_prom_word);
|
||||
|
||||
/**
|
||||
* ms_sensors_convert_and_read() - ADC conversion & read function
|
||||
* @cli: pointer to device client
|
||||
* @conv: ADC conversion command. Depends on device in use
|
||||
* @rd: ADC read command. Depends on device in use
|
||||
* @delay: usleep minimal delay after conversion command is issued
|
||||
* @adc: pointer to ADC destination value
|
||||
*
|
||||
* Generic ADC conversion & read function for Measurement Specialties
|
||||
* devices.
|
||||
* The function will issue conversion command, sleep appopriate delay, and
|
||||
* issue command to read ADC.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_convert_and_read(void *cli, u8 conv, u8 rd,
|
||||
unsigned int delay, u32 *adc)
|
||||
{
|
||||
int ret;
|
||||
__be32 buf = 0;
|
||||
struct i2c_client *client = (struct i2c_client *)cli;
|
||||
|
||||
/* Trigger conversion */
|
||||
ret = i2c_smbus_write_byte(client, conv);
|
||||
if (ret)
|
||||
goto err;
|
||||
usleep_range(delay, delay + 1000);
|
||||
|
||||
/* Retrieve ADC value */
|
||||
if (rd != MS_SENSORS_NO_READ_CMD)
|
||||
ret = i2c_smbus_read_i2c_block_data(client, rd, 3, (u8 *)&buf);
|
||||
else
|
||||
ret = i2c_master_recv(client, (u8 *)&buf, 3);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
|
||||
dev_dbg(&client->dev, "ADC raw value : %x\n", be32_to_cpu(buf) >> 8);
|
||||
*adc = be32_to_cpu(buf) >> 8;
|
||||
|
||||
return 0;
|
||||
err:
|
||||
dev_err(&client->dev, "Unable to make sensor adc conversion\n");
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_convert_and_read);
|
||||
|
||||
/**
|
||||
* ms_sensors_crc_valid() - CRC check function
|
||||
* @value: input and CRC compare value
|
||||
*
|
||||
* Cyclic Redundancy Check function used in TSYS02D, HTU21, MS8607.
|
||||
* This function performs a x^8 + x^5 + x^4 + 1 polynomial CRC.
|
||||
* The argument contains CRC value in LSB byte while the bytes 1 and 2
|
||||
* are used for CRC computation.
|
||||
*
|
||||
* Return: 1 if CRC is valid, 0 otherwise.
|
||||
*/
|
||||
static bool ms_sensors_crc_valid(u32 value)
|
||||
{
|
||||
u32 polynom = 0x988000; /* x^8 + x^5 + x^4 + 1 */
|
||||
u32 msb = 0x800000;
|
||||
u32 mask = 0xFF8000;
|
||||
u32 result = value & 0xFFFF00;
|
||||
u8 crc = value & 0xFF;
|
||||
|
||||
while (msb != 0x80) {
|
||||
if (result & msb)
|
||||
result = ((result ^ polynom) & mask)
|
||||
| (result & ~mask);
|
||||
msb >>= 1;
|
||||
mask >>= 1;
|
||||
polynom >>= 1;
|
||||
}
|
||||
|
||||
return result == crc;
|
||||
}
|
||||
|
||||
/**
|
||||
* ms_sensors_read_serial() - Serial number read function
|
||||
* @cli: pointer to i2c client
|
||||
* @sn: pointer to 64-bits destination value
|
||||
*
|
||||
* Generic i2c serial number read function for Measurement Specialties devices.
|
||||
* This function is used for TSYS02d, HTU21, MS8607 chipset.
|
||||
* Refer to datasheet:
|
||||
* http://www.meas-spec.com/downloads/HTU2X_Serial_Number_Reading.pdf
|
||||
*
|
||||
* Sensor raw MSB serial number format is the following :
|
||||
* [ SNB3, CRC, SNB2, CRC, SNB1, CRC, SNB0, CRC]
|
||||
* Sensor raw LSB serial number format is the following :
|
||||
* [ X, X, SNC1, SNC0, CRC, SNA1, SNA0, CRC]
|
||||
* The resulting serial number is following :
|
||||
* [ SNA1, SNA0, SNB3, SNB2, SNB1, SNB0, SNC1, SNC0]
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_read_serial(struct i2c_client *client, u64 *sn)
|
||||
{
|
||||
u8 i;
|
||||
__be64 rcv_buf = 0;
|
||||
u64 rcv_val;
|
||||
__be16 send_buf;
|
||||
int ret;
|
||||
|
||||
struct i2c_msg msg[2] = {
|
||||
{
|
||||
.addr = client->addr,
|
||||
.flags = client->flags,
|
||||
.len = 2,
|
||||
.buf = (__u8 *)&send_buf,
|
||||
},
|
||||
{
|
||||
.addr = client->addr,
|
||||
.flags = client->flags | I2C_M_RD,
|
||||
.buf = (__u8 *)&rcv_buf,
|
||||
},
|
||||
};
|
||||
|
||||
/* Read MSB part of serial number */
|
||||
send_buf = cpu_to_be16(MS_SENSORS_SERIAL_READ_MSB);
|
||||
msg[1].len = 8;
|
||||
ret = i2c_transfer(client->adapter, msg, 2);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Unable to read device serial number");
|
||||
return ret;
|
||||
}
|
||||
|
||||
rcv_val = be64_to_cpu(rcv_buf);
|
||||
dev_dbg(&client->dev, "Serial MSB raw : %llx\n", rcv_val);
|
||||
|
||||
for (i = 0; i < 64; i += 16) {
|
||||
if (!ms_sensors_crc_valid((rcv_val >> i) & 0xFFFF))
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
*sn = (((rcv_val >> 32) & 0xFF000000) |
|
||||
((rcv_val >> 24) & 0x00FF0000) |
|
||||
((rcv_val >> 16) & 0x0000FF00) |
|
||||
((rcv_val >> 8) & 0x000000FF)) << 16;
|
||||
|
||||
/* Read LSB part of serial number */
|
||||
send_buf = cpu_to_be16(MS_SENSORS_SERIAL_READ_LSB);
|
||||
msg[1].len = 6;
|
||||
rcv_buf = 0;
|
||||
ret = i2c_transfer(client->adapter, msg, 2);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Unable to read device serial number");
|
||||
return ret;
|
||||
}
|
||||
|
||||
rcv_val = be64_to_cpu(rcv_buf) >> 16;
|
||||
dev_dbg(&client->dev, "Serial MSB raw : %llx\n", rcv_val);
|
||||
|
||||
for (i = 0; i < 48; i += 24) {
|
||||
if (!ms_sensors_crc_valid((rcv_val >> i) & 0xFFFFFF))
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
*sn |= (rcv_val & 0xFFFF00) << 40 | (rcv_val >> 32);
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_read_serial);
|
||||
|
||||
static int ms_sensors_read_config_reg(struct i2c_client *client,
|
||||
u8 *config_reg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte(client, MS_SENSORS_CONFIG_REG_READ);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "Unable to read config register");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_master_recv(client, config_reg, 1);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "Unable to read config register");
|
||||
return ret;
|
||||
}
|
||||
dev_dbg(&client->dev, "Config register :%x\n", *config_reg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* ms_sensors_write_resolution() - Set resolution function
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @i: resolution index to set
|
||||
*
|
||||
* This function will program the appropriate resolution based on the index
|
||||
* provided when user space will set samp_freq channel.
|
||||
* This function is used for TSYS02D, HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
ssize_t ms_sensors_write_resolution(struct ms_ht_dev *dev_data,
|
||||
u8 i)
|
||||
{
|
||||
u8 config_reg;
|
||||
int ret;
|
||||
|
||||
ret = ms_sensors_read_config_reg(dev_data->client, &config_reg);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
config_reg &= 0x7E;
|
||||
config_reg |= ((i & 1) << 7) + ((i & 2) >> 1);
|
||||
|
||||
return i2c_smbus_write_byte_data(dev_data->client,
|
||||
MS_SENSORS_CONFIG_REG_WRITE,
|
||||
config_reg);
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_write_resolution);
|
||||
|
||||
/**
|
||||
* ms_sensors_show_battery_low() - Show device battery low indicator
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @buf: pointer to char buffer to write result
|
||||
*
|
||||
* This function will read battery indicator value in the device and
|
||||
* return 1 if the device voltage is below 2.25V.
|
||||
* This function is used for TSYS02D, HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: length of sprintf on success, negative errno otherwise.
|
||||
*/
|
||||
ssize_t ms_sensors_show_battery_low(struct ms_ht_dev *dev_data,
|
||||
char *buf)
|
||||
{
|
||||
int ret;
|
||||
u8 config_reg;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
ret = ms_sensors_read_config_reg(dev_data->client, &config_reg);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return sprintf(buf, "%d\n", (config_reg & 0x40) >> 6);
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_show_battery_low);
|
||||
|
||||
/**
|
||||
* ms_sensors_show_heater() - Show device heater
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @buf: pointer to char buffer to write result
|
||||
*
|
||||
* This function will read heater enable value in the device and
|
||||
* return 1 if the heater is enabled.
|
||||
* This function is used for HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: length of sprintf on success, negative errno otherwise.
|
||||
*/
|
||||
ssize_t ms_sensors_show_heater(struct ms_ht_dev *dev_data,
|
||||
char *buf)
|
||||
{
|
||||
u8 config_reg;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
ret = ms_sensors_read_config_reg(dev_data->client, &config_reg);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return sprintf(buf, "%d\n", (config_reg & 0x4) >> 2);
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_show_heater);
|
||||
|
||||
/**
|
||||
* ms_sensors_write_heater() - Write device heater
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @buf: pointer to char buffer from user space
|
||||
* @len: length of buf
|
||||
*
|
||||
* This function will write 1 or 0 value in the device
|
||||
* to enable or disable heater.
|
||||
* This function is used for HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: length of buffer, negative errno otherwise.
|
||||
*/
|
||||
ssize_t ms_sensors_write_heater(struct ms_ht_dev *dev_data,
|
||||
const char *buf, size_t len)
|
||||
{
|
||||
u8 val, config_reg;
|
||||
int ret;
|
||||
|
||||
ret = kstrtou8(buf, 10, &val);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (val > 1)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
ret = ms_sensors_read_config_reg(dev_data->client, &config_reg);
|
||||
if (ret) {
|
||||
mutex_unlock(&dev_data->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
config_reg &= 0xFB;
|
||||
config_reg |= val << 2;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(dev_data->client,
|
||||
MS_SENSORS_CONFIG_REG_WRITE,
|
||||
config_reg);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret) {
|
||||
dev_err(&dev_data->client->dev, "Unable to write config register\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return len;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_write_heater);
|
||||
|
||||
/**
|
||||
* ms_sensors_ht_read_temperature() - Read temperature
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @temperature:pointer to temperature destination value
|
||||
*
|
||||
* This function will get temperature ADC value from the device,
|
||||
* check the CRC and compute the temperature value.
|
||||
* This function is used for TSYS02D, HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_ht_read_temperature(struct ms_ht_dev *dev_data,
|
||||
s32 *temperature)
|
||||
{
|
||||
int ret;
|
||||
u32 adc;
|
||||
u16 delay;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
delay = ms_sensors_ht_t_conversion_time[dev_data->res_index];
|
||||
ret = ms_sensors_convert_and_read(dev_data->client,
|
||||
MS_SENSORS_HT_T_CONVERSION_START,
|
||||
MS_SENSORS_NO_READ_CMD,
|
||||
delay, &adc);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (!ms_sensors_crc_valid(adc)) {
|
||||
dev_err(&dev_data->client->dev,
|
||||
"Temperature read crc check error\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* Temperature algorithm */
|
||||
*temperature = (((s64)(adc >> 8) * 175720) >> 16) - 46850;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_ht_read_temperature);
|
||||
|
||||
/**
|
||||
* ms_sensors_ht_read_humidity() - Read humidity
|
||||
* @dev_data: pointer to temperature/humidity device data
|
||||
* @humidity: pointer to humidity destination value
|
||||
*
|
||||
* This function will get humidity ADC value from the device,
|
||||
* check the CRC and compute the temperature value.
|
||||
* This function is used for HTU21 and MS8607 chipsets.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_ht_read_humidity(struct ms_ht_dev *dev_data,
|
||||
u32 *humidity)
|
||||
{
|
||||
int ret;
|
||||
u32 adc;
|
||||
u16 delay;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
delay = ms_sensors_ht_h_conversion_time[dev_data->res_index];
|
||||
ret = ms_sensors_convert_and_read(dev_data->client,
|
||||
MS_SENSORS_HT_H_CONVERSION_START,
|
||||
MS_SENSORS_NO_READ_CMD,
|
||||
delay, &adc);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (!ms_sensors_crc_valid(adc)) {
|
||||
dev_err(&dev_data->client->dev,
|
||||
"Humidity read crc check error\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* Humidity algorithm */
|
||||
*humidity = (((s32)(adc >> 8) * 12500) >> 16) * 10 - 6000;
|
||||
if (*humidity >= 100000)
|
||||
*humidity = 100000;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_ht_read_humidity);
|
||||
|
||||
/**
|
||||
* ms_sensors_tp_crc_valid() - CRC check function for
|
||||
* Temperature and pressure devices.
|
||||
* This function is only used when reading PROM coefficients
|
||||
*
|
||||
* @prom: pointer to PROM coefficients array
|
||||
* @len: length of PROM coefficients array
|
||||
*
|
||||
* Return: True if CRC is ok.
|
||||
*/
|
||||
static bool ms_sensors_tp_crc_valid(u16 *prom, u8 len)
|
||||
{
|
||||
unsigned int cnt, n_bit;
|
||||
u16 n_rem = 0x0000, crc_read = prom[0], crc = (*prom & 0xF000) >> 12;
|
||||
|
||||
prom[len - 1] = 0;
|
||||
prom[0] &= 0x0FFF; /* Clear the CRC computation part */
|
||||
|
||||
for (cnt = 0; cnt < len * 2; cnt++) {
|
||||
if (cnt % 2 == 1)
|
||||
n_rem ^= prom[cnt >> 1] & 0x00FF;
|
||||
else
|
||||
n_rem ^= prom[cnt >> 1] >> 8;
|
||||
|
||||
for (n_bit = 8; n_bit > 0; n_bit--) {
|
||||
if (n_rem & 0x8000)
|
||||
n_rem = (n_rem << 1) ^ 0x3000;
|
||||
else
|
||||
n_rem <<= 1;
|
||||
}
|
||||
}
|
||||
n_rem >>= 12;
|
||||
prom[0] = crc_read;
|
||||
|
||||
return n_rem == crc;
|
||||
}
|
||||
|
||||
/**
|
||||
* ms_sensors_tp_read_prom() - prom coeff read function
|
||||
* @dev_data: pointer to temperature/pressure device data
|
||||
*
|
||||
* This function will read prom coefficients and check CRC.
|
||||
* This function is used for MS5637 and MS8607 chipsets.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_tp_read_prom(struct ms_tp_dev *dev_data)
|
||||
{
|
||||
int i, ret;
|
||||
|
||||
for (i = 0; i < MS_SENSORS_TP_PROM_WORDS_NB; i++) {
|
||||
ret = ms_sensors_read_prom_word(
|
||||
dev_data->client,
|
||||
MS_SENSORS_TP_PROM_READ + (i << 1),
|
||||
&dev_data->prom[i]);
|
||||
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (!ms_sensors_tp_crc_valid(dev_data->prom,
|
||||
MS_SENSORS_TP_PROM_WORDS_NB + 1)) {
|
||||
dev_err(&dev_data->client->dev,
|
||||
"Calibration coefficients crc check error\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_tp_read_prom);
|
||||
|
||||
/**
|
||||
* ms_sensors_read_temp_and_pressure() - read temp and pressure
|
||||
* @dev_data: pointer to temperature/pressure device data
|
||||
* @temperature:pointer to temperature destination value
|
||||
* @pressure: pointer to pressure destination value
|
||||
*
|
||||
* This function will read ADC and compute pressure and temperature value.
|
||||
* This function is used for MS5637 and MS8607 chipsets.
|
||||
*
|
||||
* Return: 0 on success, negative errno otherwise.
|
||||
*/
|
||||
int ms_sensors_read_temp_and_pressure(struct ms_tp_dev *dev_data,
|
||||
int *temperature,
|
||||
unsigned int *pressure)
|
||||
{
|
||||
int ret;
|
||||
u32 t_adc, p_adc;
|
||||
s32 dt, temp;
|
||||
s64 off, sens, t2, off2, sens2;
|
||||
u16 *prom = dev_data->prom, delay;
|
||||
|
||||
mutex_lock(&dev_data->lock);
|
||||
delay = ms_sensors_tp_conversion_time[dev_data->res_index];
|
||||
|
||||
ret = ms_sensors_convert_and_read(
|
||||
dev_data->client,
|
||||
MS_SENSORS_TP_T_CONVERSION_START +
|
||||
dev_data->res_index * 2,
|
||||
MS_SENSORS_TP_ADC_READ,
|
||||
delay, &t_adc);
|
||||
if (ret) {
|
||||
mutex_unlock(&dev_data->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = ms_sensors_convert_and_read(
|
||||
dev_data->client,
|
||||
MS_SENSORS_TP_P_CONVERSION_START +
|
||||
dev_data->res_index * 2,
|
||||
MS_SENSORS_TP_ADC_READ,
|
||||
delay, &p_adc);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
dt = (s32)t_adc - (prom[5] << 8);
|
||||
|
||||
/* Actual temperature = 2000 + dT * TEMPSENS */
|
||||
temp = 2000 + (((s64)dt * prom[6]) >> 23);
|
||||
|
||||
/* Second order temperature compensation */
|
||||
if (temp < 2000) {
|
||||
s64 tmp = (s64)temp - 2000;
|
||||
|
||||
t2 = (3 * ((s64)dt * (s64)dt)) >> 33;
|
||||
off2 = (61 * tmp * tmp) >> 4;
|
||||
sens2 = (29 * tmp * tmp) >> 4;
|
||||
|
||||
if (temp < -1500) {
|
||||
s64 tmp = (s64)temp + 1500;
|
||||
|
||||
off2 += 17 * tmp * tmp;
|
||||
sens2 += 9 * tmp * tmp;
|
||||
}
|
||||
} else {
|
||||
t2 = (5 * ((s64)dt * (s64)dt)) >> 38;
|
||||
off2 = 0;
|
||||
sens2 = 0;
|
||||
}
|
||||
|
||||
/* OFF = OFF_T1 + TCO * dT */
|
||||
off = (((s64)prom[2]) << 17) + ((((s64)prom[4]) * (s64)dt) >> 6);
|
||||
off -= off2;
|
||||
|
||||
/* Sensitivity at actual temperature = SENS_T1 + TCS * dT */
|
||||
sens = (((s64)prom[1]) << 16) + (((s64)prom[3] * dt) >> 7);
|
||||
sens -= sens2;
|
||||
|
||||
/* Temperature compensated pressure = D1 * SENS - OFF */
|
||||
*temperature = (temp - t2) * 10;
|
||||
*pressure = (u32)(((((s64)p_adc * sens) >> 21) - off) >> 15);
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(ms_sensors_read_temp_and_pressure);
|
||||
|
||||
MODULE_DESCRIPTION("Measurement-Specialties common i2c driver");
|
||||
MODULE_AUTHOR("William Markezana <william.markezana@meas-spec.com>");
|
||||
MODULE_AUTHOR("Ludovic Tancerel <ludovic.tancerel@maplehightech.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
|
66
drivers/iio/common/ms_sensors/ms_sensors_i2c.h
Normal file
66
drivers/iio/common/ms_sensors/ms_sensors_i2c.h
Normal file
|
@ -0,0 +1,66 @@
|
|||
/*
|
||||
* Measurements Specialties common sensor driver
|
||||
*
|
||||
* Copyright (c) 2015 Measurement-Specialties
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#ifndef _MS_SENSORS_I2C_H
|
||||
#define _MS_SENSORS_I2C_H
|
||||
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
#define MS_SENSORS_TP_PROM_WORDS_NB 7
|
||||
|
||||
/**
|
||||
* struct ms_ht_dev - Humidity/Temperature sensor device structure
|
||||
* @client: i2c client
|
||||
* @lock: lock protecting the i2c conversion
|
||||
* @res_index: index to selected sensor resolution
|
||||
*/
|
||||
struct ms_ht_dev {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
u8 res_index;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct ms_tp_dev - Temperature/Pressure sensor device structure
|
||||
* @client: i2c client
|
||||
* @lock: lock protecting the i2c conversion
|
||||
* @prom: array of PROM coefficients used for conversion. Added element
|
||||
* for CRC computation
|
||||
* @res_index: index to selected sensor resolution
|
||||
*/
|
||||
struct ms_tp_dev {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
u16 prom[MS_SENSORS_TP_PROM_WORDS_NB + 1];
|
||||
u8 res_index;
|
||||
};
|
||||
|
||||
int ms_sensors_reset(void *cli, u8 cmd, unsigned int delay);
|
||||
int ms_sensors_read_prom_word(void *cli, int cmd, u16 *word);
|
||||
int ms_sensors_convert_and_read(void *cli, u8 conv, u8 rd,
|
||||
unsigned int delay, u32 *adc);
|
||||
int ms_sensors_read_serial(struct i2c_client *client, u64 *sn);
|
||||
ssize_t ms_sensors_show_serial(struct ms_ht_dev *dev_data, char *buf);
|
||||
ssize_t ms_sensors_write_resolution(struct ms_ht_dev *dev_data, u8 i);
|
||||
ssize_t ms_sensors_show_battery_low(struct ms_ht_dev *dev_data, char *buf);
|
||||
ssize_t ms_sensors_show_heater(struct ms_ht_dev *dev_data, char *buf);
|
||||
ssize_t ms_sensors_write_heater(struct ms_ht_dev *dev_data,
|
||||
const char *buf, size_t len);
|
||||
int ms_sensors_ht_read_temperature(struct ms_ht_dev *dev_data,
|
||||
s32 *temperature);
|
||||
int ms_sensors_ht_read_humidity(struct ms_ht_dev *dev_data,
|
||||
u32 *humidity);
|
||||
int ms_sensors_tp_read_prom(struct ms_tp_dev *dev_data);
|
||||
int ms_sensors_read_temp_and_pressure(struct ms_tp_dev *dev_data,
|
||||
int *temperature,
|
||||
unsigned int *pressure);
|
||||
|
||||
#endif /* _MS_SENSORS_I2C_H */
|
|
@ -44,6 +44,28 @@ st_sensors_write_data_with_mask_error:
|
|||
return err;
|
||||
}
|
||||
|
||||
int st_sensors_debugfs_reg_access(struct iio_dev *indio_dev,
|
||||
unsigned reg, unsigned writeval,
|
||||
unsigned *readval)
|
||||
{
|
||||
struct st_sensor_data *sdata = iio_priv(indio_dev);
|
||||
u8 readdata;
|
||||
int err;
|
||||
|
||||
if (!readval)
|
||||
return sdata->tf->write_byte(&sdata->tb, sdata->dev,
|
||||
(u8)reg, (u8)writeval);
|
||||
|
||||
err = sdata->tf->read_byte(&sdata->tb, sdata->dev, (u8)reg, &readdata);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
*readval = (unsigned)readdata;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(st_sensors_debugfs_reg_access);
|
||||
|
||||
static int st_sensors_match_odr(struct st_sensor_settings *sensor_settings,
|
||||
unsigned int odr, struct st_sensor_odr_avl *odr_out)
|
||||
{
|
||||
|
|
|
@ -214,7 +214,6 @@ static struct attribute *ad5504_ev_attributes[] = {
|
|||
|
||||
static struct attribute_group ad5504_ev_attribute_group = {
|
||||
.attrs = ad5504_ev_attributes,
|
||||
.name = "events",
|
||||
};
|
||||
|
||||
static irqreturn_t ad5504_event_handler(int irq, void *private)
|
||||
|
|
|
@ -281,6 +281,12 @@ static int ad7303_remove(struct spi_device *spi)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id ad7303_spi_of_match[] = {
|
||||
{ .compatible = "adi,ad7303", },
|
||||
{ /* sentinel */ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, ad7303_spi_of_match);
|
||||
|
||||
static const struct spi_device_id ad7303_spi_ids[] = {
|
||||
{ "ad7303", 0 },
|
||||
{}
|
||||
|
@ -290,6 +296,7 @@ MODULE_DEVICE_TABLE(spi, ad7303_spi_ids);
|
|||
static struct spi_driver ad7303_driver = {
|
||||
.driver = {
|
||||
.name = "ad7303",
|
||||
.of_match_table = of_match_ptr(ad7303_spi_of_match),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = ad7303_probe,
|
||||
|
|
|
@ -31,7 +31,6 @@
|
|||
|
||||
struct m62332_data {
|
||||
struct i2c_client *client;
|
||||
u16 vref_mv;
|
||||
struct regulator *vcc;
|
||||
struct mutex mutex;
|
||||
u8 raw[M62332_CHANNELS];
|
||||
|
@ -40,8 +39,7 @@ struct m62332_data {
|
|||
#endif
|
||||
};
|
||||
|
||||
static int m62332_set_value(struct iio_dev *indio_dev,
|
||||
u8 val, int channel)
|
||||
static int m62332_set_value(struct iio_dev *indio_dev, u8 val, int channel)
|
||||
{
|
||||
struct m62332_data *data = iio_priv(indio_dev);
|
||||
struct i2c_client *client = data->client;
|
||||
|
@ -62,8 +60,8 @@ static int m62332_set_value(struct iio_dev *indio_dev,
|
|||
goto out;
|
||||
}
|
||||
|
||||
res = i2c_master_send(client, outbuf, 2);
|
||||
if (res >= 0 && res != 2)
|
||||
res = i2c_master_send(client, outbuf, ARRAY_SIZE(outbuf));
|
||||
if (res >= 0 && res != ARRAY_SIZE(outbuf))
|
||||
res = -EIO;
|
||||
if (res < 0)
|
||||
goto out;
|
||||
|
@ -87,46 +85,52 @@ static int m62332_read_raw(struct iio_dev *indio_dev,
|
|||
struct iio_chan_spec const *chan,
|
||||
int *val,
|
||||
int *val2,
|
||||
long m)
|
||||
long mask)
|
||||
{
|
||||
struct m62332_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
switch (m) {
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
/* Corresponds to Vref / 2^(bits) */
|
||||
*val = data->vref_mv;
|
||||
ret = regulator_get_voltage(data->vcc);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = ret / 1000; /* mV */
|
||||
*val2 = 8;
|
||||
|
||||
return IIO_VAL_FRACTIONAL_LOG2;
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
*val = data->raw[chan->channel];
|
||||
|
||||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_OFFSET:
|
||||
*val = 1;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int m62332_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int val, int val2, long mask)
|
||||
struct iio_chan_spec const *chan, int val, int val2,
|
||||
long mask)
|
||||
{
|
||||
int ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
if (val < 0 || val > 255)
|
||||
return -EINVAL;
|
||||
|
||||
ret = m62332_set_value(indio_dev, val, chan->channel);
|
||||
break;
|
||||
return m62332_set_value(indio_dev, val, chan->channel);
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
return ret;
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM_SLEEP
|
||||
|
@ -179,8 +183,8 @@ static const struct iio_info m62332_info = {
|
|||
.output = 1, \
|
||||
.channel = (chan), \
|
||||
.datasheet_name = "CH" #chan, \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||||
BIT(IIO_CHAN_INFO_SCALE) | \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
|
||||
BIT(IIO_CHAN_INFO_OFFSET), \
|
||||
}
|
||||
|
||||
|
@ -199,6 +203,7 @@ static int m62332_probe(struct i2c_client *client,
|
|||
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;
|
||||
|
@ -212,16 +217,11 @@ static int m62332_probe(struct i2c_client *client,
|
|||
/* establish that the iio_dev is a child of the i2c device */
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
|
||||
indio_dev->num_channels = M62332_CHANNELS;
|
||||
indio_dev->num_channels = ARRAY_SIZE(m62332_channels);
|
||||
indio_dev->channels = m62332_channels;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &m62332_info;
|
||||
|
||||
ret = regulator_get_voltage(data->vcc);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
data->vref_mv = ret / 1000; /* mV */
|
||||
|
||||
ret = iio_map_array_register(indio_dev, client->dev.platform_data);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
@ -234,6 +234,7 @@ static int m62332_probe(struct i2c_client *client,
|
|||
|
||||
err:
|
||||
iio_map_array_unregister(indio_dev);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -243,6 +244,8 @@ static int m62332_remove(struct i2c_client *client)
|
|||
|
||||
iio_device_unregister(indio_dev);
|
||||
iio_map_array_unregister(indio_dev);
|
||||
m62332_set_value(indio_dev, 0, 0);
|
||||
m62332_set_value(indio_dev, 0, 1);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
|
@ -387,6 +387,7 @@ static const struct of_device_id max5821_of_match[] = {
|
|||
{ .compatible = "maxim,max5821" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, max5821_of_match);
|
||||
|
||||
static struct i2c_driver max5821_driver = {
|
||||
.driver = {
|
||||
|
|
|
@ -616,15 +616,24 @@ static int adf4350_remove(struct spi_device *spi)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id adf4350_of_match[] = {
|
||||
{ .compatible = "adi,adf4350", },
|
||||
{ .compatible = "adi,adf4351", },
|
||||
{ /* sentinel */ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, adf4350_of_match);
|
||||
|
||||
static const struct spi_device_id adf4350_id[] = {
|
||||
{"adf4350", 4350},
|
||||
{"adf4351", 4351},
|
||||
{}
|
||||
};
|
||||
MODULE_DEVICE_TABLE(spi, adf4350_id);
|
||||
|
||||
static struct spi_driver adf4350_driver = {
|
||||
.driver = {
|
||||
.name = "adf4350",
|
||||
.of_match_table = of_match_ptr(adf4350_of_match),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = adf4350_probe,
|
||||
|
|
|
@ -52,15 +52,26 @@ config ADXRS450
|
|||
|
||||
config BMG160
|
||||
tristate "BOSCH BMG160 Gyro Sensor"
|
||||
depends on I2C
|
||||
depends on (I2C || SPI_MASTER)
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
select BMG160_I2C if (I2C)
|
||||
select BMG160_SPI if (SPI)
|
||||
help
|
||||
Say yes here to build support for Bosch BMG160 Tri-axis Gyro Sensor
|
||||
driver. This driver also supports BMI055 gyroscope.
|
||||
Say yes here to build support for BOSCH BMG160 Tri-axis Gyro Sensor
|
||||
driver connected via I2C or SPI. This driver also supports BMI055
|
||||
gyroscope.
|
||||
|
||||
This driver can also be built as a module. If so, the module
|
||||
will be called bmg160.
|
||||
will be called bmg160_i2c or bmg160_spi.
|
||||
|
||||
config BMG160_I2C
|
||||
tristate
|
||||
select REGMAP_I2C
|
||||
|
||||
config BMG160_SPI
|
||||
tristate
|
||||
select REGMAP_SPI
|
||||
|
||||
config HID_SENSOR_GYRO_3D
|
||||
depends on HID_SENSOR_HUB
|
||||
|
|
|
@ -8,7 +8,9 @@ obj-$(CONFIG_ADIS16130) += adis16130.o
|
|||
obj-$(CONFIG_ADIS16136) += adis16136.o
|
||||
obj-$(CONFIG_ADIS16260) += adis16260.o
|
||||
obj-$(CONFIG_ADXRS450) += adxrs450.o
|
||||
obj-$(CONFIG_BMG160) += bmg160.o
|
||||
obj-$(CONFIG_BMG160) += bmg160_core.o
|
||||
obj-$(CONFIG_BMG160_I2C) += bmg160_i2c.o
|
||||
obj-$(CONFIG_BMG160_SPI) += bmg160_spi.o
|
||||
|
||||
obj-$(CONFIG_HID_SENSOR_GYRO_3D) += hid-sensor-gyro-3d.o
|
||||
|
||||
|
|
10
drivers/iio/gyro/bmg160.h
Normal file
10
drivers/iio/gyro/bmg160.h
Normal file
|
@ -0,0 +1,10 @@
|
|||
#ifndef BMG160_H_
|
||||
#define BMG160_H_
|
||||
|
||||
extern const struct dev_pm_ops bmg160_pm_ops;
|
||||
|
||||
int bmg160_core_probe(struct device *dev, struct regmap *regmap, int irq,
|
||||
const char *name);
|
||||
void bmg160_core_remove(struct device *dev);
|
||||
|
||||
#endif /* BMG160_H_ */
|
|
@ -13,7 +13,6 @@
|
|||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/slab.h>
|
||||
|
@ -28,8 +27,9 @@
|
|||
#include <linux/iio/events.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
#include <linux/iio/triggered_buffer.h>
|
||||
#include <linux/regmap.h>
|
||||
#include "bmg160.h"
|
||||
|
||||
#define BMG160_DRV_NAME "bmg160"
|
||||
#define BMG160_IRQ_NAME "bmg160_event"
|
||||
#define BMG160_GPIO_NAME "gpio_int"
|
||||
|
||||
|
@ -97,7 +97,8 @@
|
|||
#define BMG160_AUTO_SUSPEND_DELAY_MS 2000
|
||||
|
||||
struct bmg160_data {
|
||||
struct i2c_client *client;
|
||||
struct device *dev;
|
||||
struct regmap *regmap;
|
||||
struct iio_trigger *dready_trig;
|
||||
struct iio_trigger *motion_trig;
|
||||
struct mutex mutex;
|
||||
|
@ -108,6 +109,7 @@ struct bmg160_data {
|
|||
int slope_thres;
|
||||
bool dready_trigger_on;
|
||||
bool motion_trigger_on;
|
||||
int irq;
|
||||
};
|
||||
|
||||
enum bmg160_axis {
|
||||
|
@ -138,10 +140,9 @@ static int bmg160_set_mode(struct bmg160_data *data, u8 mode)
|
|||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_PMU_LPW, mode);
|
||||
ret = regmap_write(data->regmap, BMG160_REG_PMU_LPW, mode);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_pmu_lpw\n");
|
||||
dev_err(data->dev, "Error writing reg_pmu_lpw\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -169,10 +170,9 @@ static int bmg160_set_bw(struct bmg160_data *data, int val)
|
|||
if (bw_bits < 0)
|
||||
return bw_bits;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, BMG160_REG_PMU_BW,
|
||||
bw_bits);
|
||||
ret = regmap_write(data->regmap, BMG160_REG_PMU_BW, bw_bits);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_pmu_bw\n");
|
||||
dev_err(data->dev, "Error writing reg_pmu_bw\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -184,16 +184,17 @@ static int bmg160_set_bw(struct bmg160_data *data, int val)
|
|||
static int bmg160_chip_init(struct bmg160_data *data)
|
||||
{
|
||||
int ret;
|
||||
unsigned int val;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_CHIP_ID);
|
||||
ret = regmap_read(data->regmap, BMG160_REG_CHIP_ID, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_chip_id\n");
|
||||
dev_err(data->dev, "Error reading reg_chip_id\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_dbg(&data->client->dev, "Chip Id %x\n", ret);
|
||||
if (ret != BMG160_CHIP_ID_VAL) {
|
||||
dev_err(&data->client->dev, "invalid chip %x\n", ret);
|
||||
dev_dbg(data->dev, "Chip Id %x\n", val);
|
||||
if (val != BMG160_CHIP_ID_VAL) {
|
||||
dev_err(data->dev, "invalid chip %x\n", val);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
|
@ -210,42 +211,33 @@ static int bmg160_chip_init(struct bmg160_data *data)
|
|||
return ret;
|
||||
|
||||
/* Set Default Range */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_RANGE,
|
||||
BMG160_RANGE_500DPS);
|
||||
ret = regmap_write(data->regmap, BMG160_REG_RANGE, BMG160_RANGE_500DPS);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_range\n");
|
||||
dev_err(data->dev, "Error writing reg_range\n");
|
||||
return ret;
|
||||
}
|
||||
data->dps_range = BMG160_RANGE_500DPS;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_SLOPE_THRES);
|
||||
ret = regmap_read(data->regmap, BMG160_REG_SLOPE_THRES, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_slope_thres\n");
|
||||
dev_err(data->dev, "Error reading reg_slope_thres\n");
|
||||
return ret;
|
||||
}
|
||||
data->slope_thres = ret;
|
||||
data->slope_thres = val;
|
||||
|
||||
/* Set default interrupt mode */
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_INT_EN_1);
|
||||
ret = regmap_update_bits(data->regmap, BMG160_REG_INT_EN_1,
|
||||
BMG160_INT1_BIT_OD, 0);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_en_1\n");
|
||||
return ret;
|
||||
}
|
||||
ret &= ~BMG160_INT1_BIT_OD;
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_EN_1, ret);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_en_1\n");
|
||||
dev_err(data->dev, "Error updating bits in reg_int_en_1\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_motion_intr\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -259,17 +251,17 @@ static int bmg160_set_power_state(struct bmg160_data *data, bool on)
|
|||
int ret;
|
||||
|
||||
if (on)
|
||||
ret = pm_runtime_get_sync(&data->client->dev);
|
||||
ret = pm_runtime_get_sync(data->dev);
|
||||
else {
|
||||
pm_runtime_mark_last_busy(&data->client->dev);
|
||||
ret = pm_runtime_put_autosuspend(&data->client->dev);
|
||||
pm_runtime_mark_last_busy(data->dev);
|
||||
ret = pm_runtime_put_autosuspend(data->dev);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Failed: bmg160_set_power_state for %d\n", on);
|
||||
if (on)
|
||||
pm_runtime_put_noidle(&data->client->dev);
|
||||
pm_runtime_put_noidle(data->dev);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
@ -284,43 +276,30 @@ static int bmg160_setup_any_motion_interrupt(struct bmg160_data *data,
|
|||
int ret;
|
||||
|
||||
/* Enable/Disable INT_MAP0 mapping */
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_INT_MAP_0);
|
||||
ret = regmap_update_bits(data->regmap, BMG160_REG_INT_MAP_0,
|
||||
BMG160_INT_MAP_0_BIT_ANY,
|
||||
(status ? BMG160_INT_MAP_0_BIT_ANY : 0));
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_map0\n");
|
||||
return ret;
|
||||
}
|
||||
if (status)
|
||||
ret |= BMG160_INT_MAP_0_BIT_ANY;
|
||||
else
|
||||
ret &= ~BMG160_INT_MAP_0_BIT_ANY;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_MAP_0,
|
||||
ret);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_map0\n");
|
||||
dev_err(data->dev, "Error updating bits reg_int_map0\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Enable/Disable slope interrupts */
|
||||
if (status) {
|
||||
/* Update slope thres */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_SLOPE_THRES,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_SLOPE_THRES,
|
||||
data->slope_thres);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_slope_thres\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_MOTION_INTR,
|
||||
BMG160_INT_MOTION_X |
|
||||
BMG160_INT_MOTION_Y |
|
||||
ret = regmap_write(data->regmap, BMG160_REG_MOTION_INTR,
|
||||
BMG160_INT_MOTION_X | BMG160_INT_MOTION_Y |
|
||||
BMG160_INT_MOTION_Z);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_motion_intr\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -331,28 +310,26 @@ static int bmg160_setup_any_motion_interrupt(struct bmg160_data *data,
|
|||
* to set latched mode, we will be flooded anyway with INTR
|
||||
*/
|
||||
if (!data->dready_trigger_on) {
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
ret = regmap_write(data->regmap,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_EN_0,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_EN_0,
|
||||
BMG160_DATA_ENABLE_INT);
|
||||
|
||||
} else
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_EN_0,
|
||||
0);
|
||||
} else {
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_EN_0, 0);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_en0\n");
|
||||
dev_err(data->dev, "Error writing reg_int_en0\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -365,59 +342,43 @@ static int bmg160_setup_new_data_interrupt(struct bmg160_data *data,
|
|||
int ret;
|
||||
|
||||
/* Enable/Disable INT_MAP1 mapping */
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_INT_MAP_1);
|
||||
ret = regmap_update_bits(data->regmap, BMG160_REG_INT_MAP_1,
|
||||
BMG160_INT_MAP_1_BIT_NEW_DATA,
|
||||
(status ? BMG160_INT_MAP_1_BIT_NEW_DATA : 0));
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_map1\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (status)
|
||||
ret |= BMG160_INT_MAP_1_BIT_NEW_DATA;
|
||||
else
|
||||
ret &= ~BMG160_INT_MAP_1_BIT_NEW_DATA;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_MAP_1,
|
||||
ret);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_map1\n");
|
||||
dev_err(data->dev, "Error updating bits in reg_int_map1\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (status) {
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_NON_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_EN_0,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_EN_0,
|
||||
BMG160_DATA_ENABLE_INT);
|
||||
|
||||
} else {
|
||||
/* Restore interrupt mode */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_EN_0,
|
||||
0);
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_EN_0, 0);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_int_en0\n");
|
||||
dev_err(data->dev, "Error writing reg_int_en0\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -444,12 +405,10 @@ static int bmg160_set_scale(struct bmg160_data *data, int val)
|
|||
|
||||
for (i = 0; i < ARRAY_SIZE(bmg160_scale_table); ++i) {
|
||||
if (bmg160_scale_table[i].scale == val) {
|
||||
ret = i2c_smbus_write_byte_data(
|
||||
data->client,
|
||||
BMG160_REG_RANGE,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_RANGE,
|
||||
bmg160_scale_table[i].dps_range);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_range\n");
|
||||
return ret;
|
||||
}
|
||||
|
@ -464,6 +423,7 @@ static int bmg160_set_scale(struct bmg160_data *data, int val)
|
|||
static int bmg160_get_temp(struct bmg160_data *data, int *val)
|
||||
{
|
||||
int ret;
|
||||
unsigned int raw_val;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
ret = bmg160_set_power_state(data, true);
|
||||
|
@ -472,15 +432,15 @@ static int bmg160_get_temp(struct bmg160_data *data, int *val)
|
|||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_TEMP);
|
||||
ret = regmap_read(data->regmap, BMG160_REG_TEMP, &raw_val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_temp\n");
|
||||
dev_err(data->dev, "Error reading reg_temp\n");
|
||||
bmg160_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
*val = sign_extend32(ret, 7);
|
||||
*val = sign_extend32(raw_val, 7);
|
||||
ret = bmg160_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
if (ret < 0)
|
||||
|
@ -492,6 +452,7 @@ static int bmg160_get_temp(struct bmg160_data *data, int *val)
|
|||
static int bmg160_get_axis(struct bmg160_data *data, int axis, int *val)
|
||||
{
|
||||
int ret;
|
||||
unsigned int raw_val;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
ret = bmg160_set_power_state(data, true);
|
||||
|
@ -500,15 +461,16 @@ static int bmg160_get_axis(struct bmg160_data *data, int axis, int *val)
|
|||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_read_word_data(data->client, BMG160_AXIS_TO_REG(axis));
|
||||
ret = regmap_bulk_read(data->regmap, BMG160_AXIS_TO_REG(axis), &raw_val,
|
||||
2);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading axis %d\n", axis);
|
||||
dev_err(data->dev, "Error reading axis %d\n", axis);
|
||||
bmg160_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
*val = sign_extend32(ret, 15);
|
||||
*val = sign_extend32(raw_val, 15);
|
||||
ret = bmg160_set_power_state(data, false);
|
||||
mutex_unlock(&data->mutex);
|
||||
if (ret < 0)
|
||||
|
@ -807,12 +769,13 @@ static irqreturn_t bmg160_trigger_handler(int irq, void *p)
|
|||
struct iio_dev *indio_dev = pf->indio_dev;
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
int bit, ret, i = 0;
|
||||
unsigned int val;
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
for_each_set_bit(bit, indio_dev->active_scan_mask,
|
||||
indio_dev->masklength) {
|
||||
ret = i2c_smbus_read_word_data(data->client,
|
||||
BMG160_AXIS_TO_REG(bit));
|
||||
ret = regmap_bulk_read(data->regmap, BMG160_AXIS_TO_REG(bit),
|
||||
&val, 2);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&data->mutex);
|
||||
goto err;
|
||||
|
@ -840,12 +803,11 @@ static int bmg160_trig_try_reen(struct iio_trigger *trig)
|
|||
return 0;
|
||||
|
||||
/* Set latched mode interrupt and clear any latched interrupt */
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error writing reg_rst_latch\n");
|
||||
dev_err(data->dev, "Error writing reg_rst_latch\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -907,33 +869,34 @@ static irqreturn_t bmg160_event_handler(int irq, void *private)
|
|||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
int dir;
|
||||
unsigned int val;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, BMG160_REG_INT_STATUS_2);
|
||||
ret = regmap_read(data->regmap, BMG160_REG_INT_STATUS_2, &val);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "Error reading reg_int_status2\n");
|
||||
dev_err(data->dev, "Error reading reg_int_status2\n");
|
||||
goto ack_intr_status;
|
||||
}
|
||||
|
||||
if (ret & 0x08)
|
||||
if (val & 0x08)
|
||||
dir = IIO_EV_DIR_RISING;
|
||||
else
|
||||
dir = IIO_EV_DIR_FALLING;
|
||||
|
||||
if (ret & BMG160_ANY_MOTION_BIT_X)
|
||||
if (val & BMG160_ANY_MOTION_BIT_X)
|
||||
iio_push_event(indio_dev, IIO_MOD_EVENT_CODE(IIO_ANGL_VEL,
|
||||
0,
|
||||
IIO_MOD_X,
|
||||
IIO_EV_TYPE_ROC,
|
||||
dir),
|
||||
iio_get_time_ns());
|
||||
if (ret & BMG160_ANY_MOTION_BIT_Y)
|
||||
if (val & BMG160_ANY_MOTION_BIT_Y)
|
||||
iio_push_event(indio_dev, IIO_MOD_EVENT_CODE(IIO_ANGL_VEL,
|
||||
0,
|
||||
IIO_MOD_Y,
|
||||
IIO_EV_TYPE_ROC,
|
||||
dir),
|
||||
iio_get_time_ns());
|
||||
if (ret & BMG160_ANY_MOTION_BIT_Z)
|
||||
if (val & BMG160_ANY_MOTION_BIT_Z)
|
||||
iio_push_event(indio_dev, IIO_MOD_EVENT_CODE(IIO_ANGL_VEL,
|
||||
0,
|
||||
IIO_MOD_Z,
|
||||
|
@ -943,12 +906,11 @@ static irqreturn_t bmg160_event_handler(int irq, void *private)
|
|||
|
||||
ack_intr_status:
|
||||
if (!data->dready_trigger_on) {
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
BMG160_REG_INT_RST_LATCH,
|
||||
ret = regmap_write(data->regmap, BMG160_REG_INT_RST_LATCH,
|
||||
BMG160_INT_MODE_LATCH_INT |
|
||||
BMG160_INT_MODE_LATCH_RESET);
|
||||
if (ret < 0)
|
||||
dev_err(&data->client->dev,
|
||||
dev_err(data->dev,
|
||||
"Error writing reg_rst_latch\n");
|
||||
}
|
||||
|
||||
|
@ -993,18 +955,13 @@ static const struct iio_buffer_setup_ops bmg160_buffer_setup_ops = {
|
|||
.postdisable = bmg160_buffer_postdisable,
|
||||
};
|
||||
|
||||
static int bmg160_gpio_probe(struct i2c_client *client,
|
||||
struct bmg160_data *data)
|
||||
static int bmg160_gpio_probe(struct bmg160_data *data)
|
||||
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
dev = data->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, BMG160_GPIO_NAME, 0, GPIOD_IN);
|
||||
|
@ -1013,11 +970,12 @@ static int bmg160_gpio_probe(struct i2c_client *client,
|
|||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
data->irq = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio),
|
||||
data->irq);
|
||||
|
||||
return ret;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const char *bmg160_match_acpi_device(struct device *dev)
|
||||
|
@ -1031,21 +989,22 @@ static const char *bmg160_match_acpi_device(struct device *dev)
|
|||
return dev_name(dev);
|
||||
}
|
||||
|
||||
static int bmg160_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
int bmg160_core_probe(struct device *dev, struct regmap *regmap, int irq,
|
||||
const char *name)
|
||||
{
|
||||
struct bmg160_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
int ret;
|
||||
const char *name = NULL;
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||||
indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
data = iio_priv(indio_dev);
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
data->client = client;
|
||||
dev_set_drvdata(dev, indio_dev);
|
||||
data->dev = dev;
|
||||
data->irq = irq;
|
||||
data->regmap = regmap;
|
||||
|
||||
ret = bmg160_chip_init(data);
|
||||
if (ret < 0)
|
||||
|
@ -1053,25 +1012,22 @@ static int bmg160_probe(struct i2c_client *client,
|
|||
|
||||
mutex_init(&data->mutex);
|
||||
|
||||
if (id)
|
||||
name = id->name;
|
||||
if (ACPI_HANDLE(dev))
|
||||
name = bmg160_match_acpi_device(dev);
|
||||
|
||||
if (ACPI_HANDLE(&client->dev))
|
||||
name = bmg160_match_acpi_device(&client->dev);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->dev.parent = dev;
|
||||
indio_dev->channels = bmg160_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(bmg160_channels);
|
||||
indio_dev->name = name;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &bmg160_info;
|
||||
|
||||
if (client->irq <= 0)
|
||||
client->irq = bmg160_gpio_probe(client, data);
|
||||
if (data->irq <= 0)
|
||||
bmg160_gpio_probe(data);
|
||||
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev,
|
||||
client->irq,
|
||||
if (data->irq > 0) {
|
||||
ret = devm_request_threaded_irq(dev,
|
||||
data->irq,
|
||||
bmg160_data_rdy_trig_poll,
|
||||
bmg160_event_handler,
|
||||
IRQF_TRIGGER_RISING,
|
||||
|
@ -1080,28 +1036,28 @@ static int bmg160_probe(struct i2c_client *client,
|
|||
if (ret)
|
||||
return ret;
|
||||
|
||||
data->dready_trig = devm_iio_trigger_alloc(&client->dev,
|
||||
data->dready_trig = devm_iio_trigger_alloc(dev,
|
||||
"%s-dev%d",
|
||||
indio_dev->name,
|
||||
indio_dev->id);
|
||||
if (!data->dready_trig)
|
||||
return -ENOMEM;
|
||||
|
||||
data->motion_trig = devm_iio_trigger_alloc(&client->dev,
|
||||
data->motion_trig = devm_iio_trigger_alloc(dev,
|
||||
"%s-any-motion-dev%d",
|
||||
indio_dev->name,
|
||||
indio_dev->id);
|
||||
if (!data->motion_trig)
|
||||
return -ENOMEM;
|
||||
|
||||
data->dready_trig->dev.parent = &client->dev;
|
||||
data->dready_trig->dev.parent = dev;
|
||||
data->dready_trig->ops = &bmg160_trigger_ops;
|
||||
iio_trigger_set_drvdata(data->dready_trig, indio_dev);
|
||||
ret = iio_trigger_register(data->dready_trig);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
data->motion_trig->dev.parent = &client->dev;
|
||||
data->motion_trig->dev.parent = dev;
|
||||
data->motion_trig->ops = &bmg160_trigger_ops;
|
||||
iio_trigger_set_drvdata(data->motion_trig, indio_dev);
|
||||
ret = iio_trigger_register(data->motion_trig);
|
||||
|
@ -1116,25 +1072,25 @@ static int bmg160_probe(struct i2c_client *client,
|
|||
bmg160_trigger_handler,
|
||||
&bmg160_buffer_setup_ops);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev,
|
||||
dev_err(dev,
|
||||
"iio triggered buffer setup failed\n");
|
||||
goto err_trigger_unregister;
|
||||
}
|
||||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "unable to register iio device\n");
|
||||
dev_err(dev, "unable to register iio device\n");
|
||||
goto err_buffer_cleanup;
|
||||
}
|
||||
|
||||
ret = pm_runtime_set_active(&client->dev);
|
||||
ret = pm_runtime_set_active(dev);
|
||||
if (ret)
|
||||
goto err_iio_unregister;
|
||||
|
||||
pm_runtime_enable(&client->dev);
|
||||
pm_runtime_set_autosuspend_delay(&client->dev,
|
||||
pm_runtime_enable(dev);
|
||||
pm_runtime_set_autosuspend_delay(dev,
|
||||
BMG160_AUTO_SUSPEND_DELAY_MS);
|
||||
pm_runtime_use_autosuspend(&client->dev);
|
||||
pm_runtime_use_autosuspend(dev);
|
||||
|
||||
return 0;
|
||||
|
||||
|
@ -1150,15 +1106,16 @@ err_trigger_unregister:
|
|||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(bmg160_core_probe);
|
||||
|
||||
static int bmg160_remove(struct i2c_client *client)
|
||||
void bmg160_core_remove(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
|
||||
pm_runtime_disable(&client->dev);
|
||||
pm_runtime_set_suspended(&client->dev);
|
||||
pm_runtime_put_noidle(&client->dev);
|
||||
pm_runtime_disable(dev);
|
||||
pm_runtime_set_suspended(dev);
|
||||
pm_runtime_put_noidle(dev);
|
||||
|
||||
iio_device_unregister(indio_dev);
|
||||
iio_triggered_buffer_cleanup(indio_dev);
|
||||
|
@ -1171,14 +1128,13 @@ static int bmg160_remove(struct i2c_client *client)
|
|||
mutex_lock(&data->mutex);
|
||||
bmg160_set_mode(data, BMG160_MODE_DEEP_SUSPEND);
|
||||
mutex_unlock(&data->mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(bmg160_core_remove);
|
||||
|
||||
#ifdef CONFIG_PM_SLEEP
|
||||
static int bmg160_suspend(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
|
@ -1190,7 +1146,7 @@ static int bmg160_suspend(struct device *dev)
|
|||
|
||||
static int bmg160_resume(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
|
||||
mutex_lock(&data->mutex);
|
||||
|
@ -1206,13 +1162,13 @@ static int bmg160_resume(struct device *dev)
|
|||
#ifdef CONFIG_PM
|
||||
static int bmg160_runtime_suspend(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
ret = bmg160_set_mode(data, BMG160_MODE_SUSPEND);
|
||||
if (ret < 0) {
|
||||
dev_err(&data->client->dev, "set mode failed\n");
|
||||
dev_err(data->dev, "set mode failed\n");
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
|
@ -1221,7 +1177,7 @@ static int bmg160_runtime_suspend(struct device *dev)
|
|||
|
||||
static int bmg160_runtime_resume(struct device *dev)
|
||||
{
|
||||
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||||
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
||||
struct bmg160_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
|
@ -1235,39 +1191,12 @@ static int bmg160_runtime_resume(struct device *dev)
|
|||
}
|
||||
#endif
|
||||
|
||||
static const struct dev_pm_ops bmg160_pm_ops = {
|
||||
const struct dev_pm_ops bmg160_pm_ops = {
|
||||
SET_SYSTEM_SLEEP_PM_OPS(bmg160_suspend, bmg160_resume)
|
||||
SET_RUNTIME_PM_OPS(bmg160_runtime_suspend,
|
||||
bmg160_runtime_resume, NULL)
|
||||
};
|
||||
|
||||
static const struct acpi_device_id bmg160_acpi_match[] = {
|
||||
{"BMG0160", 0},
|
||||
{"BMI055B", 0},
|
||||
{},
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(acpi, bmg160_acpi_match);
|
||||
|
||||
static const struct i2c_device_id bmg160_id[] = {
|
||||
{"bmg160", 0},
|
||||
{"bmi055_gyro", 0},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, bmg160_id);
|
||||
|
||||
static struct i2c_driver bmg160_driver = {
|
||||
.driver = {
|
||||
.name = BMG160_DRV_NAME,
|
||||
.acpi_match_table = ACPI_PTR(bmg160_acpi_match),
|
||||
.pm = &bmg160_pm_ops,
|
||||
},
|
||||
.probe = bmg160_probe,
|
||||
.remove = bmg160_remove,
|
||||
.id_table = bmg160_id,
|
||||
};
|
||||
module_i2c_driver(bmg160_driver);
|
||||
EXPORT_SYMBOL_GPL(bmg160_pm_ops);
|
||||
|
||||
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
71
drivers/iio/gyro/bmg160_i2c.c
Normal file
71
drivers/iio/gyro/bmg160_i2c.c
Normal file
|
@ -0,0 +1,71 @@
|
|||
#include <linux/i2c.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/acpi.h>
|
||||
|
||||
#include "bmg160.h"
|
||||
|
||||
static const struct regmap_config bmg160_regmap_i2c_conf = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
.max_register = 0x3f
|
||||
};
|
||||
|
||||
static int bmg160_i2c_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct regmap *regmap;
|
||||
const char *name = NULL;
|
||||
|
||||
regmap = devm_regmap_init_i2c(client, &bmg160_regmap_i2c_conf);
|
||||
if (IS_ERR(regmap)) {
|
||||
dev_err(&client->dev, "Failed to register i2c regmap %d\n",
|
||||
(int)PTR_ERR(regmap));
|
||||
return PTR_ERR(regmap);
|
||||
}
|
||||
|
||||
if (id)
|
||||
name = id->name;
|
||||
|
||||
return bmg160_core_probe(&client->dev, regmap, client->irq, name);
|
||||
}
|
||||
|
||||
static int bmg160_i2c_remove(struct i2c_client *client)
|
||||
{
|
||||
bmg160_core_remove(&client->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct acpi_device_id bmg160_acpi_match[] = {
|
||||
{"BMG0160", 0},
|
||||
{"BMI055B", 0},
|
||||
{},
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(acpi, bmg160_acpi_match);
|
||||
|
||||
static const struct i2c_device_id bmg160_i2c_id[] = {
|
||||
{"bmg160", 0},
|
||||
{"bmi055_gyro", 0},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, bmg160_i2c_id);
|
||||
|
||||
static struct i2c_driver bmg160_i2c_driver = {
|
||||
.driver = {
|
||||
.name = "bmg160_i2c",
|
||||
.acpi_match_table = ACPI_PTR(bmg160_acpi_match),
|
||||
.pm = &bmg160_pm_ops,
|
||||
},
|
||||
.probe = bmg160_i2c_probe,
|
||||
.remove = bmg160_i2c_remove,
|
||||
.id_table = bmg160_i2c_id,
|
||||
};
|
||||
module_i2c_driver(bmg160_i2c_driver);
|
||||
|
||||
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("BMG160 I2C Gyro driver");
|
57
drivers/iio/gyro/bmg160_spi.c
Normal file
57
drivers/iio/gyro/bmg160_spi.c
Normal file
|
@ -0,0 +1,57 @@
|
|||
#include <linux/spi/spi.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
#include "bmg160.h"
|
||||
|
||||
static const struct regmap_config bmg160_regmap_spi_conf = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
.max_register = 0x3f,
|
||||
};
|
||||
|
||||
static int bmg160_spi_probe(struct spi_device *spi)
|
||||
{
|
||||
struct regmap *regmap;
|
||||
const struct spi_device_id *id = spi_get_device_id(spi);
|
||||
|
||||
regmap = devm_regmap_init_spi(spi, &bmg160_regmap_spi_conf);
|
||||
if (IS_ERR(regmap)) {
|
||||
dev_err(&spi->dev, "Failed to register spi regmap %d\n",
|
||||
(int)PTR_ERR(regmap));
|
||||
return PTR_ERR(regmap);
|
||||
}
|
||||
|
||||
return bmg160_core_probe(&spi->dev, regmap, spi->irq, id->name);
|
||||
}
|
||||
|
||||
static int bmg160_spi_remove(struct spi_device *spi)
|
||||
{
|
||||
bmg160_core_remove(&spi->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct spi_device_id bmg160_spi_id[] = {
|
||||
{"bmg160", 0},
|
||||
{"bmi055_gyro", 0},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(spi, bmg160_spi_id);
|
||||
|
||||
static struct spi_driver bmg160_spi_driver = {
|
||||
.driver = {
|
||||
.name = "bmg160_spi",
|
||||
.pm = &bmg160_pm_ops,
|
||||
},
|
||||
.probe = bmg160_spi_probe,
|
||||
.remove = bmg160_spi_remove,
|
||||
.id_table = bmg160_spi_id,
|
||||
};
|
||||
module_spi_driver(bmg160_spi_driver);
|
||||
|
||||
MODULE_AUTHOR("Markus Pargmann <mpa@pengutronix.de>");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("BMG160 SPI Gyro driver");
|
|
@ -383,6 +383,7 @@ static const struct iio_info gyro_info = {
|
|||
.attrs = &st_gyro_attribute_group,
|
||||
.read_raw = &st_gyro_read_raw,
|
||||
.write_raw = &st_gyro_write_raw,
|
||||
.debugfs_reg_access = &st_sensors_debugfs_reg_access,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_IIO_TRIGGER
|
||||
|
|
|
@ -12,6 +12,29 @@ config DHT11
|
|||
Other sensors should work as well as long as they speak the
|
||||
same protocol.
|
||||
|
||||
config HDC100X
|
||||
tristate "TI HDC100x relative humidity and temperature sensor"
|
||||
depends on I2C
|
||||
help
|
||||
Say yes here to build support for the TI HDC100x series of
|
||||
relative humidity and temperature sensors.
|
||||
|
||||
To compile this driver as a module, choose M here: the module
|
||||
will be called hdc100x.
|
||||
|
||||
config HTU21
|
||||
tristate "Measurement Specialties HTU21 humidity & temperature sensor"
|
||||
depends on I2C
|
||||
select IIO_MS_SENSORS_I2C
|
||||
help
|
||||
If you say yes here you get support for the Measurement Specialties
|
||||
HTU21 humidity and temperature sensor.
|
||||
This driver is also used for MS8607 temperature, pressure & humidity
|
||||
sensor
|
||||
|
||||
This driver can also be built as a module. If so, the module will
|
||||
be called htu21.
|
||||
|
||||
config SI7005
|
||||
tristate "SI7005 relative humidity and temperature sensor"
|
||||
depends on I2C
|
||||
|
|
|
@ -3,5 +3,7 @@
|
|||
#
|
||||
|
||||
obj-$(CONFIG_DHT11) += dht11.o
|
||||
obj-$(CONFIG_HDC100X) += hdc100x.o
|
||||
obj-$(CONFIG_HTU21) += htu21.o
|
||||
obj-$(CONFIG_SI7005) += si7005.o
|
||||
obj-$(CONFIG_SI7020) += si7020.o
|
||||
|
|
320
drivers/iio/humidity/hdc100x.c
Normal file
320
drivers/iio/humidity/hdc100x.c
Normal file
|
@ -0,0 +1,320 @@
|
|||
/*
|
||||
* hdc100x.c - Support for the TI HDC100x temperature + humidity sensors
|
||||
*
|
||||
* Copyright (C) 2015 Matt Ranostay <mranostay@gmail.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/i2c.h>
|
||||
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
|
||||
#define HDC100X_REG_TEMP 0x00
|
||||
#define HDC100X_REG_HUMIDITY 0x01
|
||||
|
||||
#define HDC100X_REG_CONFIG 0x02
|
||||
#define HDC100X_REG_CONFIG_HEATER_EN BIT(13)
|
||||
|
||||
struct hdc100x_data {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
u16 config;
|
||||
|
||||
/* integration time of the sensor */
|
||||
int adc_int_us[2];
|
||||
};
|
||||
|
||||
/* integration time in us */
|
||||
static const int hdc100x_int_time[][3] = {
|
||||
{ 6350, 3650, 0 }, /* IIO_TEMP channel*/
|
||||
{ 6500, 3850, 2500 }, /* IIO_HUMIDITYRELATIVE channel */
|
||||
};
|
||||
|
||||
/* HDC100X_REG_CONFIG shift and mask values */
|
||||
static const struct {
|
||||
int shift;
|
||||
int mask;
|
||||
} hdc100x_resolution_shift[2] = {
|
||||
{ /* IIO_TEMP channel */
|
||||
.shift = 10,
|
||||
.mask = 1
|
||||
},
|
||||
{ /* IIO_HUMIDITYRELATIVE channel */
|
||||
.shift = 8,
|
||||
.mask = 2,
|
||||
},
|
||||
};
|
||||
|
||||
static IIO_CONST_ATTR(temp_integration_time_available,
|
||||
"0.00365 0.00635");
|
||||
|
||||
static IIO_CONST_ATTR(humidityrelative_integration_time_available,
|
||||
"0.0025 0.00385 0.0065");
|
||||
|
||||
static IIO_CONST_ATTR(out_current_heater_raw_available,
|
||||
"0 1");
|
||||
|
||||
static struct attribute *hdc100x_attributes[] = {
|
||||
&iio_const_attr_temp_integration_time_available.dev_attr.attr,
|
||||
&iio_const_attr_humidityrelative_integration_time_available.dev_attr.attr,
|
||||
&iio_const_attr_out_current_heater_raw_available.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
static struct attribute_group hdc100x_attribute_group = {
|
||||
.attrs = hdc100x_attributes,
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec hdc100x_channels[] = {
|
||||
{
|
||||
.type = IIO_TEMP,
|
||||
.address = HDC100X_REG_TEMP,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
|
||||
BIT(IIO_CHAN_INFO_SCALE) |
|
||||
BIT(IIO_CHAN_INFO_INT_TIME) |
|
||||
BIT(IIO_CHAN_INFO_OFFSET),
|
||||
},
|
||||
{
|
||||
.type = IIO_HUMIDITYRELATIVE,
|
||||
.address = HDC100X_REG_HUMIDITY,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
|
||||
BIT(IIO_CHAN_INFO_SCALE) |
|
||||
BIT(IIO_CHAN_INFO_INT_TIME)
|
||||
},
|
||||
{
|
||||
.type = IIO_CURRENT,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
||||
.extend_name = "heater",
|
||||
.output = 1,
|
||||
},
|
||||
};
|
||||
|
||||
static int hdc100x_update_config(struct hdc100x_data *data, int mask, int val)
|
||||
{
|
||||
int tmp = (~mask & data->config) | val;
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_word_swapped(data->client,
|
||||
HDC100X_REG_CONFIG, tmp);
|
||||
if (!ret)
|
||||
data->config = tmp;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hdc100x_set_it_time(struct hdc100x_data *data, int chan, int val2)
|
||||
{
|
||||
int shift = hdc100x_resolution_shift[chan].shift;
|
||||
int ret = -EINVAL;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(hdc100x_int_time[chan]); i++) {
|
||||
if (val2 && val2 == hdc100x_int_time[chan][i]) {
|
||||
ret = hdc100x_update_config(data,
|
||||
hdc100x_resolution_shift[chan].mask << shift,
|
||||
i << shift);
|
||||
if (!ret)
|
||||
data->adc_int_us[chan] = val2;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int hdc100x_get_measurement(struct hdc100x_data *data,
|
||||
struct iio_chan_spec const *chan)
|
||||
{
|
||||
struct i2c_client *client = data->client;
|
||||
int delay = data->adc_int_us[chan->address];
|
||||
int ret;
|
||||
int val;
|
||||
|
||||
/* start measurement */
|
||||
ret = i2c_smbus_write_byte(client, chan->address);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "cannot start measurement");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* wait for integration time to pass */
|
||||
usleep_range(delay, delay + 1000);
|
||||
|
||||
/*
|
||||
* i2c_smbus_read_word_data cannot() be used here due to the command
|
||||
* value not being understood and causes NAKs preventing any reading
|
||||
* from being accessed.
|
||||
*/
|
||||
ret = i2c_smbus_read_byte(client);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "cannot read high byte measurement");
|
||||
return ret;
|
||||
}
|
||||
val = ret << 6;
|
||||
|
||||
ret = i2c_smbus_read_byte(client);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "cannot read low byte measurement");
|
||||
return ret;
|
||||
}
|
||||
val |= ret >> 2;
|
||||
|
||||
return val;
|
||||
}
|
||||
|
||||
static int hdc100x_get_heater_status(struct hdc100x_data *data)
|
||||
{
|
||||
return !!(data->config & HDC100X_REG_CONFIG_HEATER_EN);
|
||||
}
|
||||
|
||||
static int hdc100x_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
struct hdc100x_data *data = iio_priv(indio_dev);
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW: {
|
||||
int ret;
|
||||
|
||||
mutex_lock(&data->lock);
|
||||
if (chan->type == IIO_CURRENT) {
|
||||
*val = hdc100x_get_heater_status(data);
|
||||
ret = IIO_VAL_INT;
|
||||
} else {
|
||||
ret = hdc100x_get_measurement(data, chan);
|
||||
if (ret >= 0) {
|
||||
*val = ret;
|
||||
ret = IIO_VAL_INT;
|
||||
}
|
||||
}
|
||||
mutex_unlock(&data->lock);
|
||||
return ret;
|
||||
}
|
||||
case IIO_CHAN_INFO_INT_TIME:
|
||||
*val = 0;
|
||||
*val2 = data->adc_int_us[chan->address];
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (chan->type == IIO_TEMP) {
|
||||
*val = 165;
|
||||
*val2 = 65536 >> 2;
|
||||
return IIO_VAL_FRACTIONAL;
|
||||
} else {
|
||||
*val = 0;
|
||||
*val2 = 10000;
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
}
|
||||
break;
|
||||
case IIO_CHAN_INFO_OFFSET:
|
||||
*val = -3971;
|
||||
*val2 = 879096;
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int hdc100x_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct hdc100x_data *data = iio_priv(indio_dev);
|
||||
int ret = -EINVAL;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_INT_TIME:
|
||||
if (val != 0)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->lock);
|
||||
ret = hdc100x_set_it_time(data, chan->address, val2);
|
||||
mutex_unlock(&data->lock);
|
||||
return ret;
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
if (chan->type != IIO_CURRENT || val2 != 0)
|
||||
return -EINVAL;
|
||||
|
||||
mutex_lock(&data->lock);
|
||||
ret = hdc100x_update_config(data, HDC100X_REG_CONFIG_HEATER_EN,
|
||||
val ? HDC100X_REG_CONFIG_HEATER_EN : 0);
|
||||
mutex_unlock(&data->lock);
|
||||
return ret;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct iio_info hdc100x_info = {
|
||||
.read_raw = hdc100x_read_raw,
|
||||
.write_raw = hdc100x_write_raw,
|
||||
.attrs = &hdc100x_attribute_group,
|
||||
.driver_module = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int hdc100x_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct iio_dev *indio_dev;
|
||||
struct hdc100x_data *data;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_WORD_DATA | I2C_FUNC_SMBUS_BYTE))
|
||||
return -ENODEV;
|
||||
|
||||
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;
|
||||
mutex_init(&data->lock);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->name = dev_name(&client->dev);
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &hdc100x_info;
|
||||
|
||||
indio_dev->channels = hdc100x_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(hdc100x_channels);
|
||||
|
||||
/* be sure we are in a known state */
|
||||
hdc100x_set_it_time(data, 0, hdc100x_int_time[0][0]);
|
||||
hdc100x_set_it_time(data, 1, hdc100x_int_time[1][0]);
|
||||
|
||||
return devm_iio_device_register(&client->dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct i2c_device_id hdc100x_id[] = {
|
||||
{ "hdc100x", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, hdc100x_id);
|
||||
|
||||
static struct i2c_driver hdc100x_driver = {
|
||||
.driver = {
|
||||
.name = "hdc100x",
|
||||
},
|
||||
.probe = hdc100x_probe,
|
||||
.id_table = hdc100x_id,
|
||||
};
|
||||
module_i2c_driver(hdc100x_driver);
|
||||
|
||||
MODULE_AUTHOR("Matt Ranostay <mranostay@gmail.com>");
|
||||
MODULE_DESCRIPTION("TI HDC100x humidity and temperature sensor driver");
|
||||
MODULE_LICENSE("GPL");
|
253
drivers/iio/humidity/htu21.c
Normal file
253
drivers/iio/humidity/htu21.c
Normal file
|
@ -0,0 +1,253 @@
|
|||
/*
|
||||
* htu21.c - Support for Measurement-Specialties
|
||||
* htu21 temperature & humidity sensor
|
||||
* and humidity part of MS8607 sensor
|
||||
*
|
||||
* Copyright (c) 2014 Measurement-Specialties
|
||||
*
|
||||
* Licensed under the GPL-2.
|
||||
*
|
||||
* (7-bit I2C slave address 0x40)
|
||||
*
|
||||
* Datasheet:
|
||||
* http://www.meas-spec.com/downloads/HTU21D.pdf
|
||||
* Datasheet:
|
||||
* http://www.meas-spec.com/downloads/MS8607-02BA01.pdf
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
|
||||
#include "../common/ms_sensors/ms_sensors_i2c.h"
|
||||
|
||||
#define HTU21_RESET 0xFE
|
||||
|
||||
enum {
|
||||
HTU21,
|
||||
MS8607
|
||||
};
|
||||
|
||||
static const int htu21_samp_freq[4] = { 20, 40, 70, 120 };
|
||||
/* String copy of the above const for readability purpose */
|
||||
static const char htu21_show_samp_freq[] = "20 40 70 120";
|
||||
|
||||
static int htu21_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *channel, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
int ret, temperature;
|
||||
unsigned int humidity;
|
||||
struct ms_ht_dev *dev_data = iio_priv(indio_dev);
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_PROCESSED:
|
||||
switch (channel->type) {
|
||||
case IIO_TEMP: /* in milli °C */
|
||||
ret = ms_sensors_ht_read_temperature(dev_data,
|
||||
&temperature);
|
||||
if (ret)
|
||||
return ret;
|
||||
*val = temperature;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
case IIO_HUMIDITYRELATIVE: /* in milli %RH */
|
||||
ret = ms_sensors_ht_read_humidity(dev_data,
|
||||
&humidity);
|
||||
if (ret)
|
||||
return ret;
|
||||
*val = humidity;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||
*val = htu21_samp_freq[dev_data->res_index];
|
||||
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int htu21_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct ms_ht_dev *dev_data = iio_priv(indio_dev);
|
||||
int i, ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||
i = ARRAY_SIZE(htu21_samp_freq);
|
||||
while (i-- > 0)
|
||||
if (val == htu21_samp_freq[i])
|
||||
break;
|
||||
if (i < 0)
|
||||
return -EINVAL;
|
||||
mutex_lock(&dev_data->lock);
|
||||
dev_data->res_index = i;
|
||||
ret = ms_sensors_write_resolution(dev_data, i);
|
||||
mutex_unlock(&dev_data->lock);
|
||||
|
||||
return ret;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec htu21_channels[] = {
|
||||
{
|
||||
.type = IIO_TEMP,
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ),
|
||||
},
|
||||
{
|
||||
.type = IIO_HUMIDITYRELATIVE,
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ),
|
||||
}
|
||||
};
|
||||
|
||||
/*
|
||||
* Meas Spec recommendation is to not read temperature
|
||||
* on this driver part for MS8607
|
||||
*/
|
||||
static const struct iio_chan_spec ms8607_channels[] = {
|
||||
{
|
||||
.type = IIO_HUMIDITYRELATIVE,
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ),
|
||||
}
|
||||
};
|
||||
|
||||
static ssize_t htu21_show_battery_low(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
struct iio_dev *indio_dev = dev_to_iio_dev(dev);
|
||||
struct ms_ht_dev *dev_data = iio_priv(indio_dev);
|
||||
|
||||
return ms_sensors_show_battery_low(dev_data, buf);
|
||||
}
|
||||
|
||||
static ssize_t htu21_show_heater(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
struct iio_dev *indio_dev = dev_to_iio_dev(dev);
|
||||
struct ms_ht_dev *dev_data = iio_priv(indio_dev);
|
||||
|
||||
return ms_sensors_show_heater(dev_data, buf);
|
||||
}
|
||||
|
||||
static ssize_t htu21_write_heater(struct device *dev,
|
||||
struct device_attribute *attr,
|
||||
const char *buf, size_t len)
|
||||
{
|
||||
struct iio_dev *indio_dev = dev_to_iio_dev(dev);
|
||||
struct ms_ht_dev *dev_data = iio_priv(indio_dev);
|
||||
|
||||
return ms_sensors_write_heater(dev_data, buf, len);
|
||||
}
|
||||
|
||||
static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(htu21_show_samp_freq);
|
||||
static IIO_DEVICE_ATTR(battery_low, S_IRUGO,
|
||||
htu21_show_battery_low, NULL, 0);
|
||||
static IIO_DEVICE_ATTR(heater_enable, S_IRUGO | S_IWUSR,
|
||||
htu21_show_heater, htu21_write_heater, 0);
|
||||
|
||||
static struct attribute *htu21_attributes[] = {
|
||||
&iio_const_attr_sampling_frequency_available.dev_attr.attr,
|
||||
&iio_dev_attr_battery_low.dev_attr.attr,
|
||||
&iio_dev_attr_heater_enable.dev_attr.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group htu21_attribute_group = {
|
||||
.attrs = htu21_attributes,
|
||||
};
|
||||
|
||||
static const struct iio_info htu21_info = {
|
||||
.read_raw = htu21_read_raw,
|
||||
.write_raw = htu21_write_raw,
|
||||
.attrs = &htu21_attribute_group,
|
||||
.driver_module = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int htu21_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct ms_ht_dev *dev_data;
|
||||
struct iio_dev *indio_dev;
|
||||
int ret;
|
||||
u64 serial_number;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_WRITE_BYTE_DATA |
|
||||
I2C_FUNC_SMBUS_WRITE_BYTE |
|
||||
I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
|
||||
dev_err(&client->dev,
|
||||
"Adapter does not support some i2c transaction\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*dev_data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
dev_data = iio_priv(indio_dev);
|
||||
dev_data->client = client;
|
||||
dev_data->res_index = 0;
|
||||
mutex_init(&dev_data->lock);
|
||||
|
||||
indio_dev->info = &htu21_info;
|
||||
indio_dev->name = id->name;
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
|
||||
if (id->driver_data == MS8607) {
|
||||
indio_dev->channels = ms8607_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(ms8607_channels);
|
||||
} else {
|
||||
indio_dev->channels = htu21_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(htu21_channels);
|
||||
}
|
||||
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
|
||||
ret = ms_sensors_reset(client, HTU21_RESET, 15000);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = ms_sensors_read_serial(client, &serial_number);
|
||||
if (ret)
|
||||
return ret;
|
||||
dev_info(&client->dev, "Serial number : %llx", serial_number);
|
||||
|
||||
return devm_iio_device_register(&client->dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct i2c_device_id htu21_id[] = {
|
||||
{"htu21", HTU21},
|
||||
{"ms8607-humidity", MS8607},
|
||||
{}
|
||||
};
|
||||
|
||||
static struct i2c_driver htu21_driver = {
|
||||
.probe = htu21_probe,
|
||||
.id_table = htu21_id,
|
||||
.driver = {
|
||||
.name = "htu21",
|
||||
},
|
||||
};
|
||||
|
||||
module_i2c_driver(htu21_driver);
|
||||
|
||||
MODULE_DESCRIPTION("Measurement-Specialties htu21 temperature and humidity driver");
|
||||
MODULE_AUTHOR("William Markezana <william.markezana@meas-spec.com>");
|
||||
MODULE_AUTHOR("Ludovic Tancerel <ludovic.tancerel@maplehightech.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
|
@ -57,8 +57,12 @@ static int si7020_read_raw(struct iio_dev *indio_dev,
|
|||
if (ret < 0)
|
||||
return ret;
|
||||
*val = ret >> 2;
|
||||
/*
|
||||
* Humidity values can slightly exceed the 0-100%RH
|
||||
* range and should be corrected by software
|
||||
*/
|
||||
if (chan->type == IIO_HUMIDITYRELATIVE)
|
||||
*val &= GENMASK(11, 0);
|
||||
*val = clamp_val(*val, 786, 13893);
|
||||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (chan->type == IIO_TEMP)
|
||||
|
|
|
@ -27,7 +27,6 @@
|
|||
#include <linux/iio/trigger_consumer.h>
|
||||
|
||||
#define KMX61_DRV_NAME "kmx61"
|
||||
#define KMX61_GPIO_NAME "kmx61_int"
|
||||
#define KMX61_IRQ_NAME "kmx61_event"
|
||||
|
||||
#define KMX61_REG_WHO_AM_I 0x00
|
||||
|
@ -1243,30 +1242,6 @@ static const char *kmx61_match_acpi_device(struct device *dev)
|
|||
return dev_name(dev);
|
||||
}
|
||||
|
||||
static int kmx61_gpio_probe(struct i2c_client *client, struct kmx61_data *data)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, KMX61_GPIO_NAME, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "acpi gpio get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static struct iio_dev *kmx61_indiodev_setup(struct kmx61_data *data,
|
||||
const struct iio_info *info,
|
||||
const struct iio_chan_spec *chan,
|
||||
|
@ -1360,9 +1335,6 @@ static int kmx61_probe(struct i2c_client *client,
|
|||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = kmx61_gpio_probe(client, data);
|
||||
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
kmx61_data_rdy_trig_poll,
|
||||
|
|
|
@ -75,6 +75,8 @@ static const char * const iio_chan_type_name_spec[] = {
|
|||
[IIO_ENERGY] = "energy",
|
||||
[IIO_DISTANCE] = "distance",
|
||||
[IIO_VELOCITY] = "velocity",
|
||||
[IIO_CONCENTRATION] = "concentration",
|
||||
[IIO_RESISTANCE] = "resistance",
|
||||
};
|
||||
|
||||
static const char * const iio_modifier_names[] = {
|
||||
|
@ -111,6 +113,8 @@ static const char * const iio_modifier_names[] = {
|
|||
[IIO_MOD_ROOT_SUM_SQUARED_X_Y_Z] = "sqrt(x^2+y^2+z^2)",
|
||||
[IIO_MOD_I] = "i",
|
||||
[IIO_MOD_Q] = "q",
|
||||
[IIO_MOD_CO2] = "co2",
|
||||
[IIO_MOD_VOC] = "voc",
|
||||
};
|
||||
|
||||
/* relies on pairs of these shared then separate */
|
||||
|
@ -962,7 +966,7 @@ static void iio_device_unregister_sysfs(struct iio_dev *indio_dev)
|
|||
static void iio_dev_release(struct device *device)
|
||||
{
|
||||
struct iio_dev *indio_dev = dev_to_iio_dev(device);
|
||||
if (indio_dev->modes & INDIO_BUFFER_TRIGGERED)
|
||||
if (indio_dev->modes & (INDIO_BUFFER_TRIGGERED | INDIO_EVENT_TRIGGERED))
|
||||
iio_device_unregister_trigger_consumer(indio_dev);
|
||||
iio_device_unregister_eventset(indio_dev);
|
||||
iio_device_unregister_sysfs(indio_dev);
|
||||
|
@ -1153,6 +1157,8 @@ static long iio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
|
|||
|
||||
if (cmd == IIO_GET_EVENT_FD_IOCTL) {
|
||||
fd = iio_event_getfd(indio_dev);
|
||||
if (fd < 0)
|
||||
return fd;
|
||||
if (copy_to_user(ip, &fd, sizeof(fd)))
|
||||
return -EFAULT;
|
||||
return 0;
|
||||
|
@ -1241,7 +1247,7 @@ int iio_device_register(struct iio_dev *indio_dev)
|
|||
"Failed to register event set\n");
|
||||
goto error_free_sysfs;
|
||||
}
|
||||
if (indio_dev->modes & INDIO_BUFFER_TRIGGERED)
|
||||
if (indio_dev->modes & (INDIO_BUFFER_TRIGGERED | INDIO_EVENT_TRIGGERED))
|
||||
iio_device_register_trigger_consumer(indio_dev);
|
||||
|
||||
if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) &&
|
||||
|
|
|
@ -366,10 +366,18 @@ static ssize_t iio_trigger_write_current(struct device *dev,
|
|||
|
||||
indio_dev->trig = trig;
|
||||
|
||||
if (oldtrig)
|
||||
if (oldtrig) {
|
||||
if (indio_dev->modes & INDIO_EVENT_TRIGGERED)
|
||||
iio_trigger_detach_poll_func(oldtrig,
|
||||
indio_dev->pollfunc_event);
|
||||
iio_trigger_put(oldtrig);
|
||||
if (indio_dev->trig)
|
||||
}
|
||||
if (indio_dev->trig) {
|
||||
iio_trigger_get(indio_dev->trig);
|
||||
if (indio_dev->modes & INDIO_EVENT_TRIGGERED)
|
||||
iio_trigger_attach_poll_func(indio_dev->trig,
|
||||
indio_dev->pollfunc_event);
|
||||
}
|
||||
|
||||
return len;
|
||||
}
|
||||
|
|
68
drivers/iio/industrialio-triggered-event.c
Normal file
68
drivers/iio/industrialio-triggered-event.c
Normal file
|
@ -0,0 +1,68 @@
|
|||
/*
|
||||
* Copyright (C) 2015 Cogent Embedded, Inc.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/export.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/triggered_event.h>
|
||||
#include <linux/iio/trigger_consumer.h>
|
||||
|
||||
/**
|
||||
* iio_triggered_event_setup() - Setup pollfunc_event for triggered event
|
||||
* @indio_dev: IIO device structure
|
||||
* @h: Function which will be used as pollfunc_event top half
|
||||
* @thread: Function which will be used as pollfunc_event bottom half
|
||||
*
|
||||
* This function combines some common tasks which will normally be performed
|
||||
* when setting up a triggered event. It will allocate the pollfunc_event and
|
||||
* set mode to use it for triggered event.
|
||||
*
|
||||
* Before calling this function the indio_dev structure should already be
|
||||
* completely initialized, but not yet registered. In practice this means that
|
||||
* this function should be called right before iio_device_register().
|
||||
*
|
||||
* To free the resources allocated by this function call
|
||||
* iio_triggered_event_cleanup().
|
||||
*/
|
||||
int iio_triggered_event_setup(struct iio_dev *indio_dev,
|
||||
irqreturn_t (*h)(int irq, void *p),
|
||||
irqreturn_t (*thread)(int irq, void *p))
|
||||
{
|
||||
indio_dev->pollfunc_event = iio_alloc_pollfunc(h,
|
||||
thread,
|
||||
IRQF_ONESHOT,
|
||||
indio_dev,
|
||||
"%s_consumer%d",
|
||||
indio_dev->name,
|
||||
indio_dev->id);
|
||||
if (indio_dev->pollfunc_event == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
/* Flag that events polling is possible */
|
||||
indio_dev->modes |= INDIO_EVENT_TRIGGERED;
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(iio_triggered_event_setup);
|
||||
|
||||
/**
|
||||
* iio_triggered_event_cleanup() - Free resources allocated by iio_triggered_event_setup()
|
||||
* @indio_dev: IIO device structure
|
||||
*/
|
||||
void iio_triggered_event_cleanup(struct iio_dev *indio_dev)
|
||||
{
|
||||
indio_dev->modes &= ~INDIO_EVENT_TRIGGERED;
|
||||
iio_dealloc_pollfunc(indio_dev->pollfunc_event);
|
||||
}
|
||||
EXPORT_SYMBOL(iio_triggered_event_cleanup);
|
||||
|
||||
MODULE_AUTHOR("Vladimir Barinov");
|
||||
MODULE_DESCRIPTION("IIO helper functions for setting up triggered events");
|
||||
MODULE_LICENSE("GPL");
|
|
@ -50,6 +50,19 @@ config APDS9300
|
|||
To compile this driver as a module, choose M here: the
|
||||
module will be called apds9300.
|
||||
|
||||
config APDS9960
|
||||
tristate "Avago APDS9960 gesture/RGB/ALS/proximity sensor"
|
||||
select REGMAP_I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_KFIFO_BUF
|
||||
depends on I2C
|
||||
help
|
||||
Say Y here to build I2C interface support for the Avago
|
||||
APDS9960 gesture/RGB/ALS/proximity sensor.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called apds9960
|
||||
|
||||
config BH1750
|
||||
tristate "ROHM BH1750 ambient light sensor"
|
||||
depends on I2C
|
||||
|
@ -287,6 +300,16 @@ config TSL4531
|
|||
To compile this driver as a module, choose M here: the
|
||||
module will be called tsl4531.
|
||||
|
||||
config US5182D
|
||||
tristate "UPISEMI light and proximity sensor"
|
||||
depends on I2C
|
||||
help
|
||||
If you say yes here you get support for the UPISEMI US5182D
|
||||
ambient light and proximity sensor.
|
||||
|
||||
This driver can also be built as a module. If so, the module
|
||||
will be called us5182d.
|
||||
|
||||
config VCNL4000
|
||||
tristate "VCNL4000 combined ALS and proximity sensor"
|
||||
depends on I2C
|
||||
|
|
|
@ -7,6 +7,7 @@ obj-$(CONFIG_ACPI_ALS) += acpi-als.o
|
|||
obj-$(CONFIG_ADJD_S311) += adjd_s311.o
|
||||
obj-$(CONFIG_AL3320A) += al3320a.o
|
||||
obj-$(CONFIG_APDS9300) += apds9300.o
|
||||
obj-$(CONFIG_APDS9960) += apds9960.o
|
||||
obj-$(CONFIG_BH1750) += bh1750.o
|
||||
obj-$(CONFIG_CM32181) += cm32181.o
|
||||
obj-$(CONFIG_CM3232) += cm3232.o
|
||||
|
@ -27,4 +28,5 @@ obj-$(CONFIG_STK3310) += stk3310.o
|
|||
obj-$(CONFIG_TCS3414) += tcs3414.o
|
||||
obj-$(CONFIG_TCS3472) += tcs3472.o
|
||||
obj-$(CONFIG_TSL4531) += tsl4531.o
|
||||
obj-$(CONFIG_US5182D) += us5182d.o
|
||||
obj-$(CONFIG_VCNL4000) += vcnl4000.o
|
||||
|
|
1130
drivers/iio/light/apds9960.c
Normal file
1130
drivers/iio/light/apds9960.c
Normal file
File diff suppressed because it is too large
Load diff
|
@ -793,7 +793,6 @@ static struct i2c_driver opt3001_driver = {
|
|||
.driver = {
|
||||
.name = "opt3001",
|
||||
.of_match_table = of_match_ptr(opt3001_of_match),
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
};
|
||||
|
||||
|
|
|
@ -35,8 +35,8 @@
|
|||
#define STK3310_REG_ID 0x3E
|
||||
#define STK3310_MAX_REG 0x80
|
||||
|
||||
#define STK3310_STATE_EN_PS 0x01
|
||||
#define STK3310_STATE_EN_ALS 0x02
|
||||
#define STK3310_STATE_EN_PS BIT(0)
|
||||
#define STK3310_STATE_EN_ALS BIT(1)
|
||||
#define STK3310_STATE_STANDBY 0x00
|
||||
|
||||
#define STK3310_CHIP_ID_VAL 0x13
|
||||
|
@ -47,7 +47,6 @@
|
|||
#define STK3310_DRIVER_NAME "stk3310"
|
||||
#define STK3310_REGMAP_NAME "stk3310_regmap"
|
||||
#define STK3310_EVENT "stk3310_event"
|
||||
#define STK3310_GPIO "stk3310_gpio"
|
||||
|
||||
#define STK3310_SCALE_AVAILABLE "6.4 1.6 0.4 0.1"
|
||||
|
||||
|
@ -241,8 +240,11 @@ static int stk3310_write_event(struct iio_dev *indio_dev,
|
|||
struct stk3310_data *data = iio_priv(indio_dev);
|
||||
struct i2c_client *client = data->client;
|
||||
|
||||
regmap_field_read(data->reg_ps_gain, &index);
|
||||
if (val > stk3310_ps_max[index])
|
||||
ret = regmap_field_read(data->reg_ps_gain, &index);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (val < 0 || val > stk3310_ps_max[index])
|
||||
return -EINVAL;
|
||||
|
||||
if (dir == IIO_EV_DIR_RISING)
|
||||
|
@ -266,9 +268,12 @@ static int stk3310_read_event_config(struct iio_dev *indio_dev,
|
|||
enum iio_event_direction dir)
|
||||
{
|
||||
unsigned int event_val;
|
||||
int ret;
|
||||
struct stk3310_data *data = iio_priv(indio_dev);
|
||||
|
||||
regmap_field_read(data->reg_int_ps, &event_val);
|
||||
ret = regmap_field_read(data->reg_int_ps, &event_val);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return event_val;
|
||||
}
|
||||
|
@ -307,14 +312,16 @@ static int stk3310_read_raw(struct iio_dev *indio_dev,
|
|||
struct stk3310_data *data = iio_priv(indio_dev);
|
||||
struct i2c_client *client = data->client;
|
||||
|
||||
if (chan->type != IIO_LIGHT && chan->type != IIO_PROXIMITY)
|
||||
return -EINVAL;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
if (chan->type == IIO_LIGHT)
|
||||
reg = STK3310_REG_ALS_DATA_MSB;
|
||||
else if (chan->type == IIO_PROXIMITY)
|
||||
reg = STK3310_REG_PS_DATA_MSB;
|
||||
else
|
||||
return -EINVAL;
|
||||
reg = STK3310_REG_PS_DATA_MSB;
|
||||
|
||||
mutex_lock(&data->lock);
|
||||
ret = regmap_bulk_read(data->regmap, reg, &buf, 2);
|
||||
if (ret < 0) {
|
||||
|
@ -327,17 +334,23 @@ static int stk3310_read_raw(struct iio_dev *indio_dev,
|
|||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_INT_TIME:
|
||||
if (chan->type == IIO_LIGHT)
|
||||
regmap_field_read(data->reg_als_it, &index);
|
||||
ret = regmap_field_read(data->reg_als_it, &index);
|
||||
else
|
||||
regmap_field_read(data->reg_ps_it, &index);
|
||||
ret = regmap_field_read(data->reg_ps_it, &index);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = stk3310_it_table[index][0];
|
||||
*val2 = stk3310_it_table[index][1];
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (chan->type == IIO_LIGHT)
|
||||
regmap_field_read(data->reg_als_gain, &index);
|
||||
ret = regmap_field_read(data->reg_als_gain, &index);
|
||||
else
|
||||
regmap_field_read(data->reg_ps_gain, &index);
|
||||
ret = regmap_field_read(data->reg_ps_gain, &index);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = stk3310_scale_table[index][0];
|
||||
*val2 = stk3310_scale_table[index][1];
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
|
@ -354,6 +367,9 @@ static int stk3310_write_raw(struct iio_dev *indio_dev,
|
|||
int index;
|
||||
struct stk3310_data *data = iio_priv(indio_dev);
|
||||
|
||||
if (chan->type != IIO_LIGHT && chan->type != IIO_PROXIMITY)
|
||||
return -EINVAL;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_INT_TIME:
|
||||
index = stk3310_get_index(stk3310_it_table,
|
||||
|
@ -419,8 +435,8 @@ static int stk3310_set_state(struct stk3310_data *data, u8 state)
|
|||
dev_err(&client->dev, "failed to change sensor state\n");
|
||||
} else if (state != STK3310_STATE_STANDBY) {
|
||||
/* Don't reset the 'enabled' flags if we're going in standby */
|
||||
data->ps_enabled = !!(state & 0x01);
|
||||
data->als_enabled = !!(state & 0x02);
|
||||
data->ps_enabled = !!(state & STK3310_STATE_EN_PS);
|
||||
data->als_enabled = !!(state & STK3310_STATE_EN_ALS);
|
||||
}
|
||||
mutex_unlock(&data->lock);
|
||||
|
||||
|
@ -435,7 +451,10 @@ static int stk3310_init(struct iio_dev *indio_dev)
|
|||
struct stk3310_data *data = iio_priv(indio_dev);
|
||||
struct i2c_client *client = data->client;
|
||||
|
||||
regmap_read(data->regmap, STK3310_REG_ID, &chipid);
|
||||
ret = regmap_read(data->regmap, STK3310_REG_ID, &chipid);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (chipid != STK3310_CHIP_ID_VAL &&
|
||||
chipid != STK3311_CHIP_ID_VAL) {
|
||||
dev_err(&client->dev, "invalid chip id: 0x%x\n", chipid);
|
||||
|
@ -457,30 +476,6 @@ static int stk3310_init(struct iio_dev *indio_dev)
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int stk3310_gpio_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* gpio interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, STK3310_GPIO, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "acpi gpio get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static bool stk3310_is_volatile_reg(struct device *dev, unsigned int reg)
|
||||
{
|
||||
switch (reg) {
|
||||
|
@ -604,27 +599,30 @@ static int stk3310_probe(struct i2c_client *client,
|
|||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (client->irq < 0)
|
||||
client->irq = stk3310_gpio_probe(client);
|
||||
|
||||
if (client->irq >= 0) {
|
||||
if (client->irq > 0) {
|
||||
ret = devm_request_threaded_irq(&client->dev, client->irq,
|
||||
stk3310_irq_handler,
|
||||
stk3310_irq_event_handler,
|
||||
IRQF_TRIGGER_FALLING |
|
||||
IRQF_ONESHOT,
|
||||
STK3310_EVENT, indio_dev);
|
||||
if (ret < 0)
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "request irq %d failed\n",
|
||||
client->irq);
|
||||
goto err_standby;
|
||||
}
|
||||
}
|
||||
|
||||
ret = iio_device_register(indio_dev);
|
||||
if (ret < 0) {
|
||||
dev_err(&client->dev, "device_register failed\n");
|
||||
stk3310_set_state(data, STK3310_STATE_STANDBY);
|
||||
goto err_standby;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_standby:
|
||||
stk3310_set_state(data, STK3310_STATE_STANDBY);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
@ -648,7 +646,7 @@ static int stk3310_suspend(struct device *dev)
|
|||
|
||||
static int stk3310_resume(struct device *dev)
|
||||
{
|
||||
int state = 0;
|
||||
u8 state = 0;
|
||||
struct stk3310_data *data;
|
||||
|
||||
data = iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
|
||||
|
|
|
@ -158,9 +158,9 @@ static int tsl4531_check_id(struct i2c_client *client)
|
|||
case TSL45313_ID:
|
||||
case TSL45315_ID:
|
||||
case TSL45317_ID:
|
||||
return 1;
|
||||
default:
|
||||
return 0;
|
||||
default:
|
||||
return -ENODEV;
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -180,9 +180,10 @@ static int tsl4531_probe(struct i2c_client *client,
|
|||
data->client = client;
|
||||
mutex_init(&data->lock);
|
||||
|
||||
if (!tsl4531_check_id(client)) {
|
||||
ret = tsl4531_check_id(client);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "no TSL4531 sensor\n");
|
||||
return -ENODEV;
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, TSL4531_CONTROL,
|
||||
|
|
507
drivers/iio/light/us5182d.c
Normal file
507
drivers/iio/light/us5182d.c
Normal file
|
@ -0,0 +1,507 @@
|
|||
/*
|
||||
* Copyright (c) 2015 Intel Corporation
|
||||
*
|
||||
* Driver for UPISEMI us5182d Proximity and Ambient Light Sensor.
|
||||
*
|
||||
* 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 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.
|
||||
*
|
||||
* To do: Interrupt support.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/acpi.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
#define US5182D_REG_CFG0 0x00
|
||||
#define US5182D_CFG0_ONESHOT_EN BIT(6)
|
||||
#define US5182D_CFG0_SHUTDOWN_EN BIT(7)
|
||||
#define US5182D_CFG0_WORD_ENABLE BIT(0)
|
||||
|
||||
#define US5182D_REG_CFG1 0x01
|
||||
#define US5182D_CFG1_ALS_RES16 BIT(4)
|
||||
#define US5182D_CFG1_AGAIN_DEFAULT 0x00
|
||||
|
||||
#define US5182D_REG_CFG2 0x02
|
||||
#define US5182D_CFG2_PX_RES16 BIT(4)
|
||||
#define US5182D_CFG2_PXGAIN_DEFAULT BIT(2)
|
||||
|
||||
#define US5182D_REG_CFG3 0x03
|
||||
#define US5182D_CFG3_LED_CURRENT100 (BIT(4) | BIT(5))
|
||||
|
||||
#define US5182D_REG_CFG4 0x10
|
||||
|
||||
/*
|
||||
* Registers for tuning the auto dark current cancelling feature.
|
||||
* DARK_TH(reg 0x27,0x28) - threshold (counts) for auto dark cancelling.
|
||||
* when ALS > DARK_TH --> ALS_Code = ALS - Upper(0x2A) * Dark
|
||||
* when ALS < DARK_TH --> ALS_Code = ALS - Lower(0x29) * Dark
|
||||
*/
|
||||
#define US5182D_REG_UDARK_TH 0x27
|
||||
#define US5182D_REG_DARK_AUTO_EN 0x2b
|
||||
#define US5182D_REG_AUTO_LDARK_GAIN 0x29
|
||||
#define US5182D_REG_AUTO_HDARK_GAIN 0x2a
|
||||
|
||||
#define US5182D_OPMODE_ALS 0x01
|
||||
#define US5182D_OPMODE_PX 0x02
|
||||
#define US5182D_OPMODE_SHIFT 4
|
||||
|
||||
#define US5182D_REG_DARK_AUTO_EN_DEFAULT 0x80
|
||||
#define US5182D_REG_AUTO_LDARK_GAIN_DEFAULT 0x16
|
||||
#define US5182D_REG_AUTO_HDARK_GAIN_DEFAULT 0x00
|
||||
|
||||
#define US5182D_REG_ADL 0x0c
|
||||
#define US5182D_REG_PDL 0x0e
|
||||
|
||||
#define US5182D_REG_MODE_STORE 0x21
|
||||
#define US5182D_STORE_MODE 0x01
|
||||
|
||||
#define US5182D_REG_CHIPID 0xb2
|
||||
|
||||
#define US5182D_OPMODE_MASK GENMASK(5, 4)
|
||||
#define US5182D_AGAIN_MASK 0x07
|
||||
#define US5182D_RESET_CHIP 0x01
|
||||
|
||||
#define US5182D_CHIPID 0x26
|
||||
#define US5182D_DRV_NAME "us5182d"
|
||||
|
||||
#define US5182D_GA_RESOLUTION 1000
|
||||
|
||||
#define US5182D_READ_BYTE 1
|
||||
#define US5182D_READ_WORD 2
|
||||
#define US5182D_OPSTORE_SLEEP_TIME 20 /* ms */
|
||||
|
||||
/* Available ranges: [12354, 7065, 3998, 2202, 1285, 498, 256, 138] lux */
|
||||
static const int us5182d_scales[] = {188500, 107800, 61000, 33600, 19600, 7600,
|
||||
3900, 2100};
|
||||
|
||||
/*
|
||||
* Experimental thresholds that work with US5182D sensor on evaluation board
|
||||
* roughly between 12-32 lux
|
||||
*/
|
||||
static u16 us5182d_dark_ths_vals[] = {170, 200, 512, 512, 800, 2000, 4000,
|
||||
8000};
|
||||
|
||||
enum mode {
|
||||
US5182D_ALS_PX,
|
||||
US5182D_ALS_ONLY,
|
||||
US5182D_PX_ONLY
|
||||
};
|
||||
|
||||
struct us5182d_data {
|
||||
struct i2c_client *client;
|
||||
struct mutex lock;
|
||||
|
||||
/* Glass attenuation factor */
|
||||
u32 ga;
|
||||
|
||||
/* Dark gain tuning */
|
||||
u8 lower_dark_gain;
|
||||
u8 upper_dark_gain;
|
||||
u16 *us5182d_dark_ths;
|
||||
|
||||
u8 opmode;
|
||||
};
|
||||
|
||||
static IIO_CONST_ATTR(in_illuminance_scale_available,
|
||||
"0.0021 0.0039 0.0076 0.0196 0.0336 0.061 0.1078 0.1885");
|
||||
|
||||
static struct attribute *us5182d_attrs[] = {
|
||||
&iio_const_attr_in_illuminance_scale_available.dev_attr.attr,
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct attribute_group us5182d_attr_group = {
|
||||
.attrs = us5182d_attrs,
|
||||
};
|
||||
|
||||
static const struct {
|
||||
u8 reg;
|
||||
u8 val;
|
||||
} us5182d_regvals[] = {
|
||||
{US5182D_REG_CFG0, (US5182D_CFG0_SHUTDOWN_EN |
|
||||
US5182D_CFG0_WORD_ENABLE)},
|
||||
{US5182D_REG_CFG1, US5182D_CFG1_ALS_RES16},
|
||||
{US5182D_REG_CFG2, (US5182D_CFG2_PX_RES16 |
|
||||
US5182D_CFG2_PXGAIN_DEFAULT)},
|
||||
{US5182D_REG_CFG3, US5182D_CFG3_LED_CURRENT100},
|
||||
{US5182D_REG_MODE_STORE, US5182D_STORE_MODE},
|
||||
{US5182D_REG_CFG4, 0x00},
|
||||
};
|
||||
|
||||
static const struct iio_chan_spec us5182d_channels[] = {
|
||||
{
|
||||
.type = IIO_LIGHT,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
|
||||
BIT(IIO_CHAN_INFO_SCALE),
|
||||
},
|
||||
{
|
||||
.type = IIO_PROXIMITY,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
|
||||
}
|
||||
};
|
||||
|
||||
static int us5182d_get_als(struct us5182d_data *data)
|
||||
{
|
||||
int ret;
|
||||
unsigned long result;
|
||||
|
||||
ret = i2c_smbus_read_word_data(data->client,
|
||||
US5182D_REG_ADL);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
result = ret * data->ga / US5182D_GA_RESOLUTION;
|
||||
if (result > 0xffff)
|
||||
result = 0xffff;
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static int us5182d_set_opmode(struct us5182d_data *data, u8 mode)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
/*
|
||||
* In oneshot mode the chip will power itself down after taking the
|
||||
* required measurement.
|
||||
*/
|
||||
ret = ret | US5182D_CFG0_ONESHOT_EN;
|
||||
|
||||
/* update mode */
|
||||
ret = ret & ~US5182D_OPMODE_MASK;
|
||||
ret = ret | (mode << US5182D_OPMODE_SHIFT);
|
||||
|
||||
/*
|
||||
* After updating the operating mode, the chip requires that
|
||||
* the operation is stored, by writing 1 in the STORE_MODE
|
||||
* register (auto-clearing).
|
||||
*/
|
||||
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (mode == data->opmode)
|
||||
return 0;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_MODE_STORE,
|
||||
US5182D_STORE_MODE);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
data->opmode = mode;
|
||||
msleep(US5182D_OPSTORE_SLEEP_TIME);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int us5182d_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
switch (chan->type) {
|
||||
case IIO_LIGHT:
|
||||
mutex_lock(&data->lock);
|
||||
ret = us5182d_set_opmode(data, US5182D_OPMODE_ALS);
|
||||
if (ret < 0)
|
||||
goto out_err;
|
||||
|
||||
ret = us5182d_get_als(data);
|
||||
if (ret < 0)
|
||||
goto out_err;
|
||||
mutex_unlock(&data->lock);
|
||||
*val = ret;
|
||||
return IIO_VAL_INT;
|
||||
case IIO_PROXIMITY:
|
||||
mutex_lock(&data->lock);
|
||||
ret = us5182d_set_opmode(data, US5182D_OPMODE_PX);
|
||||
if (ret < 0)
|
||||
goto out_err;
|
||||
|
||||
ret = i2c_smbus_read_word_data(data->client,
|
||||
US5182D_REG_PDL);
|
||||
if (ret < 0)
|
||||
goto out_err;
|
||||
mutex_unlock(&data->lock);
|
||||
*val = ret;
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
*val = 0;
|
||||
*val2 = us5182d_scales[ret & US5182D_AGAIN_MASK];
|
||||
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return -EINVAL;
|
||||
out_err:
|
||||
mutex_unlock(&data->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* us5182d_update_dark_th - update Darh_Th registers
|
||||
* @data us5182d_data structure
|
||||
* @index index in us5182d_dark_ths array to use for the updated value
|
||||
*
|
||||
* Function needs to be called with a lock held because it needs two i2c write
|
||||
* byte operations as these registers (0x27 0x28) don't work in word mode
|
||||
* accessing.
|
||||
*/
|
||||
static int us5182d_update_dark_th(struct us5182d_data *data, int index)
|
||||
{
|
||||
__be16 dark_th = cpu_to_be16(data->us5182d_dark_ths[index]);
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH,
|
||||
((u8 *)&dark_th)[0]);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH + 1,
|
||||
((u8 *)&dark_th)[1]);
|
||||
}
|
||||
|
||||
/**
|
||||
* us5182d_apply_scale - update the ALS scale
|
||||
* @data us5182d_data structure
|
||||
* @index index in us5182d_scales array to use for the updated value
|
||||
*
|
||||
* Function needs to be called with a lock held as we're having more than one
|
||||
* i2c operation.
|
||||
*/
|
||||
static int us5182d_apply_scale(struct us5182d_data *data, int index)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = ret & (~US5182D_AGAIN_MASK);
|
||||
ret |= index;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG1, ret);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return us5182d_update_dark_th(data, index);
|
||||
}
|
||||
|
||||
static int us5182d_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan, int val,
|
||||
int val2, long mask)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
int ret, i;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
if (val != 0)
|
||||
return -EINVAL;
|
||||
for (i = 0; i < ARRAY_SIZE(us5182d_scales); i++)
|
||||
if (val2 == us5182d_scales[i]) {
|
||||
mutex_lock(&data->lock);
|
||||
ret = us5182d_apply_scale(data, i);
|
||||
mutex_unlock(&data->lock);
|
||||
return ret;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static const struct iio_info us5182d_info = {
|
||||
.driver_module = THIS_MODULE,
|
||||
.read_raw = us5182d_read_raw,
|
||||
.write_raw = us5182d_write_raw,
|
||||
.attrs = &us5182d_attr_group,
|
||||
};
|
||||
|
||||
static int us5182d_reset(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
|
||||
return i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG3,
|
||||
US5182D_RESET_CHIP);
|
||||
}
|
||||
|
||||
static int us5182d_init(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
int i, ret;
|
||||
|
||||
ret = us5182d_reset(indio_dev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
data->opmode = 0;
|
||||
for (i = 0; i < ARRAY_SIZE(us5182d_regvals); i++) {
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
us5182d_regvals[i].reg,
|
||||
us5182d_regvals[i].val);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void us5182d_get_platform_data(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
|
||||
if (device_property_read_u32(&data->client->dev, "upisemi,glass-coef",
|
||||
&data->ga))
|
||||
data->ga = US5182D_GA_RESOLUTION;
|
||||
if (device_property_read_u16_array(&data->client->dev,
|
||||
"upisemi,dark-ths",
|
||||
data->us5182d_dark_ths,
|
||||
ARRAY_SIZE(us5182d_dark_ths_vals)))
|
||||
data->us5182d_dark_ths = us5182d_dark_ths_vals;
|
||||
if (device_property_read_u8(&data->client->dev,
|
||||
"upisemi,upper-dark-gain",
|
||||
&data->upper_dark_gain))
|
||||
data->upper_dark_gain = US5182D_REG_AUTO_HDARK_GAIN_DEFAULT;
|
||||
if (device_property_read_u8(&data->client->dev,
|
||||
"upisemi,lower-dark-gain",
|
||||
&data->lower_dark_gain))
|
||||
data->lower_dark_gain = US5182D_REG_AUTO_LDARK_GAIN_DEFAULT;
|
||||
}
|
||||
|
||||
static int us5182d_dark_gain_config(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct us5182d_data *data = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
ret = us5182d_update_dark_th(data, US5182D_CFG1_AGAIN_DEFAULT);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
US5182D_REG_AUTO_LDARK_GAIN,
|
||||
data->lower_dark_gain);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = i2c_smbus_write_byte_data(data->client,
|
||||
US5182D_REG_AUTO_HDARK_GAIN,
|
||||
data->upper_dark_gain);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return i2c_smbus_write_byte_data(data->client, US5182D_REG_DARK_AUTO_EN,
|
||||
US5182D_REG_DARK_AUTO_EN_DEFAULT);
|
||||
}
|
||||
|
||||
static int us5182d_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct us5182d_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
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;
|
||||
|
||||
mutex_init(&data->lock);
|
||||
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->info = &us5182d_info;
|
||||
indio_dev->name = US5182D_DRV_NAME;
|
||||
indio_dev->channels = us5182d_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(us5182d_channels);
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
|
||||
ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CHIPID);
|
||||
if (ret != US5182D_CHIPID) {
|
||||
dev_err(&data->client->dev,
|
||||
"Failed to detect US5182 light chip\n");
|
||||
return (ret < 0) ? ret : -ENODEV;
|
||||
}
|
||||
|
||||
us5182d_get_platform_data(indio_dev);
|
||||
ret = us5182d_init(indio_dev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = us5182d_dark_gain_config(indio_dev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return iio_device_register(indio_dev);
|
||||
}
|
||||
|
||||
static int us5182d_remove(struct i2c_client *client)
|
||||
{
|
||||
iio_device_unregister(i2c_get_clientdata(client));
|
||||
return i2c_smbus_write_byte_data(client, US5182D_REG_CFG0,
|
||||
US5182D_CFG0_SHUTDOWN_EN);
|
||||
}
|
||||
|
||||
static const struct acpi_device_id us5182d_acpi_match[] = {
|
||||
{ "USD5182", 0},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(acpi, us5182d_acpi_match);
|
||||
|
||||
static const struct i2c_device_id us5182d_id[] = {
|
||||
{"usd5182", 0},
|
||||
{}
|
||||
};
|
||||
|
||||
MODULE_DEVICE_TABLE(i2c, us5182d_id);
|
||||
|
||||
static struct i2c_driver us5182d_driver = {
|
||||
.driver = {
|
||||
.name = US5182D_DRV_NAME,
|
||||
.acpi_match_table = ACPI_PTR(us5182d_acpi_match),
|
||||
},
|
||||
.probe = us5182d_probe,
|
||||
.remove = us5182d_remove,
|
||||
.id_table = us5182d_id,
|
||||
|
||||
};
|
||||
module_i2c_driver(us5182d_driver);
|
||||
|
||||
MODULE_AUTHOR("Adriana Reus <adriana.reus@intel.com>");
|
||||
MODULE_DESCRIPTION("Driver for us5182d Proximity and Light Sensor");
|
||||
MODULE_LICENSE("GPL v2");
|
|
@ -24,6 +24,24 @@ config AK09911
|
|||
help
|
||||
Deprecated: AK09911 is now supported by AK8975 driver.
|
||||
|
||||
config BMC150_MAGN
|
||||
tristate "Bosch BMC150 Magnetometer Driver"
|
||||
depends on I2C
|
||||
select REGMAP_I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to build support for the BMC150 magnetometer.
|
||||
|
||||
Currently this only supports the device via an i2c interface.
|
||||
|
||||
This is a combo module with both accelerometer and magnetometer.
|
||||
This driver is only implementing magnetometer part, which has
|
||||
its own address and register map.
|
||||
|
||||
To compile this driver as a module, choose M here: the module will be
|
||||
called bmc150_magn.
|
||||
|
||||
config MAG3110
|
||||
tristate "Freescale MAG3110 3-Axis Magnetometer"
|
||||
depends on I2C
|
||||
|
@ -87,19 +105,4 @@ config IIO_ST_MAGN_SPI_3AXIS
|
|||
depends on IIO_ST_MAGN_3AXIS
|
||||
depends on IIO_ST_SENSORS_SPI
|
||||
|
||||
config BMC150_MAGN
|
||||
tristate "Bosch BMC150 Magnetometer Driver"
|
||||
depends on I2C
|
||||
select REGMAP_I2C
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
help
|
||||
Say yes here to build support for the BMC150 magnetometer.
|
||||
|
||||
Currently this only supports the device via an i2c interface.
|
||||
|
||||
This is a combo module with both accelerometer and magnetometer.
|
||||
This driver is only implementing magnetometer part, which has
|
||||
its own address and register map.
|
||||
|
||||
endmenu
|
||||
|
|
|
@ -4,6 +4,7 @@
|
|||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_AK8975) += ak8975.o
|
||||
obj-$(CONFIG_BMC150_MAGN) += bmc150_magn.o
|
||||
obj-$(CONFIG_MAG3110) += mag3110.o
|
||||
obj-$(CONFIG_HID_SENSOR_MAGNETOMETER_3D) += hid-sensor-magn-3d.o
|
||||
obj-$(CONFIG_MMC35240) += mmc35240.o
|
||||
|
@ -14,5 +15,3 @@ st_magn-$(CONFIG_IIO_BUFFER) += st_magn_buffer.o
|
|||
|
||||
obj-$(CONFIG_IIO_ST_MAGN_I2C_3AXIS) += st_magn_i2c.o
|
||||
obj-$(CONFIG_IIO_ST_MAGN_SPI_3AXIS) += st_magn_spi.o
|
||||
|
||||
obj-$(CONFIG_BMC150_MAGN) += bmc150_magn.o
|
||||
|
|
|
@ -37,7 +37,6 @@
|
|||
|
||||
#define BMC150_MAGN_DRV_NAME "bmc150_magn"
|
||||
#define BMC150_MAGN_IRQ_NAME "bmc150_magn_event"
|
||||
#define BMC150_MAGN_GPIO_INT "interrupt"
|
||||
|
||||
#define BMC150_MAGN_REG_CHIP_ID 0x40
|
||||
#define BMC150_MAGN_CHIP_ID_VAL 0x32
|
||||
|
@ -833,31 +832,6 @@ static const struct iio_buffer_setup_ops bmc150_magn_buffer_setup_ops = {
|
|||
.postdisable = bmc150_magn_buffer_postdisable,
|
||||
};
|
||||
|
||||
static int bmc150_magn_gpio_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev;
|
||||
struct gpio_desc *gpio;
|
||||
int ret;
|
||||
|
||||
if (!client)
|
||||
return -EINVAL;
|
||||
|
||||
dev = &client->dev;
|
||||
|
||||
/* data ready GPIO interrupt pin */
|
||||
gpio = devm_gpiod_get_index(dev, BMC150_MAGN_GPIO_INT, 0, GPIOD_IN);
|
||||
if (IS_ERR(gpio)) {
|
||||
dev_err(dev, "ACPI GPIO get index failed\n");
|
||||
return PTR_ERR(gpio);
|
||||
}
|
||||
|
||||
ret = gpiod_to_irq(gpio);
|
||||
|
||||
dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const char *bmc150_magn_match_acpi_device(struct device *dev)
|
||||
{
|
||||
const struct acpi_device_id *id;
|
||||
|
@ -911,9 +885,6 @@ static int bmc150_magn_probe(struct i2c_client *client,
|
|||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->info = &bmc150_magn_info;
|
||||
|
||||
if (client->irq <= 0)
|
||||
client->irq = bmc150_magn_gpio_probe(client);
|
||||
|
||||
if (client->irq > 0) {
|
||||
data->dready_trig = devm_iio_trigger_alloc(&client->dev,
|
||||
"%s-dev%d",
|
||||
|
|
|
@ -560,6 +560,7 @@ static const struct iio_info magn_info = {
|
|||
.attrs = &st_magn_attribute_group,
|
||||
.read_raw = &st_magn_read_raw,
|
||||
.write_raw = &st_magn_write_raw,
|
||||
.debugfs_reg_access = &st_sensors_debugfs_reg_access,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_IIO_TRIGGER
|
||||
|
|
20
drivers/iio/potentiometer/Kconfig
Normal file
20
drivers/iio/potentiometer/Kconfig
Normal file
|
@ -0,0 +1,20 @@
|
|||
#
|
||||
# Potentiometer drivers
|
||||
#
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
|
||||
menu "Digital potentiometers"
|
||||
|
||||
config MCP4531
|
||||
tristate "Microchip MCP45xx/MCP46xx Digital Potentiometer driver"
|
||||
depends on I2C
|
||||
help
|
||||
Say yes here to build support for the Microchip
|
||||
MCP4531, MCP4532, MCP4551, MCP4552,
|
||||
MCP4631, MCP4632, MCP4651, MCP4652
|
||||
digital potentiomenter chips.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called mcp4531.
|
||||
|
||||
endmenu
|
6
drivers/iio/potentiometer/Makefile
Normal file
6
drivers/iio/potentiometer/Makefile
Normal file
|
@ -0,0 +1,6 @@
|
|||
#
|
||||
# Makefile for industrial I/O potentiometer drivers
|
||||
#
|
||||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_MCP4531) += mcp4531.o
|
231
drivers/iio/potentiometer/mcp4531.c
Normal file
231
drivers/iio/potentiometer/mcp4531.c
Normal file
|
@ -0,0 +1,231 @@
|
|||
/*
|
||||
* Industrial I/O driver for Microchip digital potentiometers
|
||||
* Copyright (c) 2015 Axentia Technologies AB
|
||||
* Author: Peter Rosin <peda@axentia.se>
|
||||
*
|
||||
* Datasheet: http://www.microchip.com/downloads/en/DeviceDoc/22096b.pdf
|
||||
*
|
||||
* DEVID #Wipers #Positions Resistor Opts (kOhm) i2c address
|
||||
* mcp4531 1 129 5, 10, 50, 100 010111x
|
||||
* mcp4532 1 129 5, 10, 50, 100 01011xx
|
||||
* mcp4551 1 257 5, 10, 50, 100 010111x
|
||||
* mcp4552 1 257 5, 10, 50, 100 01011xx
|
||||
* mcp4631 2 129 5, 10, 50, 100 0101xxx
|
||||
* mcp4632 2 129 5, 10, 50, 100 01011xx
|
||||
* mcp4651 2 257 5, 10, 50, 100 0101xxx
|
||||
* mcp4652 2 257 5, 10, 50, 100 01011xx
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/err.h>
|
||||
|
||||
#include <linux/iio/iio.h>
|
||||
|
||||
struct mcp4531_cfg {
|
||||
int wipers;
|
||||
int max_pos;
|
||||
int kohms;
|
||||
};
|
||||
|
||||
enum mcp4531_type {
|
||||
MCP453x_502,
|
||||
MCP453x_103,
|
||||
MCP453x_503,
|
||||
MCP453x_104,
|
||||
MCP455x_502,
|
||||
MCP455x_103,
|
||||
MCP455x_503,
|
||||
MCP455x_104,
|
||||
MCP463x_502,
|
||||
MCP463x_103,
|
||||
MCP463x_503,
|
||||
MCP463x_104,
|
||||
MCP465x_502,
|
||||
MCP465x_103,
|
||||
MCP465x_503,
|
||||
MCP465x_104,
|
||||
};
|
||||
|
||||
static const struct mcp4531_cfg mcp4531_cfg[] = {
|
||||
[MCP453x_502] = { .wipers = 1, .max_pos = 128, .kohms = 5, },
|
||||
[MCP453x_103] = { .wipers = 1, .max_pos = 128, .kohms = 10, },
|
||||
[MCP453x_503] = { .wipers = 1, .max_pos = 128, .kohms = 50, },
|
||||
[MCP453x_104] = { .wipers = 1, .max_pos = 128, .kohms = 100, },
|
||||
[MCP455x_502] = { .wipers = 1, .max_pos = 256, .kohms = 5, },
|
||||
[MCP455x_103] = { .wipers = 1, .max_pos = 256, .kohms = 10, },
|
||||
[MCP455x_503] = { .wipers = 1, .max_pos = 256, .kohms = 50, },
|
||||
[MCP455x_104] = { .wipers = 1, .max_pos = 256, .kohms = 100, },
|
||||
[MCP463x_502] = { .wipers = 2, .max_pos = 128, .kohms = 5, },
|
||||
[MCP463x_103] = { .wipers = 2, .max_pos = 128, .kohms = 10, },
|
||||
[MCP463x_503] = { .wipers = 2, .max_pos = 128, .kohms = 50, },
|
||||
[MCP463x_104] = { .wipers = 2, .max_pos = 128, .kohms = 100, },
|
||||
[MCP465x_502] = { .wipers = 2, .max_pos = 256, .kohms = 5, },
|
||||
[MCP465x_103] = { .wipers = 2, .max_pos = 256, .kohms = 10, },
|
||||
[MCP465x_503] = { .wipers = 2, .max_pos = 256, .kohms = 50, },
|
||||
[MCP465x_104] = { .wipers = 2, .max_pos = 256, .kohms = 100, },
|
||||
};
|
||||
|
||||
#define MCP4531_WRITE (0 << 2)
|
||||
#define MCP4531_INCR (1 << 2)
|
||||
#define MCP4531_DECR (2 << 2)
|
||||
#define MCP4531_READ (3 << 2)
|
||||
|
||||
#define MCP4531_WIPER_SHIFT (4)
|
||||
|
||||
struct mcp4531_data {
|
||||
struct i2c_client *client;
|
||||
unsigned long devid;
|
||||
};
|
||||
|
||||
#define MCP4531_CHANNEL(ch) { \
|
||||
.type = IIO_RESISTANCE, \
|
||||
.indexed = 1, \
|
||||
.output = 1, \
|
||||
.channel = (ch), \
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
|
||||
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec mcp4531_channels[] = {
|
||||
MCP4531_CHANNEL(0),
|
||||
MCP4531_CHANNEL(1),
|
||||
};
|
||||
|
||||
static int mcp4531_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int *val, int *val2, long mask)
|
||||
{
|
||||
struct mcp4531_data *data = iio_priv(indio_dev);
|
||||
int address = chan->channel << MCP4531_WIPER_SHIFT;
|
||||
s32 ret;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
ret = i2c_smbus_read_word_swapped(data->client,
|
||||
MCP4531_READ | address);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
*val = ret;
|
||||
return IIO_VAL_INT;
|
||||
case IIO_CHAN_INFO_SCALE:
|
||||
*val = 1000 * mcp4531_cfg[data->devid].kohms;
|
||||
*val2 = mcp4531_cfg[data->devid].max_pos;
|
||||
return IIO_VAL_FRACTIONAL;
|
||||
}
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int mcp4531_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct mcp4531_data *data = iio_priv(indio_dev);
|
||||
int address = chan->channel << MCP4531_WIPER_SHIFT;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_RAW:
|
||||
if (val > mcp4531_cfg[data->devid].max_pos || val < 0)
|
||||
return -EINVAL;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return i2c_smbus_write_byte_data(data->client,
|
||||
MCP4531_WRITE | address | (val >> 8),
|
||||
val & 0xff);
|
||||
}
|
||||
|
||||
static const struct iio_info mcp4531_info = {
|
||||
.read_raw = mcp4531_read_raw,
|
||||
.write_raw = mcp4531_write_raw,
|
||||
.driver_module = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int mcp4531_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct device *dev = &client->dev;
|
||||
unsigned long devid = id->driver_data;
|
||||
struct mcp4531_data *data;
|
||||
struct iio_dev *indio_dev;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_WORD_DATA)) {
|
||||
dev_err(dev, "SMBUS Word Data not supported\n");
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
data = iio_priv(indio_dev);
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
data->client = client;
|
||||
data->devid = devid;
|
||||
|
||||
indio_dev->dev.parent = dev;
|
||||
indio_dev->info = &mcp4531_info;
|
||||
indio_dev->channels = mcp4531_channels;
|
||||
indio_dev->num_channels = mcp4531_cfg[devid].wipers;
|
||||
indio_dev->name = client->name;
|
||||
|
||||
return devm_iio_device_register(dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct i2c_device_id mcp4531_id[] = {
|
||||
{ "mcp4531-502", MCP453x_502 },
|
||||
{ "mcp4531-103", MCP453x_103 },
|
||||
{ "mcp4531-503", MCP453x_503 },
|
||||
{ "mcp4531-104", MCP453x_104 },
|
||||
{ "mcp4532-502", MCP453x_502 },
|
||||
{ "mcp4532-103", MCP453x_103 },
|
||||
{ "mcp4532-503", MCP453x_503 },
|
||||
{ "mcp4532-104", MCP453x_104 },
|
||||
{ "mcp4551-502", MCP455x_502 },
|
||||
{ "mcp4551-103", MCP455x_103 },
|
||||
{ "mcp4551-503", MCP455x_503 },
|
||||
{ "mcp4551-104", MCP455x_104 },
|
||||
{ "mcp4552-502", MCP455x_502 },
|
||||
{ "mcp4552-103", MCP455x_103 },
|
||||
{ "mcp4552-503", MCP455x_503 },
|
||||
{ "mcp4552-104", MCP455x_104 },
|
||||
{ "mcp4631-502", MCP463x_502 },
|
||||
{ "mcp4631-103", MCP463x_103 },
|
||||
{ "mcp4631-503", MCP463x_503 },
|
||||
{ "mcp4631-104", MCP463x_104 },
|
||||
{ "mcp4632-502", MCP463x_502 },
|
||||
{ "mcp4632-103", MCP463x_103 },
|
||||
{ "mcp4632-503", MCP463x_503 },
|
||||
{ "mcp4632-104", MCP463x_104 },
|
||||
{ "mcp4651-502", MCP465x_502 },
|
||||
{ "mcp4651-103", MCP465x_103 },
|
||||
{ "mcp4651-503", MCP465x_503 },
|
||||
{ "mcp4651-104", MCP465x_104 },
|
||||
{ "mcp4652-502", MCP465x_502 },
|
||||
{ "mcp4652-103", MCP465x_103 },
|
||||
{ "mcp4652-503", MCP465x_503 },
|
||||
{ "mcp4652-104", MCP465x_104 },
|
||||
{}
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, mcp4531_id);
|
||||
|
||||
static struct i2c_driver mcp4531_driver = {
|
||||
.driver = {
|
||||
.name = "mcp4531",
|
||||
},
|
||||
.probe = mcp4531_probe,
|
||||
.id_table = mcp4531_id,
|
||||
};
|
||||
|
||||
module_i2c_driver(mcp4531_driver);
|
||||
|
||||
MODULE_AUTHOR("Peter Rosin <peda@axentia.se>");
|
||||
MODULE_DESCRIPTION("MCP4531 digital potentiometer");
|
||||
MODULE_LICENSE("GPL");
|
|
@ -79,6 +79,19 @@ config MS5611_SPI
|
|||
To compile this driver as a module, choose M here: the module will
|
||||
be called ms5611_spi.
|
||||
|
||||
config MS5637
|
||||
tristate "Measurement Specialties MS5637 pressure & temperature sensor"
|
||||
depends on I2C
|
||||
select IIO_MS_SENSORS_I2C
|
||||
help
|
||||
If you say yes here you get support for the Measurement Specialties
|
||||
MS5637 pressure and temperature sensor.
|
||||
This driver is also used for MS8607 temperature, pressure & humidity
|
||||
sensor
|
||||
|
||||
This driver can also be built as a module. If so, the module will
|
||||
be called ms5637.
|
||||
|
||||
config IIO_ST_PRESS
|
||||
tristate "STMicroelectronics pressure sensor Driver"
|
||||
depends on (I2C || SPI_MASTER) && SYSFS
|
||||
|
|
|
@ -10,6 +10,7 @@ obj-$(CONFIG_MPL3115) += mpl3115.o
|
|||
obj-$(CONFIG_MS5611) += ms5611_core.o
|
||||
obj-$(CONFIG_MS5611_I2C) += ms5611_i2c.o
|
||||
obj-$(CONFIG_MS5611_SPI) += ms5611_spi.o
|
||||
obj-$(CONFIG_MS5637) += ms5637.o
|
||||
obj-$(CONFIG_IIO_ST_PRESS) += st_pressure.o
|
||||
st_pressure-y := st_pressure_core.o
|
||||
st_pressure-$(CONFIG_IIO_BUFFER) += st_pressure_buffer.o
|
||||
|
|
190
drivers/iio/pressure/ms5637.c
Normal file
190
drivers/iio/pressure/ms5637.c
Normal file
|
@ -0,0 +1,190 @@
|
|||
/*
|
||||
* ms5637.c - Support for Measurement-Specialties ms5637 and ms8607
|
||||
* pressure & temperature sensor
|
||||
*
|
||||
* Copyright (c) 2015 Measurement-Specialties
|
||||
*
|
||||
* Licensed under the GPL-2.
|
||||
*
|
||||
* (7-bit I2C slave address 0x76)
|
||||
*
|
||||
* Datasheet:
|
||||
* http://www.meas-spec.com/downloads/MS5637-02BA03.pdf
|
||||
* Datasheet:
|
||||
* http://www.meas-spec.com/downloads/MS8607-02BA01.pdf
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/iio/iio.h>
|
||||
#include <linux/iio/sysfs.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
#include "../common/ms_sensors/ms_sensors_i2c.h"
|
||||
|
||||
static const int ms5637_samp_freq[6] = { 960, 480, 240, 120, 60, 30 };
|
||||
/* String copy of the above const for readability purpose */
|
||||
static const char ms5637_show_samp_freq[] = "960 480 240 120 60 30";
|
||||
|
||||
static int ms5637_read_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *channel, int *val,
|
||||
int *val2, long mask)
|
||||
{
|
||||
int ret;
|
||||
int temperature;
|
||||
unsigned int pressure;
|
||||
struct ms_tp_dev *dev_data = iio_priv(indio_dev);
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_PROCESSED:
|
||||
ret = ms_sensors_read_temp_and_pressure(dev_data,
|
||||
&temperature,
|
||||
&pressure);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
switch (channel->type) {
|
||||
case IIO_TEMP: /* in milli °C */
|
||||
*val = temperature;
|
||||
|
||||
return IIO_VAL_INT;
|
||||
case IIO_PRESSURE: /* in kPa */
|
||||
*val = pressure / 1000;
|
||||
*val2 = (pressure % 1000) * 1000;
|
||||
|
||||
return IIO_VAL_INT_PLUS_MICRO;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||
*val = ms5637_samp_freq[dev_data->res_index];
|
||||
|
||||
return IIO_VAL_INT;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static int ms5637_write_raw(struct iio_dev *indio_dev,
|
||||
struct iio_chan_spec const *chan,
|
||||
int val, int val2, long mask)
|
||||
{
|
||||
struct ms_tp_dev *dev_data = iio_priv(indio_dev);
|
||||
int i;
|
||||
|
||||
switch (mask) {
|
||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||
i = ARRAY_SIZE(ms5637_samp_freq);
|
||||
while (i-- > 0)
|
||||
if (val == ms5637_samp_freq[i])
|
||||
break;
|
||||
if (i < 0)
|
||||
return -EINVAL;
|
||||
dev_data->res_index = i;
|
||||
|
||||
return 0;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct iio_chan_spec ms5637_channels[] = {
|
||||
{
|
||||
.type = IIO_TEMP,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ),
|
||||
},
|
||||
{
|
||||
.type = IIO_PRESSURE,
|
||||
.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
|
||||
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ),
|
||||
}
|
||||
};
|
||||
|
||||
static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(ms5637_show_samp_freq);
|
||||
|
||||
static struct attribute *ms5637_attributes[] = {
|
||||
&iio_const_attr_sampling_frequency_available.dev_attr.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group ms5637_attribute_group = {
|
||||
.attrs = ms5637_attributes,
|
||||
};
|
||||
|
||||
static const struct iio_info ms5637_info = {
|
||||
.read_raw = ms5637_read_raw,
|
||||
.write_raw = ms5637_write_raw,
|
||||
.attrs = &ms5637_attribute_group,
|
||||
.driver_module = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int ms5637_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct ms_tp_dev *dev_data;
|
||||
struct iio_dev *indio_dev;
|
||||
int ret;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_READ_WORD_DATA |
|
||||
I2C_FUNC_SMBUS_WRITE_BYTE |
|
||||
I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
|
||||
dev_err(&client->dev,
|
||||
"Adapter does not support some i2c transaction\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*dev_data));
|
||||
if (!indio_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
dev_data = iio_priv(indio_dev);
|
||||
dev_data->client = client;
|
||||
dev_data->res_index = 5;
|
||||
mutex_init(&dev_data->lock);
|
||||
|
||||
indio_dev->info = &ms5637_info;
|
||||
indio_dev->name = id->name;
|
||||
indio_dev->dev.parent = &client->dev;
|
||||
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||
indio_dev->channels = ms5637_channels;
|
||||
indio_dev->num_channels = ARRAY_SIZE(ms5637_channels);
|
||||
|
||||
i2c_set_clientdata(client, indio_dev);
|
||||
|
||||
ret = ms_sensors_reset(client, 0x1E, 3000);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = ms_sensors_tp_read_prom(dev_data);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return devm_iio_device_register(&client->dev, indio_dev);
|
||||
}
|
||||
|
||||
static const struct i2c_device_id ms5637_id[] = {
|
||||
{"ms5637", 0},
|
||||
{"ms8607-temppressure", 1},
|
||||
{}
|
||||
};
|
||||
|
||||
static struct i2c_driver ms5637_driver = {
|
||||
.probe = ms5637_probe,
|
||||
.id_table = ms5637_id,
|
||||
.driver = {
|
||||
.name = "ms5637"
|
||||
},
|
||||
};
|
||||
|
||||
module_i2c_driver(ms5637_driver);
|
||||
|
||||
MODULE_DESCRIPTION("Measurement-Specialties ms5637 temperature & pressure driver");
|
||||
MODULE_AUTHOR("William Markezana <william.markezana@meas-spec.com>");
|
||||
MODULE_AUTHOR("Ludovic Tancerel <ludovic.tancerel@maplehightech.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
|
@ -400,6 +400,7 @@ static const struct iio_info press_info = {
|
|||
.attrs = &st_press_attribute_group,
|
||||
.read_raw = &st_press_read_raw,
|
||||
.write_raw = &st_press_write_raw,
|
||||
.debugfs_reg_access = &st_sensors_debugfs_reg_access,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_IIO_TRIGGER
|
||||
|
|
|
@ -20,6 +20,18 @@ endmenu
|
|||
|
||||
menu "Proximity sensors"
|
||||
|
||||
config LIDAR_LITE_V2
|
||||
tristate "PulsedLight LIDAR sensor"
|
||||
select IIO_BUFFER
|
||||
select IIO_TRIGGERED_BUFFER
|
||||
depends on I2C
|
||||
help
|
||||
Say Y to build a driver for PulsedLight LIDAR range finding
|
||||
sensor.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called pulsedlight-lite-v2
|
||||
|
||||
config SX9500
|
||||
tristate "SX9500 Semtech proximity sensor"
|
||||
select IIO_BUFFER
|
||||
|
|
|
@ -4,4 +4,5 @@
|
|||
|
||||
# When adding new entries keep the list in alphabetical order
|
||||
obj-$(CONFIG_AS3935) += as3935.o
|
||||
obj-$(CONFIG_LIDAR_LITE_V2) += pulsedlight-lidar-lite-v2.o
|
||||
obj-$(CONFIG_SX9500) += sx9500.o
|
||||
|
|
|
@ -434,6 +434,12 @@ static int as3935_remove(struct spi_device *spi)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id as3935_of_match[] = {
|
||||
{ .compatible = "ams,as3935", },
|
||||
{ /* sentinel */ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, as3935_of_match);
|
||||
|
||||
static const struct spi_device_id as3935_id[] = {
|
||||
{"as3935", 0},
|
||||
{},
|
||||
|
@ -443,6 +449,7 @@ MODULE_DEVICE_TABLE(spi, as3935_id);
|
|||
static struct spi_driver as3935_driver = {
|
||||
.driver = {
|
||||
.name = "as3935",
|
||||
.of_match_table = of_match_ptr(as3935_of_match),
|
||||
.owner = THIS_MODULE,
|
||||
.pm = AS3935_PM_OPS,
|
||||
},
|
||||
|
|
Some files were not shown because too many files have changed in this diff Show more
Loading…
Reference in a new issue