From patchwork Tue Feb 5 17:43:29 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rui Miguel Silva X-Patchwork-Id: 10797913 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 38E4A746 for ; Tue, 5 Feb 2019 17:43:52 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 28FC82C676 for ; Tue, 5 Feb 2019 17:43:52 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 245242C69D; Tue, 5 Feb 2019 17:43:52 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id C662E2C676 for ; Tue, 5 Feb 2019 17:43:51 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726742AbfBERnv (ORCPT ); Tue, 5 Feb 2019 12:43:51 -0500 Received: from mail-wr1-f66.google.com ([209.85.221.66]:37525 "EHLO mail-wr1-f66.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1728614AbfBERnv (ORCPT ); Tue, 5 Feb 2019 12:43:51 -0500 Received: by mail-wr1-f66.google.com with SMTP id s12so4614788wrt.4 for ; Tue, 05 Feb 2019 09:43:50 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=ERTGWcj2mXhrs1MM5n+vI6FIpImhaTERquVn+K2Zjrc=; b=X/1RzFo9umi69PDUybyvJ2T04C1op+H6HZMzjMexVLQNCGfMomxfkr4xM9L0QVnRnJ b/0mlHXHOXD/dnZXucCjOv2u3Xa4KExxO3IClyioYogd9G/Rc7vMhJb6D52LPyHAQTwA FdlUlg5brXcZX6tunn5F4sba8bZImt4IHpD5yFeEDxvK055I4NN9GLxUNnJWuFh6IOHG 8SvvFPmiDOJDIvMJT9rZX3QvBrObdmhgK/3FbYhgfr/nH0hhmaeHDkTy5zXB2DPLgHHd OSiJSZERNJ4vOaxrquS6JqH2zJP0SDLgxwmtz+6UamsXeWRx5eu9PiB61alelf+Gcd7o qPvA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=ERTGWcj2mXhrs1MM5n+vI6FIpImhaTERquVn+K2Zjrc=; b=msjFuEFOX/SE330SnsiULg2pZElDbNQiu1XE9PO23PUwVcQcga5o9c4Qqwudog0enp 8+tSvvE8yhaiUvKliV24E+vP1MPjyJ0scG9JsjTf6/gct2CNikWWFCo7ujv6ByiIc0Xt QVORHf2gc6T9BQ+tA6wznCZ12/whw92YSJQ8ILpIy3qfNOPSPWlESRk0BH9Bu2kBo3Am Im9DiLymNoW2klsbLjg6FlHR3wzticpgbUg2HHaySj5++ZwkO+msdXHmUTeB6L+GFObI xE1dbJ5adCJMR81M31qaAvju1cSxygy0dSrRahOIllaiNyhq1r4/FfhXcL4f59qRoLWj /alA== X-Gm-Message-State: AHQUAuazm19DVfse2tK/eSOAS4WoSrl02WTEp6y2/htMfYWx8aQak6OY QD2zn4zzAGNX+pdWvipu5Yo+uQ== X-Google-Smtp-Source: AHgI3IYsLlDP1PrNUAGXtEXqWLtsHcZGdKKF0lp2s0hYJ9jerJk4hT1j7QG3a460mnTTgTLDA8ss3A== X-Received: by 2002:a5d:4a85:: with SMTP id o5mr4674567wrq.54.1549388629255; Tue, 05 Feb 2019 09:43:49 -0800 (PST) Received: from arch-late.local (a109-49-46-234.cpe.netcabo.pt. [109.49.46.234]) by smtp.gmail.com with ESMTPSA id s132sm12225751wmf.28.2019.02.05.09.43.48 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Tue, 05 Feb 2019 09:43:48 -0800 (PST) From: Rui Miguel Silva To: Jonathan Cameron , Hartmut Knaack , Lars-Peter Clausen , Peter Meerwald-Stadler , Shawn Guo , Rob Herring , Fabio Estevam Cc: linux-iio@vger.kernel.org, devicetree@vger.kernel.org, Rui Miguel Silva Subject: [PATCH v2 1/5] iio: gyro: add DT bindings to fxas21002 Date: Tue, 5 Feb 2019 17:43:29 +0000 Message-Id: <20190205174333.17672-2-rui.silva@linaro.org> X-Mailer: git-send-email 2.20.1 In-Reply-To: <20190205174333.17672-1-rui.silva@linaro.org> References: <20190205174333.17672-1-rui.silva@linaro.org> MIME-Version: 1.0 Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Add device tree bindings for the FXAS21002 gyroscope. Signed-off-by: Rui Miguel Silva Reviewed-by: Rob Herring --- .../bindings/iio/gyroscope/fxas2100x.txt | 18 ++++++++++++++++++ 1 file changed, 18 insertions(+) create mode 100644 Documentation/devicetree/bindings/iio/gyroscope/fxas2100x.txt diff --git a/Documentation/devicetree/bindings/iio/gyroscope/fxas2100x.txt b/Documentation/devicetree/bindings/iio/gyroscope/fxas2100x.txt new file mode 100644 index 000000000000..df10a60aa533 --- /dev/null +++ b/Documentation/devicetree/bindings/iio/gyroscope/fxas2100x.txt @@ -0,0 +1,18 @@ +* NXP FXAS2100X Gyroscope device tree bindings + +http://www.nxp.com/products/sensors/gyroscopes/3-axis-digital-gyroscope:FXAS21002C + +Required properties: + - compatible : should be "nxp,fxas21002" + - reg : the I2C address of the sensor + - vdd-supply: phandle to the regulator that provides power to the sensor. + - vddio-supply: phandle to the regulator that provides power to the bus. + +Example: + +fxas21002@20 { + compatible = "nxp,fxas21002"; + reg = <0x20>; + vdd-supply = <®_peri_3p15v>; + vddio-supply = <®_peri_3p15v>; +}; From patchwork Tue Feb 5 17:43:30 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rui Miguel Silva X-Patchwork-Id: 10797919 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 3B166746 for ; Tue, 5 Feb 2019 17:43:59 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 29A692C69D for ; Tue, 5 Feb 2019 17:43:59 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 279F32C714; Tue, 5 Feb 2019 17:43:59 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 42A262A97F for ; Tue, 5 Feb 2019 17:43:57 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1728614AbfBERn4 (ORCPT ); Tue, 5 Feb 2019 12:43:56 -0500 Received: from mail-wm1-f67.google.com ([209.85.128.67]:35865 "EHLO mail-wm1-f67.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727969AbfBERn4 (ORCPT ); Tue, 5 Feb 2019 12:43:56 -0500 Received: by mail-wm1-f67.google.com with SMTP id p6so4636471wmc.1 for ; Tue, 05 Feb 2019 09:43:53 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=4enINrP4BD78y/Jm1yA3obRtES69JlbFA+Rqq63Qn3A=; b=K4hRj681f1Fw2WbiwgObNQOtlG+iWZXFx9iYExMajT9KyPWkHsgCAtFEth/cmHCxRW 7Zni7jTtTbImfGWIDr+jHj216YRvQbOQVTxXoXA3ojc575r7ElnrCsDMSPY4KpKCZWM/ t0UOjCawEGrsjNCmB9nkXoV98E2EE+CU7eZaYmlEVpZxTRYCIWCBtiqdEom8IprRqz3+ G1ITua2UKDxnDRYumUcHIPXRAVm5G+FRCFTXq61IHbujHQ73UmT23TexiM8nH7dQabSd tP0UUDaS38h+LXyVxzBDY1Vh6Vcx03sXL0FbizGPmK06Z4vnOZsa1PF889WG8pjJDw1Z yJ9g== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=4enINrP4BD78y/Jm1yA3obRtES69JlbFA+Rqq63Qn3A=; b=AxiAn6ITAhCleEr2fgO16TPpsWHGq1rFbyAdF0EoSSosOoxMJyB8An7ucUg6GY2uGB QbmCX5ym4m0nJ+hBN5xfgOcMDwBpbYv2wnWJdMnwHnKhpX4daXa54Idhx59Ov1O+PiKS /73L0iC0Vjfnk4liJov7qBZEwk9LTDHk2GCRMTLHMHAnrERV3x3mUnXP4LlJJl9X/rUm Ca3Cg7+kE/7Hdvu+IApoKTh8jwkno+Wpjm94DRvLgHjwfvtY7p0FhgboMndNW8/Kf3lR cRze17QfoxlQv/5makW68rtbBPMTWPf1wS1FzayOeeuHV/+4WpCfZ0XfRaNbAqIw46gU NRiQ== X-Gm-Message-State: AHQUAubhSqx9EGRH7P6+3QWAQu0nWT1OpkdkySMY70j4LbKWxUeyhF2l WG/1s3cQfXdqlRYxOh4HkYZKhg== X-Google-Smtp-Source: AHgI3IasCQIbFx59B6kHd7rbQvD5OwMOiZsbhMTIfjalwfGyumeJsudVBUwsnfw5juXc4e7+Mg7h1w== X-Received: by 2002:a7b:cc86:: with SMTP id p6mr4536668wma.19.1549388631716; Tue, 05 Feb 2019 09:43:51 -0800 (PST) Received: from arch-late.local (a109-49-46-234.cpe.netcabo.pt. [109.49.46.234]) by smtp.gmail.com with ESMTPSA id s132sm12225751wmf.28.2019.02.05.09.43.50 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Tue, 05 Feb 2019 09:43:51 -0800 (PST) From: Rui Miguel Silva To: Jonathan Cameron , Hartmut Knaack , Lars-Peter Clausen , Peter Meerwald-Stadler , Shawn Guo , Rob Herring , Fabio Estevam Cc: linux-iio@vger.kernel.org, devicetree@vger.kernel.org, Rui Miguel Silva Subject: [PATCH v2 2/5] iio: gyro: fxas2100x: add core driver for fxas2100x gyroscope Date: Tue, 5 Feb 2019 17:43:30 +0000 Message-Id: <20190205174333.17672-3-rui.silva@linaro.org> X-Mailer: git-send-email 2.20.1 In-Reply-To: <20190205174333.17672-1-rui.silva@linaro.org> References: <20190205174333.17672-1-rui.silva@linaro.org> MIME-Version: 1.0 Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP This adds core support for the NXP fxas2100x Tri-axis gyroscope, using the iio subsystem. It supports PM operations, axis reading, temperature, scale factor of the axis, high pass and low pass filtering, and sampling frequency selection. It will have extras modules to support the communication over i2c and spi. Signed-off-by: Rui Miguel Silva --- drivers/iio/gyro/Kconfig | 11 + drivers/iio/gyro/Makefile | 1 + drivers/iio/gyro/fxas2100x.h | 151 +++++ drivers/iio/gyro/fxas2100x_core.c | 931 ++++++++++++++++++++++++++++++ 4 files changed, 1094 insertions(+) create mode 100644 drivers/iio/gyro/fxas2100x.h create mode 100644 drivers/iio/gyro/fxas2100x_core.c diff --git a/drivers/iio/gyro/Kconfig b/drivers/iio/gyro/Kconfig index 3126cf05e6b9..c168aa63de3b 100644 --- a/drivers/iio/gyro/Kconfig +++ b/drivers/iio/gyro/Kconfig @@ -73,6 +73,17 @@ config BMG160_SPI tristate select REGMAP_SPI +config FXAS2100X + tristate "NXP FXAS2100X Gyro Sensor" + select IIO_BUFFER + select IIO_TRIGGERED_BUFFER + help + Say yes here to build support for NXP FXAS2100X family Tri-axis Gyro + Sensor driver connected via I2C or SPI. + + This driver can also be built as a module. If so, the module + will be called fxas2100x_i2c or fxas2100x_spi. + config HID_SENSOR_GYRO_3D depends on HID_SENSOR_HUB select IIO_BUFFER diff --git a/drivers/iio/gyro/Makefile b/drivers/iio/gyro/Makefile index 295ec780c4eb..9e2395185a6e 100644 --- a/drivers/iio/gyro/Makefile +++ b/drivers/iio/gyro/Makefile @@ -12,6 +12,7 @@ obj-$(CONFIG_ADXRS450) += adxrs450.o obj-$(CONFIG_BMG160) += bmg160_core.o obj-$(CONFIG_BMG160_I2C) += bmg160_i2c.o obj-$(CONFIG_BMG160_SPI) += bmg160_spi.o +obj-$(CONFIG_FXAS2100X) += fxas2100x_core.o obj-$(CONFIG_HID_SENSOR_GYRO_3D) += hid-sensor-gyro-3d.o diff --git a/drivers/iio/gyro/fxas2100x.h b/drivers/iio/gyro/fxas2100x.h new file mode 100644 index 000000000000..2b503196337f --- /dev/null +++ b/drivers/iio/gyro/fxas2100x.h @@ -0,0 +1,151 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Driver for NXP FXAS2100x Gyroscope - Header + * + * Copyright (C) 2019 Linaro Ltd. + * + */ + +#ifndef FXAS2100X_H_ +#define FXAS2100X_H_ + +#include + +#define FXAS2100X_REG_STATUS 0x00 +#define FXAS2100X_REG_OUT_X_MSB 0x01 +#define FXAS2100X_REG_OUT_X_LSB 0x02 +#define FXAS2100X_REG_OUT_Y_MSB 0x03 +#define FXAS2100X_REG_OUT_Y_LSB 0x04 +#define FXAS2100X_REG_OUT_Z_MSB 0x05 +#define FXAS2100X_REG_OUT_Z_LSB 0x06 +#define FXAS2100X_REG_DR_STATUS 0x07 +#define FXAS2100X_REG_F_STATUS 0x08 +#define FXAS2100X_REG_F_SETUP 0x09 +#define FXAS2100X_REG_F_EVENT 0x0A +#define FXAS2100X_REG_INT_SRC_FLAG 0x0B +#define FXAS2100X_REG_WHO_AM_I 0x0C +#define FXAS2100X_REG_CTRL0 0x0D +#define FXAS2100X_REG_RT_CFG 0x0E +#define FXAS2100X_REG_RT_SRC 0x0F +#define FXAS2100X_REG_RT_THS 0x10 +#define FXAS2100X_REG_RT_COUNT 0x11 +#define FXAS2100X_REG_TEMP 0x12 +#define FXAS2100X_REG_CTRL1 0x13 +#define FXAS2100X_REG_CTRL2 0x14 +#define FXAS2100X_REG_CTRL3 0x15 + +enum fxas2100x_fields { + F_DR_STATUS, + F_OUT_X_MSB, + F_OUT_X_LSB, + F_OUT_Y_MSB, + F_OUT_Y_LSB, + F_OUT_Z_MSB, + F_OUT_Z_LSB, + /* DR_STATUS */ + F_ZYX_OW, F_Z_OW, F_Y_OW, F_X_OW, F_ZYX_DR, F_Z_DR, F_Y_DR, F_X_DR, + /* F_STATUS */ + F_OVF, F_WMKF, F_CNT, + /* F_SETUP */ + F_MODE, F_WMRK, + /* F_EVENT */ + F_EVENT, FE_TIME, + /* INT_SOURCE_FLAG */ + F_BOOTEND, F_SRC_FIFO, F_SRC_RT, F_SRC_DRDY, + /* WHO_AM_I */ + F_WHO_AM_I, + /* CTRL_REG0 */ + F_BW, F_SPIW, F_SEL, F_HPF_EN, F_FS, + /* RT_CFG */ + F_ELE, F_ZTEFE, F_YTEFE, F_XTEFE, + /* RT_SRC */ + F_EA, F_ZRT, F_ZRT_POL, F_YRT, F_YRT_POL, F_XRT, F_XRT_POL, + /* RT_THS */ + F_DBCNTM, F_THS, + /* RT_COUNT */ + F_RT_COUNT, + /* TEMP */ + F_TEMP, + /* CTRL_REG1 */ + F_RST, F_ST, F_DR, F_ACTIVE, F_READY, + /* CTRL_REG2 */ + F_INT_CFG_FIFO, F_INT_EN_FIFO, F_INT_CFG_RT, F_INT_EN_RT, + F_INT_CFG_DRDY, F_INT_EN_DRDY, F_IPOL, F_PP_OD, + /* CTRL_REG3 */ + F_WRAPTOONE, F_EXTCTRLEN, F_FS_DOUBLE, + /* MAX FIELDS */ + F_MAX_FIELDS, +}; + +static const struct reg_field fxas2100x_reg_fields[] = { + [F_DR_STATUS] = REG_FIELD(FXAS2100X_REG_STATUS, 0, 7), + [F_OUT_X_MSB] = REG_FIELD(FXAS2100X_REG_OUT_X_MSB, 0, 7), + [F_OUT_X_LSB] = REG_FIELD(FXAS2100X_REG_OUT_X_LSB, 0, 7), + [F_OUT_Y_MSB] = REG_FIELD(FXAS2100X_REG_OUT_Y_MSB, 0, 7), + [F_OUT_Y_LSB] = REG_FIELD(FXAS2100X_REG_OUT_Y_LSB, 0, 7), + [F_OUT_Z_MSB] = REG_FIELD(FXAS2100X_REG_OUT_Z_MSB, 0, 7), + [F_OUT_Z_LSB] = REG_FIELD(FXAS2100X_REG_OUT_Z_LSB, 0, 7), + [F_ZYX_OW] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 7, 7), + [F_Z_OW] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 6, 6), + [F_Y_OW] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 5, 5), + [F_X_OW] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 4, 4), + [F_ZYX_DR] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 3, 3), + [F_Z_DR] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 2, 2), + [F_Y_DR] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 1, 1), + [F_X_DR] = REG_FIELD(FXAS2100X_REG_DR_STATUS, 0, 0), + [F_OVF] = REG_FIELD(FXAS2100X_REG_F_STATUS, 7, 7), + [F_WMKF] = REG_FIELD(FXAS2100X_REG_F_STATUS, 6, 6), + [F_CNT] = REG_FIELD(FXAS2100X_REG_F_STATUS, 0, 5), + [F_MODE] = REG_FIELD(FXAS2100X_REG_F_SETUP, 6, 7), + [F_WMRK] = REG_FIELD(FXAS2100X_REG_F_SETUP, 0, 5), + [F_EVENT] = REG_FIELD(FXAS2100X_REG_F_EVENT, 5, 5), + [FE_TIME] = REG_FIELD(FXAS2100X_REG_F_EVENT, 0, 4), + [F_BOOTEND] = REG_FIELD(FXAS2100X_REG_INT_SRC_FLAG, 3, 3), + [F_SRC_FIFO] = REG_FIELD(FXAS2100X_REG_INT_SRC_FLAG, 2, 2), + [F_SRC_RT] = REG_FIELD(FXAS2100X_REG_INT_SRC_FLAG, 1, 1), + [F_SRC_DRDY] = REG_FIELD(FXAS2100X_REG_INT_SRC_FLAG, 0, 0), + [F_WHO_AM_I] = REG_FIELD(FXAS2100X_REG_WHO_AM_I, 0, 7), + [F_BW] = REG_FIELD(FXAS2100X_REG_CTRL0, 6, 7), + [F_SPIW] = REG_FIELD(FXAS2100X_REG_CTRL0, 5, 5), + [F_SEL] = REG_FIELD(FXAS2100X_REG_CTRL0, 3, 4), + [F_HPF_EN] = REG_FIELD(FXAS2100X_REG_CTRL0, 2, 2), + [F_FS] = REG_FIELD(FXAS2100X_REG_CTRL0, 0, 1), + [F_ELE] = REG_FIELD(FXAS2100X_REG_RT_CFG, 3, 3), + [F_ZTEFE] = REG_FIELD(FXAS2100X_REG_RT_CFG, 2, 2), + [F_YTEFE] = REG_FIELD(FXAS2100X_REG_RT_CFG, 1, 1), + [F_XTEFE] = REG_FIELD(FXAS2100X_REG_RT_CFG, 0, 0), + [F_EA] = REG_FIELD(FXAS2100X_REG_RT_SRC, 6, 6), + [F_ZRT] = REG_FIELD(FXAS2100X_REG_RT_SRC, 5, 5), + [F_ZRT_POL] = REG_FIELD(FXAS2100X_REG_RT_SRC, 4, 4), + [F_YRT] = REG_FIELD(FXAS2100X_REG_RT_SRC, 3, 3), + [F_YRT_POL] = REG_FIELD(FXAS2100X_REG_RT_SRC, 2, 2), + [F_XRT] = REG_FIELD(FXAS2100X_REG_RT_SRC, 1, 1), + [F_XRT_POL] = REG_FIELD(FXAS2100X_REG_RT_SRC, 0, 0), + [F_DBCNTM] = REG_FIELD(FXAS2100X_REG_RT_THS, 7, 7), + [F_THS] = REG_FIELD(FXAS2100X_REG_RT_SRC, 0, 6), + [F_RT_COUNT] = REG_FIELD(FXAS2100X_REG_RT_COUNT, 0, 7), + [F_TEMP] = REG_FIELD(FXAS2100X_REG_TEMP, 0, 7), + [F_RST] = REG_FIELD(FXAS2100X_REG_CTRL1, 6, 6), + [F_ST] = REG_FIELD(FXAS2100X_REG_CTRL1, 5, 5), + [F_DR] = REG_FIELD(FXAS2100X_REG_CTRL1, 2, 4), + [F_ACTIVE] = REG_FIELD(FXAS2100X_REG_CTRL1, 1, 1), + [F_READY] = REG_FIELD(FXAS2100X_REG_CTRL1, 0, 0), + [F_INT_CFG_FIFO] = REG_FIELD(FXAS2100X_REG_CTRL2, 7, 7), + [F_INT_EN_FIFO] = REG_FIELD(FXAS2100X_REG_CTRL2, 6, 6), + [F_INT_CFG_RT] = REG_FIELD(FXAS2100X_REG_CTRL2, 5, 5), + [F_INT_EN_RT] = REG_FIELD(FXAS2100X_REG_CTRL2, 4, 4), + [F_INT_CFG_DRDY] = REG_FIELD(FXAS2100X_REG_CTRL2, 3, 3), + [F_INT_EN_DRDY] = REG_FIELD(FXAS2100X_REG_CTRL2, 2, 2), + [F_IPOL] = REG_FIELD(FXAS2100X_REG_CTRL2, 1, 1), + [F_PP_OD] = REG_FIELD(FXAS2100X_REG_CTRL2, 0, 0), + [F_WRAPTOONE] = REG_FIELD(FXAS2100X_REG_CTRL3, 3, 3), + [F_EXTCTRLEN] = REG_FIELD(FXAS2100X_REG_CTRL3, 2, 2), + [F_FS_DOUBLE] = REG_FIELD(FXAS2100X_REG_CTRL3, 0, 0), +}; + +extern const struct dev_pm_ops fxas2100x_pm_ops; + +int fxas2100x_core_probe(struct device *dev, struct regmap *regmap, int irq, + const char *name); +void fxas2100x_core_remove(struct device *dev); +#endif diff --git a/drivers/iio/gyro/fxas2100x_core.c b/drivers/iio/gyro/fxas2100x_core.c new file mode 100644 index 000000000000..9c0ba283fea8 --- /dev/null +++ b/drivers/iio/gyro/fxas2100x_core.c @@ -0,0 +1,931 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for NXP FXAS2100x Gyroscope - Core + * + * Copyright (C) 2019 Linaro Ltd. + * + */ + +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include + +#include "fxas2100x.h" + +#define FXAS21002_CHIP_ID_1 0xD6 +#define FXAS21002_CHIP_ID_2 0xD7 + +enum fxas2100x_mode_state { + FXAS2100X_MODE_STANDBY, + FXAS2100X_MODE_READY, + FXAS2100X_MODE_ACTIVE, +}; + +#define FXAS2100X_STANDBY_ACTIVE_TIME_MS 62 +#define FXAS2100X_READY_ACTIVE_TIME_MS 7 + +#define FXAS2100X_ODR_LIST_MAX 10 + +#define FXAS2100X_SCALE_FRACTIONAL 32 +#define FXAS2100X_RANGE_LIMIT_DOUBLE 2000 + +#define FXAS2100X_AXIS_TO_REG(axis) (FXAS2100X_REG_OUT_X_MSB + ((axis) * 2)) + +static const int fxas2100x_odr_values[] = { + 800, 400, 200, 100, 50, 25, 12, 12 +}; + +/* + * These values are taken from the low-pass filter cutoff frequency calculated + * ODR * 0.lpf_values. So, for ODR = 800Hz with a lpf value = 0.32 + * => LPF cutoff frequency = 800 * 0.32 = 256 Hz + */ +static const int fxas2100x_lpf_values[] = { + 32, 16, 8 +}; + +/* + * These values are taken from the high-pass filter cutoff frequency calculated + * ODR * 0.0hpf_values. So, for ODR = 800Hz with a hpf value = 0.018750 + * => HPF cutoff frequency = 800 * 0.018750 = 15 Hz + */ +static const int fxas2100x_hpf_values[] = { + 18750, 9625, 4875, 2475 +}; + +static const int fxas2100x_range_values[] = { + 4000, 2000, 1000, 500, 250 +}; + +struct fxas2100x_data { + u8 chip_id; + enum fxas2100x_mode_state mode; + enum fxas2100x_mode_state prev_mode; + + struct mutex lock; /* serialize data access */ + struct regmap *regmap; + struct regmap_field *regmap_fields[F_MAX_FIELDS]; + s16 buffer[8]; + + struct iio_trigger *dready_trig; + int irq; + + struct regulator *vdd; + struct regulator *vddio; +}; + +enum fxas2100x_channel_index { + CHANNEL_SCAN_INDEX_X, + CHANNEL_SCAN_INDEX_Y, + CHANNEL_SCAN_INDEX_Z, + CHANNEL_SCAN_MAX, +}; + +static int fxas2100x_odr_hz_from_value(struct fxas2100x_data *data, u8 value) +{ + int odr_value_max = ARRAY_SIZE(fxas2100x_odr_values) - 1; + + value = min_t(u8, value, odr_value_max); + + return fxas2100x_odr_values[value]; +} + +static int fxas2100x_odr_value_from_hz(struct fxas2100x_data *data, + unsigned int hz) +{ + int odr_table_size = ARRAY_SIZE(fxas2100x_odr_values); + int i; + + for (i = 0; i < odr_table_size; i++) + if (fxas2100x_odr_values[i] == hz) + return i; + + return -EINVAL; +} + +static int fxas2100x_lpf_bw_from_value(struct fxas2100x_data *data, u8 value) +{ + int lpf_value_max = ARRAY_SIZE(fxas2100x_lpf_values) - 1; + + value = min_t(u8, value, lpf_value_max); + + return fxas2100x_lpf_values[value]; +} + +static int fxas2100x_lpf_value_from_bw(struct fxas2100x_data *data, + unsigned int hz) +{ + int lpf_table_size = ARRAY_SIZE(fxas2100x_lpf_values); + int i; + + for (i = 0; i < lpf_table_size; i++) + if (fxas2100x_lpf_values[i] == hz) + return i; + + return -EINVAL; +} + +static int fxas2100x_hpf_sel_from_value(struct fxas2100x_data *data, u8 value) +{ + int hpf_value_max = ARRAY_SIZE(fxas2100x_hpf_values) - 1; + + value = min_t(u8, value, hpf_value_max); + + return fxas2100x_hpf_values[value]; +} + +static int fxas2100x_hpf_value_from_sel(struct fxas2100x_data *data, + unsigned int hz) +{ + int hpf_table_size = ARRAY_SIZE(fxas2100x_hpf_values); + int i; + + for (i = 0; i < hpf_table_size; i++) + if (fxas2100x_hpf_values[i] == hz) + return i; + + return -EINVAL; +} + +static int fxas2100x_range_fs_from_value(struct fxas2100x_data *data, + u8 value) +{ + int range_value_max = ARRAY_SIZE(fxas2100x_range_values) - 1; + unsigned int fs_double; + int ret; + + /* We need to check if FS_DOUBLE is enabled to offset the value */ + ret = regmap_field_read(data->regmap_fields[F_FS_DOUBLE], &fs_double); + if (ret < 0) + return ret; + + if (!fs_double) + value += 1; + + value = min_t(u8, value, range_value_max); + + return fxas2100x_range_values[value]; +} + +static int fxas2100x_range_value_from_fs(struct fxas2100x_data *data, + unsigned int range) +{ + int range_table_size = ARRAY_SIZE(fxas2100x_range_values); + bool found = false; + int ret; + int i; + + for (i = 0; i < range_table_size; i++) + if (fxas2100x_range_values[i] == range) + found = true; + if (!found) + return -EINVAL; + + if (range > FXAS2100X_RANGE_LIMIT_DOUBLE) + ret = regmap_field_write(data->regmap_fields[F_FS_DOUBLE], 1); + else + ret = regmap_field_write(data->regmap_fields[F_FS_DOUBLE], 0); + if (ret < 0) + return ret; + + return i; +} + +static int fxas2100x_mode_get(struct fxas2100x_data *data) +{ + unsigned int active; + unsigned int ready; + int ret; + + ret = regmap_field_read(data->regmap_fields[F_ACTIVE], &active); + if (ret < 0) + return ret; + if (active) + return FXAS2100X_MODE_ACTIVE; + + ret = regmap_field_read(data->regmap_fields[F_READY], &ready); + if (ret < 0) + return ret; + if (ready) + return FXAS2100X_MODE_READY; + + return FXAS2100X_MODE_STANDBY; +} + +static int fxas2100x_mode_set(struct fxas2100x_data *data, + enum fxas2100x_mode_state mode) +{ + int ret; + + if (mode > FXAS2100X_MODE_ACTIVE) + return -EINVAL; + + if (mode == data->mode) + return 0; + + if (mode == FXAS2100X_MODE_READY) + ret = regmap_field_write(data->regmap_fields[F_READY], 1); + else + ret = regmap_field_write(data->regmap_fields[F_READY], 0); + if (ret < 0) + return ret; + + if (mode == FXAS2100X_MODE_ACTIVE) + ret = regmap_field_write(data->regmap_fields[F_ACTIVE], 1); + else + ret = regmap_field_write(data->regmap_fields[F_ACTIVE], 0); + if (ret < 0) + return ret; + + /* if going to active wait the setup times */ + if (mode == FXAS2100X_MODE_ACTIVE) + if (data->mode == FXAS2100X_MODE_STANDBY) + msleep_interruptible(FXAS2100X_STANDBY_ACTIVE_TIME_MS); + if (data->mode == FXAS2100X_MODE_READY) + msleep_interruptible(FXAS2100X_READY_ACTIVE_TIME_MS); + + data->prev_mode = data->mode; + data->mode = mode; + + return ret; +} + +static int fxas2100x_write(struct fxas2100x_data *data, + enum fxas2100x_fields field, int bits) +{ + int actual_mode; + int ret; + + mutex_lock(&data->lock); + + actual_mode = fxas2100x_mode_get(data); + if (actual_mode < 0) { + ret = actual_mode; + goto out_unlock; + } + + ret = fxas2100x_mode_set(data, FXAS2100X_MODE_READY); + if (ret < 0) + goto out_unlock; + + ret = regmap_field_write(data->regmap_fields[field], bits); + if (ret < 0) + goto out_unlock; + + ret = fxas2100x_mode_set(data, data->prev_mode); + +out_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_pm_get(struct fxas2100x_data *data) +{ + struct device *dev = regmap_get_device(data->regmap); + int ret; + + ret = pm_runtime_get_sync(dev); + if (ret < 0) + pm_runtime_put_noidle(dev); + + return ret; +} + +static int fxas2100x_pm_put(struct fxas2100x_data *data) +{ + struct device *dev = regmap_get_device(data->regmap); + + pm_runtime_mark_last_busy(dev); + + return pm_runtime_put_autosuspend(dev); +} + +static int fxas2100x_temp_get(struct fxas2100x_data *data, int *val) +{ + struct device *dev = regmap_get_device(data->regmap); + unsigned int temp; + int ret; + + mutex_lock(&data->lock); + ret = fxas2100x_pm_get(data); + if (ret < 0) + goto data_unlock; + + ret = regmap_field_read(data->regmap_fields[F_TEMP], &temp); + if (ret < 0) { + dev_err(dev, "failed to read temp: %d\n", ret); + goto data_unlock; + } + + *val = sign_extend32(temp, 7); + + ret = fxas2100x_pm_put(data); + if (ret < 0) + goto data_unlock; + + ret = IIO_VAL_INT; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_axis_get(struct fxas2100x_data *data, int index, int *val) +{ + struct device *dev = regmap_get_device(data->regmap); + __be16 axis_be; + int ret; + + mutex_lock(&data->lock); + ret = fxas2100x_pm_get(data); + if (ret < 0) + goto data_unlock; + + ret = regmap_bulk_read(data->regmap, FXAS2100X_AXIS_TO_REG(index), + &axis_be, sizeof(axis_be)); + if (ret < 0) { + dev_err(dev, "failed to read axis: %d: %d\n", index, ret); + goto data_unlock; + } + + *val = sign_extend32(be16_to_cpu(axis_be), 15); + + ret = fxas2100x_pm_put(data); + if (ret < 0) + goto data_unlock; + + ret = IIO_VAL_INT; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_odr_get(struct fxas2100x_data *data, int *odr) +{ + unsigned int odr_bits; + int ret; + + mutex_lock(&data->lock); + ret = regmap_field_read(data->regmap_fields[F_DR], &odr_bits); + if (ret < 0) + goto data_unlock; + + *odr = fxas2100x_odr_hz_from_value(data, odr_bits); + + ret = IIO_VAL_INT; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_odr_set(struct fxas2100x_data *data, int odr) +{ + int odr_bits; + + odr_bits = fxas2100x_odr_value_from_hz(data, odr); + if (odr_bits < 0) + return odr_bits; + + return fxas2100x_write(data, F_DR, odr_bits); +} + +static int fxas2100x_lpf_get(struct fxas2100x_data *data, int *val2) +{ + unsigned int bw_bits; + int ret; + + mutex_lock(&data->lock); + ret = regmap_field_read(data->regmap_fields[F_BW], &bw_bits); + if (ret < 0) + goto data_unlock; + + *val2 = fxas2100x_lpf_bw_from_value(data, bw_bits) * 10000; + + ret = IIO_VAL_INT_PLUS_MICRO; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_lpf_set(struct fxas2100x_data *data, int bw) +{ + int bw_bits; + int odr; + int ret; + + bw_bits = fxas2100x_lpf_value_from_bw(data, bw); + if (bw_bits < 0) + return bw_bits; + + /* + * From table 33 of the device spec, for ODR = 25Hz and 12.5 value 0.08 + * is not allowed and for ODR = 12.5 value 0.16 is also not allowed + */ + ret = fxas2100x_odr_get(data, &odr); + if (ret < 0) + return -EINVAL; + + if ((odr == 25 && bw_bits > 0x01) || (odr == 12 && bw_bits > 0)) + return -EINVAL; + + return fxas2100x_write(data, F_BW, bw_bits); +} + +static int fxas2100x_hpf_get(struct fxas2100x_data *data, int *val2) +{ + unsigned int sel_bits; + int ret; + + mutex_lock(&data->lock); + ret = regmap_field_read(data->regmap_fields[F_SEL], &sel_bits); + if (ret < 0) + goto data_unlock; + + *val2 = fxas2100x_hpf_sel_from_value(data, sel_bits); + + ret = IIO_VAL_INT_PLUS_MICRO; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_hpf_set(struct fxas2100x_data *data, int sel) +{ + int sel_bits; + + sel_bits = fxas2100x_hpf_value_from_sel(data, sel); + if (sel_bits < 0) + return sel_bits; + + return fxas2100x_write(data, F_SEL, sel_bits); +} + +static int fxas2100x_scale_get(struct fxas2100x_data *data, int *val) +{ + int fs_bits; + int scale; + int ret; + + mutex_lock(&data->lock); + ret = regmap_field_read(data->regmap_fields[F_FS], &fs_bits); + if (ret < 0) + goto data_unlock; + + scale = fxas2100x_range_fs_from_value(data, fs_bits); + + *val = scale; + + ret = IIO_VAL_FRACTIONAL; + +data_unlock: + mutex_unlock(&data->lock); + + return ret; +} + +static int fxas2100x_scale_set(struct fxas2100x_data *data, int range) +{ + int fs_bits; + + fs_bits = fxas2100x_range_value_from_fs(data, range); + if (fs_bits < 0) + return fs_bits; + + return fxas2100x_write(data, F_FS, fs_bits); +} + +static int fxas2100x_read_raw(struct iio_dev *indio_dev, + struct iio_chan_spec const *chan, int *val, + int *val2, long mask) +{ + struct fxas2100x_data *data = iio_priv(indio_dev); + + switch (mask) { + case IIO_CHAN_INFO_RAW: + switch (chan->type) { + case IIO_TEMP: + return fxas2100x_temp_get(data, val); + case IIO_ANGL_VEL: + return fxas2100x_axis_get(data, chan->scan_index, val); + default: + return -EINVAL; + } + case IIO_CHAN_INFO_SCALE: + switch (chan->type) { + case IIO_ANGL_VEL: + *val2 = FXAS2100X_SCALE_FRACTIONAL; + return fxas2100x_scale_get(data, val); + default: + return -EINVAL; + } + case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: + *val = 0; + return fxas2100x_lpf_get(data, val2); + case IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY: + *val = 0; + return fxas2100x_hpf_get(data, val2); + case IIO_CHAN_INFO_SAMP_FREQ: + *val2 = 0; + return fxas2100x_odr_get(data, val); + default: + return -EINVAL; + } +} + +static int fxas2100x_write_raw(struct iio_dev *indio_dev, + struct iio_chan_spec const *chan, int val, + int val2, long mask) +{ + struct fxas2100x_data *data = iio_priv(indio_dev); + int range; + + switch (mask) { + case IIO_CHAN_INFO_SAMP_FREQ: + if (val2) + return -EINVAL; + + return fxas2100x_odr_set(data, val); + case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: + if (val) + return -EINVAL; + + val2 = val2 / 10000; + return fxas2100x_lpf_set(data, val2); + case IIO_CHAN_INFO_SCALE: + switch (chan->type) { + case IIO_ANGL_VEL: + range = (((val * 1000 + val2 / 1000) * + FXAS2100X_SCALE_FRACTIONAL) / 1000); + return fxas2100x_scale_set(data, range); + default: + return -EINVAL; + } + case IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY: + return fxas2100x_hpf_set(data, val2); + default: + return -EINVAL; + } +} + +static IIO_CONST_ATTR_SAMP_FREQ_AVAIL("12.5 25 50 100 200 400 800"); + +static IIO_CONST_ATTR(in_anglvel_filter_low_pass_3db_frequency_available, + "0.32 0.16 0.08"); + +static IIO_CONST_ATTR(in_anglvel_filter_high_pass_3db_frequency_available, + "0.018750 0.009625 0.004875 0.002475"); + +static IIO_CONST_ATTR(in_anglvel_scale_available, + "125.0 62.5 31.25 15.625 7.8125"); + +static struct attribute *fxas2100x_attributes[] = { + &iio_const_attr_sampling_frequency_available.dev_attr.attr, + &iio_const_attr_in_anglvel_filter_low_pass_3db_frequency_available.dev_attr.attr, + &iio_const_attr_in_anglvel_filter_high_pass_3db_frequency_available.dev_attr.attr, + &iio_const_attr_in_anglvel_scale_available.dev_attr.attr, + NULL, +}; + +static const struct attribute_group fxas2100x_attrs_group = { + .attrs = fxas2100x_attributes, +}; + +#define FXAS2100X_CHANNEL(_axis) { \ + .type = IIO_ANGL_VEL, \ + .modified = 1, \ + .channel2 = IIO_MOD_##_axis, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ + .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ + BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY) | \ + BIT(IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY) | \ + BIT(IIO_CHAN_INFO_SAMP_FREQ), \ + .scan_index = CHANNEL_SCAN_INDEX_##_axis, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \ + .storagebits = 16, \ + .endianness = IIO_BE, \ + }, \ +} + +static const struct iio_chan_spec fxas2100x_channels[] = { + { + .type = IIO_TEMP, + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), + .scan_index = -1, + }, + FXAS2100X_CHANNEL(X), + FXAS2100X_CHANNEL(Y), + FXAS2100X_CHANNEL(Z), +}; + +static const struct iio_info fxas2100x_info = { + .attrs = &fxas2100x_attrs_group, + .read_raw = &fxas2100x_read_raw, + .write_raw = &fxas2100x_write_raw, +}; + +static irqreturn_t fxas2100x_trigger_handler(int irq, void *p) +{ + struct iio_poll_func *pf = p; + struct iio_dev *indio_dev = pf->indio_dev; + struct fxas2100x_data *data = iio_priv(indio_dev); + int ret; + + mutex_lock(&data->lock); + ret = regmap_bulk_read(data->regmap, FXAS2100X_REG_OUT_X_MSB, + data->buffer, CHANNEL_SCAN_MAX * sizeof(s16)); + mutex_unlock(&data->lock); + if (ret < 0) + goto notify_done; + + iio_push_to_buffers_with_timestamp(indio_dev, data->buffer, + pf->timestamp); + +notify_done: + iio_trigger_notify_done(indio_dev->trig); + + return IRQ_HANDLED; +} + +static int fxas2100x_chip_init(struct fxas2100x_data *data) +{ + struct device *dev = regmap_get_device(data->regmap); + unsigned int chip_id; + int ret; + + ret = regmap_field_read(data->regmap_fields[F_WHO_AM_I], &chip_id); + if (ret < 0) + return ret; + + if (chip_id != FXAS21002_CHIP_ID_1 && chip_id != FXAS21002_CHIP_ID_2) { + dev_err(dev, "chip id 0x%02x is not supported\n", chip_id); + return -EINVAL; + } + + data->chip_id = chip_id; + + ret = fxas2100x_mode_set(data, FXAS2100X_MODE_STANDBY); + if (ret < 0) + return ret; + + /* Set ODR to 200HZ as default */ + ret = fxas2100x_odr_set(data, 200); + if (ret < 0) + dev_err(dev, "failed to set ODR: %d\n", ret); + + return ret; +} + +static int fxas2100x_data_rdy_trigger_set_state(struct iio_trigger *trig, + bool state) +{ + struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); + struct fxas2100x_data *data = iio_priv(indio_dev); + + return regmap_field_write(data->regmap_fields[F_INT_EN_DRDY], state); +} + +static const struct iio_trigger_ops fxas2100x_trigger_ops = { + .set_trigger_state = &fxas2100x_data_rdy_trigger_set_state, +}; + +static irqreturn_t fxas2100x_data_rdy_trig_poll(int irq, void *private) +{ + struct iio_dev *indio_dev = private; + struct fxas2100x_data *data = iio_priv(indio_dev); + + iio_trigger_poll(data->dready_trig); + + return IRQ_HANDLED; +} + +static int fxas2100x_trigger_probe(struct fxas2100x_data *data) +{ + struct device *dev = regmap_get_device(data->regmap); + struct iio_dev *indio_dev = dev_get_drvdata(dev); + int ret; + + if (!data->irq) + return 0; + + data->dready_trig = devm_iio_trigger_alloc(dev, "%s-dev%d", + indio_dev->name, + indio_dev->id); + if (!data->dready_trig) + return -ENOMEM; + + ret = devm_request_irq(dev, data->irq, fxas2100x_data_rdy_trig_poll, + IRQF_TRIGGER_RISING, "fxas2100x_data_ready", + data->dready_trig); + if (ret < 0) + return ret; + + data->dready_trig->dev.parent = dev; + data->dready_trig->ops = &fxas2100x_trigger_ops; + iio_trigger_set_drvdata(data->dready_trig, indio_dev); + + return devm_iio_trigger_register(dev, data->dready_trig); +} + +static int fxas2100x_power_enable(struct fxas2100x_data *data) +{ + struct device *dev = regmap_get_device(data->regmap); + int ret; + + data->vdd = devm_regulator_get(dev->parent, "vdd"); + if (IS_ERR(data->vdd)) { + dev_err(dev, "failed to get Vdd supply\n"); + return PTR_ERR(data->vdd); + } + + ret = regulator_enable(data->vdd); + if (ret < 0) + return ret; + + data->vddio = devm_regulator_get(dev->parent, "vddio"); + if (IS_ERR(data->vddio)) { + dev_err(dev, "failed to get Vdd_IO supply\n"); + regulator_disable(data->vdd); + return PTR_ERR(data->vddio); + } + + ret = regulator_enable(data->vddio); + if (ret < 0) + return ret; + + return 0; +} + +static void fxas2100x_power_disable(struct fxas2100x_data *data) +{ + regulator_disable(data->vdd); + regulator_disable(data->vddio); +} + +int fxas2100x_core_probe(struct device *dev, struct regmap *regmap, int irq, + const char *name) +{ + struct fxas2100x_data *data; + struct iio_dev *indio_dev; + struct regmap_field *f; + int i; + int ret; + + indio_dev = devm_iio_device_alloc(dev, sizeof(*data)); + if (!indio_dev) + return -ENOMEM; + + data = iio_priv(indio_dev); + dev_set_drvdata(dev, indio_dev); + data->irq = irq; + data->regmap = regmap; + + for (i = 0; i < F_MAX_FIELDS; i++) { + f = devm_regmap_field_alloc(dev, data->regmap, + fxas2100x_reg_fields[i]); + if (IS_ERR(f)) + return PTR_ERR(f); + + data->regmap_fields[i] = f; + } + + mutex_init(&data->lock); + + ret = fxas2100x_power_enable(data); + if (ret < 0) + return ret; + + ret = fxas2100x_chip_init(data); + if (ret < 0) + goto power_disable; + + indio_dev->dev.parent = dev; + indio_dev->channels = fxas2100x_channels; + indio_dev->num_channels = ARRAY_SIZE(fxas2100x_channels); + indio_dev->name = name; + indio_dev->modes = INDIO_DIRECT_MODE; + indio_dev->info = &fxas2100x_info; + + ret = fxas2100x_trigger_probe(data); + if (ret < 0) + goto power_disable; + + ret = devm_iio_triggered_buffer_setup(dev, indio_dev, + iio_pollfunc_store_time, + fxas2100x_trigger_handler, NULL); + if (ret < 0) + goto power_disable; + + ret = pm_runtime_set_active(dev); + if (ret) + goto power_disable; + + pm_runtime_enable(dev); + pm_runtime_set_autosuspend_delay(dev, 2000); + pm_runtime_use_autosuspend(dev); + + ret = devm_iio_device_register(dev, indio_dev); + if (ret < 0) + goto power_disable; + + return 0; + +power_disable: + fxas2100x_power_disable(data); + + return ret; +} +EXPORT_SYMBOL_GPL(fxas2100x_core_probe); + +void fxas2100x_core_remove(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct fxas2100x_data *data = iio_priv(indio_dev); + + pm_runtime_disable(dev); + pm_runtime_set_suspended(dev); + pm_runtime_put_noidle(dev); + + fxas2100x_mode_set(data, FXAS2100X_MODE_STANDBY); + fxas2100x_power_disable(data); +} +EXPORT_SYMBOL_GPL(fxas2100x_core_remove); + +static int __maybe_unused fxas2100x_suspend(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct fxas2100x_data *data = iio_priv(indio_dev); + + fxas2100x_mode_set(data, FXAS2100X_MODE_STANDBY); + + return 0; +} + +static int __maybe_unused fxas2100x_resume(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct fxas2100x_data *data = iio_priv(indio_dev); + + fxas2100x_mode_set(data, data->prev_mode); + + return 0; +} + +static int __maybe_unused fxas2100x_runtime_suspend(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct fxas2100x_data *data = iio_priv(indio_dev); + int ret; + + ret = fxas2100x_mode_set(data, FXAS2100X_MODE_READY); + if (ret < 0) + return -EAGAIN; + + return 0; +} + +static int __maybe_unused fxas2100x_runtime_resume(struct device *dev) +{ + struct iio_dev *indio_dev = dev_get_drvdata(dev); + struct fxas2100x_data *data = iio_priv(indio_dev); + int ret; + + ret = fxas2100x_mode_set(data, FXAS2100X_MODE_ACTIVE); + if (ret < 0) + return -EAGAIN; + + return 0; +} + +const struct dev_pm_ops fxas2100x_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(fxas2100x_suspend, fxas2100x_resume) + SET_RUNTIME_PM_OPS(fxas2100x_runtime_suspend, + fxas2100x_runtime_resume, NULL) +}; +EXPORT_SYMBOL_GPL(fxas2100x_pm_ops); + +MODULE_AUTHOR("Rui Miguel Silva "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("FXAS2100X Gyro driver"); From patchwork Tue Feb 5 17:43:31 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rui Miguel Silva X-Patchwork-Id: 10797915 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 012C9922 for ; Tue, 5 Feb 2019 17:43:57 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id E5FB82A97F for ; Tue, 5 Feb 2019 17:43:56 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id E3A1C2C660; Tue, 5 Feb 2019 17:43:56 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 7153C2C660 for ; Tue, 5 Feb 2019 17:43:56 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1728363AbfBERn4 (ORCPT ); Tue, 5 Feb 2019 12:43:56 -0500 Received: from mail-wm1-f65.google.com ([209.85.128.65]:51804 "EHLO mail-wm1-f65.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727835AbfBERnz (ORCPT ); Tue, 5 Feb 2019 12:43:55 -0500 Received: by mail-wm1-f65.google.com with SMTP id b11so4598329wmj.1 for ; Tue, 05 Feb 2019 09:43:54 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=2luiUc6gzFLBKKxk29xFnHm2KXg4oKTSaw5uIVColWk=; b=rjVwGa4L999FeZ3SVbbJ4+aGsJWVX8rXVl+QWAqfkR5qA43P+71VQlBAjbrZUMxrQ5 ZUm5cIEOfvR+X+85JftO81d8SCgK1DNvTy9eFvmi+ChncIEyh6DZGEZqmNuj7pDlBdVU IcGnvDmnG7yRtw4Quk/8/Yun87pQOSe0LT1WXe/g+vrcziA4y3cEjwgylvQF45TIW7G1 pbyD0oZRZZlKHT853SdWekLwi3Q6TJaiin5vredXltaYgykbIbQ+LmK6lpYA1oCrufMv QhCTBFh2JiC1swzaE5aVbkEWOy5vQvJgnMaae1btA9BZtf1J26iMuI2OTr+a+G1xWa9L 1NCg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=2luiUc6gzFLBKKxk29xFnHm2KXg4oKTSaw5uIVColWk=; b=Qz3HzwAXhr0Bh0ybZ3WAKpid6m8PV0AxuBfgcEvpKTXpATqa4Z9bIrJfizMR3KDWp9 Mt/1npyxNpr/w6x0G4BB2zNBSus4Kw3xgLqYeXFZZ/m+F0DCgsf8Q8CwKIRreTDTdxoE cYIvp+bd6qgB3sfKNT7dBbpOPtI9AiVe6ion9cPUF3ZjcsABJdbqnyQUj/Yb+MVN6rx5 79luLWA35p2kP2XzRYGgORM1QO7iKz6gf3DyyshNTp7YsoyTW2Oj1mK+sfXl3pMtHU6Z Ot8sMbtGBN/LCQo4cyMDKBxqtxcvUwMCTBME1XKlgWpgKl2vYuOf6QuHksFgTCofC9an 9hCQ== X-Gm-Message-State: AHQUAuYhmSq6B1mrErXdFaWxGoUIkCA2x3uY4xZuiEbQLo0alFIDT7/j U03qrOGJw8gtRzyLXVbonOUKqg== X-Google-Smtp-Source: AHgI3IYlMWcMPqdN7mZOdfhm7fOlU/YPKuGzQpTySccPAlSiuoYQT4QpaxZ9bBj4zByzBrD8pWr3pg== X-Received: by 2002:a7b:c1d7:: with SMTP id a23mr4475270wmj.48.1549388633646; Tue, 05 Feb 2019 09:43:53 -0800 (PST) Received: from arch-late.local (a109-49-46-234.cpe.netcabo.pt. [109.49.46.234]) by smtp.gmail.com with ESMTPSA id s132sm12225751wmf.28.2019.02.05.09.43.52 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Tue, 05 Feb 2019 09:43:53 -0800 (PST) From: Rui Miguel Silva To: Jonathan Cameron , Hartmut Knaack , Lars-Peter Clausen , Peter Meerwald-Stadler , Shawn Guo , Rob Herring , Fabio Estevam Cc: linux-iio@vger.kernel.org, devicetree@vger.kernel.org, Rui Miguel Silva Subject: [PATCH v2 3/5] iio: gyro: fxas2100x: add i2c driver Date: Tue, 5 Feb 2019 17:43:31 +0000 Message-Id: <20190205174333.17672-4-rui.silva@linaro.org> X-Mailer: git-send-email 2.20.1 In-Reply-To: <20190205174333.17672-1-rui.silva@linaro.org> References: <20190205174333.17672-1-rui.silva@linaro.org> MIME-Version: 1.0 Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP This add the real driver to talk over i2c and use the fxas2100x core for the main tasks. Signed-off-by: Rui Miguel Silva --- drivers/iio/gyro/Kconfig | 6 +++ drivers/iio/gyro/Makefile | 1 + drivers/iio/gyro/fxas2100x_i2c.c | 73 ++++++++++++++++++++++++++++++++ 3 files changed, 80 insertions(+) create mode 100644 drivers/iio/gyro/fxas2100x_i2c.c diff --git a/drivers/iio/gyro/Kconfig b/drivers/iio/gyro/Kconfig index c168aa63de3b..1f9bfc51febb 100644 --- a/drivers/iio/gyro/Kconfig +++ b/drivers/iio/gyro/Kconfig @@ -77,6 +77,8 @@ config FXAS2100X tristate "NXP FXAS2100X Gyro Sensor" select IIO_BUFFER select IIO_TRIGGERED_BUFFER + select FXAS2100X_I2C if (I2C) + depends on (I2C || SPI_MASTER) help Say yes here to build support for NXP FXAS2100X family Tri-axis Gyro Sensor driver connected via I2C or SPI. @@ -84,6 +86,10 @@ config FXAS2100X This driver can also be built as a module. If so, the module will be called fxas2100x_i2c or fxas2100x_spi. +config FXAS2100X_I2C + tristate + select REGMAP_I2C + config HID_SENSOR_GYRO_3D depends on HID_SENSOR_HUB select IIO_BUFFER diff --git a/drivers/iio/gyro/Makefile b/drivers/iio/gyro/Makefile index 9e2395185a6e..8b1540ddbbce 100644 --- a/drivers/iio/gyro/Makefile +++ b/drivers/iio/gyro/Makefile @@ -13,6 +13,7 @@ obj-$(CONFIG_BMG160) += bmg160_core.o obj-$(CONFIG_BMG160_I2C) += bmg160_i2c.o obj-$(CONFIG_BMG160_SPI) += bmg160_spi.o obj-$(CONFIG_FXAS2100X) += fxas2100x_core.o +obj-$(CONFIG_FXAS2100X_I2C) += fxas2100x_i2c.o obj-$(CONFIG_HID_SENSOR_GYRO_3D) += hid-sensor-gyro-3d.o diff --git a/drivers/iio/gyro/fxas2100x_i2c.c b/drivers/iio/gyro/fxas2100x_i2c.c new file mode 100644 index 000000000000..b8f6d2b7f6dd --- /dev/null +++ b/drivers/iio/gyro/fxas2100x_i2c.c @@ -0,0 +1,73 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for NXP FXAS2100x Gyroscope - I2C + * + * Copyright (C) 2018 Linaro Ltd. + * + */ +#include +#include +#include +#include + +#include "fxas2100x.h" + +static const struct regmap_config fxas2100x_regmap_i2c_conf = { + .reg_bits = 8, + .val_bits = 8, + .max_register = FXAS2100X_REG_CTRL3, +}; + +static int fxas2100x_i2c_probe(struct i2c_client *i2c, + const struct i2c_device_id *id) +{ + struct regmap *regmap; + const char *name = NULL; + + regmap = devm_regmap_init_i2c(i2c, &fxas2100x_regmap_i2c_conf); + if (IS_ERR(regmap)) { + dev_err(&i2c->dev, "Failed to register i2c regmap: %ld\n", + PTR_ERR(regmap)); + return PTR_ERR(regmap); + } + + if (id) + name = id->name; + + return fxas2100x_core_probe(&i2c->dev, regmap, i2c->irq, name); +} + +static int fxas2100x_i2c_remove(struct i2c_client *i2c) +{ + fxas2100x_core_remove(&i2c->dev); + + return 0; +} + +static const struct i2c_device_id fxas2100x_i2c_id[] = { + { "fxas2100x", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c, fxas2100x_i2c_id); + +static const struct of_device_id fxas2100x_i2c_of_match[] = { + { .compatible = "nxp,fxas21002", }, + { }, +}; +MODULE_DEVICE_TABLE(of, fxas2100x_i2c_of_match); + +static struct i2c_driver fxas2100x_i2c_driver = { + .driver = { + .name = "fxas2100x_i2c", + .pm = &fxas2100x_pm_ops, + .of_match_table = of_match_ptr(fxas2100x_i2c_of_match), + }, + .probe = fxas2100x_i2c_probe, + .remove = fxas2100x_i2c_remove, + .id_table = fxas2100x_i2c_id, +}; +module_i2c_driver(fxas2100x_i2c_driver); + +MODULE_AUTHOR("Rui Miguel Silva "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("FXAS2100X I2C Gyro driver"); From patchwork Tue Feb 5 17:43:32 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rui Miguel Silva X-Patchwork-Id: 10797917 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id C017A922 for ; Tue, 5 Feb 2019 17:43:58 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id B0C6D2C69D for ; Tue, 5 Feb 2019 17:43:58 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id AE7DB2C714; Tue, 5 Feb 2019 17:43:58 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 3F6C62C660 for ; Tue, 5 Feb 2019 17:43:58 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727969AbfBERn5 (ORCPT ); Tue, 5 Feb 2019 12:43:57 -0500 Received: from mail-wm1-f67.google.com ([209.85.128.67]:32954 "EHLO mail-wm1-f67.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727835AbfBERn5 (ORCPT ); Tue, 5 Feb 2019 12:43:57 -0500 Received: by mail-wm1-f67.google.com with SMTP id r24so102872wmh.0 for ; Tue, 05 Feb 2019 09:43:56 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=gDgmk73jZxpcUob0JtNtldENUWQY6jE2DXwyzn7tmw8=; b=FFWqg5ckf/0PWzXYi1ObveJ1ACjS4K62xIljtH0ecFKVbLdTFeV0ipWd3DZa5X0T/8 71tlAK9js3avffXFWwkiesU0RkMAy84y/J0lUcV05icR6o7naw3H1YJhzNJUJqXwFfWw Ahj2tECW76394VTqCLC8G0HJ+lKlGsm/EulW2scJ5qMF3b8x98dsPF1E3M+Mz5c7y2sH NNWYlUiDPeuRxzKiGzcFMqiEr1Raj55EqmyUOUsjg9FV4WQ9pkZn5TNMc6koB4FpOpim ewkFfr5G86o+H/hmQhUUzVhXHBJ3kLOdc+js8pfKnBc7Wb6S/N3b+Bz1iNcmdTDv3990 wYZg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=gDgmk73jZxpcUob0JtNtldENUWQY6jE2DXwyzn7tmw8=; b=SkDbiZ6xNY9E7xHomkAovck9EWDHjZpjuoSbc3cbL8xrfTo5nLgUTXx2+abEH2H5Bk XHzOTHXoton3lcBVXW3Z+0CFeWnsux4pqDRu8vrbQuLdOQdwQWGIYwXE4ABwMaFmNoU1 EOVTKU2eQ8qP14W23BX2AFRFXOlEDPWe4vfSUYCjwDzI+iFx5W1Ecr64jQigariT+mKc r5kUgqZIvU75xvpKe/aawKO0RUb12UqMyl9485Gb09szT2pMPpu5nyjvhHrr11oOEimv RQhZr2NaGF2X6BW3Xj1EEFh8x9lR0IvKYG5tlH3QW9aT62i1RmDRpkEOGCyQ/eCNkkzU LnrA== X-Gm-Message-State: AHQUAua/XM2Jpsjt6aAiu4+3BJDnyEi37+Ryvq7nJeP6kXmtoOOgJsIa TRmNBIm2EDnYgEIOuPi6PM8SNA== X-Google-Smtp-Source: AHgI3IYXOf1GGWpN77W881VdnTtje7gTPaarnTRDpRr9WdiWtTsnZzqTluWsG+35auZuk3dgWLDTtQ== X-Received: by 2002:a1c:5a42:: with SMTP id o63mr4608833wmb.88.1549388635740; Tue, 05 Feb 2019 09:43:55 -0800 (PST) Received: from arch-late.local (a109-49-46-234.cpe.netcabo.pt. [109.49.46.234]) by smtp.gmail.com with ESMTPSA id s132sm12225751wmf.28.2019.02.05.09.43.54 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Tue, 05 Feb 2019 09:43:55 -0800 (PST) From: Rui Miguel Silva To: Jonathan Cameron , Hartmut Knaack , Lars-Peter Clausen , Peter Meerwald-Stadler , Shawn Guo , Rob Herring , Fabio Estevam Cc: linux-iio@vger.kernel.org, devicetree@vger.kernel.org, Rui Miguel Silva Subject: [PATCH v2 4/5] iio: gyro: fxas2100x: add spi driver Date: Tue, 5 Feb 2019 17:43:32 +0000 Message-Id: <20190205174333.17672-5-rui.silva@linaro.org> X-Mailer: git-send-email 2.20.1 In-Reply-To: <20190205174333.17672-1-rui.silva@linaro.org> References: <20190205174333.17672-1-rui.silva@linaro.org> MIME-Version: 1.0 Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Add driver to talk over spi to a fxas21002 gyroscope device and use the core as main controller. Signed-off-by: Rui Miguel Silva --- drivers/iio/gyro/Kconfig | 5 +++ drivers/iio/gyro/Makefile | 1 + drivers/iio/gyro/fxas2100x_spi.c | 70 ++++++++++++++++++++++++++++++++ 3 files changed, 76 insertions(+) create mode 100644 drivers/iio/gyro/fxas2100x_spi.c diff --git a/drivers/iio/gyro/Kconfig b/drivers/iio/gyro/Kconfig index 1f9bfc51febb..4f6d6b393ad8 100644 --- a/drivers/iio/gyro/Kconfig +++ b/drivers/iio/gyro/Kconfig @@ -78,6 +78,7 @@ config FXAS2100X select IIO_BUFFER select IIO_TRIGGERED_BUFFER select FXAS2100X_I2C if (I2C) + select FXAS2100X_SPI if (SPI) depends on (I2C || SPI_MASTER) help Say yes here to build support for NXP FXAS2100X family Tri-axis Gyro @@ -90,6 +91,10 @@ config FXAS2100X_I2C tristate select REGMAP_I2C +config FXAS2100X_SPI + tristate + select REGMAP_SPI + config HID_SENSOR_GYRO_3D depends on HID_SENSOR_HUB select IIO_BUFFER diff --git a/drivers/iio/gyro/Makefile b/drivers/iio/gyro/Makefile index 8b1540ddbbce..29915ba124b0 100644 --- a/drivers/iio/gyro/Makefile +++ b/drivers/iio/gyro/Makefile @@ -14,6 +14,7 @@ obj-$(CONFIG_BMG160_I2C) += bmg160_i2c.o obj-$(CONFIG_BMG160_SPI) += bmg160_spi.o obj-$(CONFIG_FXAS2100X) += fxas2100x_core.o obj-$(CONFIG_FXAS2100X_I2C) += fxas2100x_i2c.o +obj-$(CONFIG_FXAS2100X_SPI) += fxas2100x_spi.o obj-$(CONFIG_HID_SENSOR_GYRO_3D) += hid-sensor-gyro-3d.o diff --git a/drivers/iio/gyro/fxas2100x_spi.c b/drivers/iio/gyro/fxas2100x_spi.c new file mode 100644 index 000000000000..7bd16a607372 --- /dev/null +++ b/drivers/iio/gyro/fxas2100x_spi.c @@ -0,0 +1,70 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for NXP FXAS2100x Gyroscope - SPI + * + * Copyright (C) 2018 Linaro Ltd. + * + */ + +#include +#include +#include +#include + +#include "fxas2100x.h" + +static const struct regmap_config fxas2100x_regmap_spi_conf = { + .reg_bits = 8, + .val_bits = 8, + .max_register = FXAS2100X_REG_CTRL3, +}; + +static int fxas2100x_spi_probe(struct spi_device *spi) +{ + const struct spi_device_id *id = spi_get_device_id(spi); + struct regmap *regmap; + + regmap = devm_regmap_init_spi(spi, &fxas2100x_regmap_spi_conf); + if (IS_ERR(regmap)) { + dev_err(&spi->dev, "Failed to register spi regmap: %ld\n", + PTR_ERR(regmap)); + return PTR_ERR(regmap); + } + + return fxas2100x_core_probe(&spi->dev, regmap, spi->irq, id->name); +} + +static int fxas2100x_spi_remove(struct spi_device *spi) +{ + fxas2100x_core_remove(&spi->dev); + + return 0; +} + +static const struct spi_device_id fxas2100x_spi_id[] = { + { "fxas2100x", 0 }, + { } +}; +MODULE_DEVICE_TABLE(spi, fxas2100x_spi_id); + +static const struct of_device_id fxas2100x_spi_of_match[] = { + { .compatible = "nxp,fxas21002", }, + { }, +}; +MODULE_DEVICE_TABLE(of, fxas2100x_spi_of_match); + +static struct spi_driver fxas2100x_spi_driver = { + .driver = { + .name = "fxas2100x_spi", + .pm = &fxas2100x_pm_ops, + .of_match_table = of_match_ptr(fxas2100x_spi_of_match), + }, + .probe = fxas2100x_spi_probe, + .remove = fxas2100x_spi_remove, + .id_table = fxas2100x_spi_id, +}; +module_spi_driver(fxas2100x_spi_driver); + +MODULE_AUTHOR("Rui Miguel Silva "); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("FXAS2100X SPI Gyro driver"); From patchwork Tue Feb 5 17:43:33 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rui Miguel Silva X-Patchwork-Id: 10797921 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 9A268922 for ; Tue, 5 Feb 2019 17:44:00 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 8B3462A97F for ; Tue, 5 Feb 2019 17:44:00 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 892332C739; Tue, 5 Feb 2019 17:44:00 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 35CDF2A97F for ; Tue, 5 Feb 2019 17:44:00 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727752AbfBERn7 (ORCPT ); Tue, 5 Feb 2019 12:43:59 -0500 Received: from mail-wm1-f65.google.com ([209.85.128.65]:53104 "EHLO mail-wm1-f65.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1728741AbfBERn7 (ORCPT ); Tue, 5 Feb 2019 12:43:59 -0500 Received: by mail-wm1-f65.google.com with SMTP id m1so4589187wml.2 for ; Tue, 05 Feb 2019 09:43:58 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=1beXyQ7Gf29kAeZEAs9WtF0BKb4rwWHgLwQvrdn6V/Y=; b=bHzekH/bWSHQl3zTXv2YVD9MjXSFYUPbsiuMgER2iccqk0ib4nip+rpB3WWWvODWDi 9evwdQqULxH+ix0hKCpAS98nNNqiAsIYhVJOU52peR5lVT7N/QFMfoQZ8oZJrQylalu/ J6FxXl/oe6LCvr9r3JWUNj9NPbxV4xRljdGrMEM+r5VKEirxq5f8paXw+npuPUrDEHZj vvoDX3NFF1tgK0dQFvasDZKdD96/FzVLYMDb1LtW7t+bBasNkTyvaaMEzLydWmhfiBg6 twc8kU21S7bPqP8EeLiOy43PbXAtonr9nScoS6Efk5ur4CUzZ7LxF4JVwGFJk2A0QS5c nSTA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=1beXyQ7Gf29kAeZEAs9WtF0BKb4rwWHgLwQvrdn6V/Y=; b=Pni1GtLTxmni2bwfX3g4pftU+3/NtKgrJeZTL4y/rh4fcFaHHz/oVSDaybippngxAP ZU2kSl3uQFAsikQjPhJiKsCw7AT6fc1l/ANMBK0Znj6d7XwWiQXXjruKcZoE/Y1NblAT MEmDw6Tr63QW7a1Cp8/KAXku5qqYCyifcZSXMxI6mUZBZhodYVRDrvmYoRpmD1Pgkruy khm4YnfJMNTLpom2d/55l74Rx9aTGrjrgvESsqDmc6WstrNl3xnbAoodhyjBjTfSveV8 2QbplgG5h7KNI/FI0+Dw81Tkrp/PzoGoDr9tY7lvaeJCcJf8T1tpPQEVBl6xoRwSKWyO E31Q== X-Gm-Message-State: AHQUAuZGxYAvPEWtemoHxdgtemz/+3/VIAUpDyLwktfyjqnsaoaBA27w RVwjjFR608uYfqJv/XK4jR6CVA== X-Google-Smtp-Source: AHgI3IauMFIqR5UhM/Qe2u6Imjg9f9NtV+2/ihKpOM8JXoIQFFwfgedsE/l+P/CWeuEVmG37p7L/Kw== X-Received: by 2002:a1c:bc82:: with SMTP id m124mr4554500wmf.77.1549388637813; Tue, 05 Feb 2019 09:43:57 -0800 (PST) Received: from arch-late.local (a109-49-46-234.cpe.netcabo.pt. [109.49.46.234]) by smtp.gmail.com with ESMTPSA id s132sm12225751wmf.28.2019.02.05.09.43.56 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Tue, 05 Feb 2019 09:43:57 -0800 (PST) From: Rui Miguel Silva To: Jonathan Cameron , Hartmut Knaack , Lars-Peter Clausen , Peter Meerwald-Stadler , Shawn Guo , Rob Herring , Fabio Estevam Cc: linux-iio@vger.kernel.org, devicetree@vger.kernel.org, Rui Miguel Silva Subject: [PATCH v2 5/5] ARM: dts: imx7s-warp: add fxas21002 gyroscope Date: Tue, 5 Feb 2019 17:43:33 +0000 Message-Id: <20190205174333.17672-6-rui.silva@linaro.org> X-Mailer: git-send-email 2.20.1 In-Reply-To: <20190205174333.17672-1-rui.silva@linaro.org> References: <20190205174333.17672-1-rui.silva@linaro.org> MIME-Version: 1.0 Sender: linux-iio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-iio@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Add entry to enable the fxas21002 in the warp7 board Signed-off-by: Rui Miguel Silva --- arch/arm/boot/dts/imx7s-warp.dts | 7 +++++++ 1 file changed, 7 insertions(+) diff --git a/arch/arm/boot/dts/imx7s-warp.dts b/arch/arm/boot/dts/imx7s-warp.dts index 58d1a89ee3e3..233ff2b68488 100644 --- a/arch/arm/boot/dts/imx7s-warp.dts +++ b/arch/arm/boot/dts/imx7s-warp.dts @@ -238,6 +238,13 @@ compatible = "fsl,mpl3115"; reg = <0x60>; }; + + fxas21002@20 { + compatible = "nxp,fxas21002"; + reg = <0x20>; + vdd-supply = <®_peri_3p15v>; + vddio-supply = <®_peri_3p15v>; + }; }; &sai1 {