From: LI Qingwu <Qing-wu.Li@leica-geosystems.com.cn>
To: jic23@kernel.org, lars@metafoo.de, robh+dt@kernel.org,
tomas.melin@vaisala.com, andy.shevchenko@gmail.com,
devicetree@vger.kernel.org, linux-kernel@vger.kernel.org,
Qing-wu.Li@leica-geosystems.com.cn
Cc: linux-iio@vger.kernel.org, bsp-development.geo@leica-geosystems.com
Subject: [PATCH V2 5/5] iio: accel: sca3300: Add inclination channels.
Date: Thu, 17 Feb 2022 06:27:05 +0000 [thread overview]
Message-ID: <20220217062705.2867149-6-Qing-wu.Li@leica-geosystems.com.cn> (raw)
In-Reply-To: <20220217062705.2867149-1-Qing-wu.Li@leica-geosystems.com.cn>
Different with SCA3300, SCL3300 can output inclination angles.
Angles are formed from acceleration with following equations:
ANG_X = atan2(accx / √(accy^2 + accz^2)),
ANG_Y = atan2(accy / √(accx^2 + accz^2)),
ANG_Z = atan2(accz / √(accx^2 + accy^2)),
The commit add output of the raw value,scale
and scale_available of angles.
New interfaces:
in_incli_scale
in_incli_scale_available
in_incli_x_raw
in_incli_y_raw
in_incli_z_raw
Signed-off-by: LI Qingwu <Qing-wu.Li@leica-geosystems.com.cn>
---
drivers/iio/accel/sca3300.c | 48 +++++++++++++++++++++++++++++++++++++
1 file changed, 48 insertions(+)
diff --git a/drivers/iio/accel/sca3300.c b/drivers/iio/accel/sca3300.c
index 123ab9a784d2..5c86b143d17a 100644
--- a/drivers/iio/accel/sca3300.c
+++ b/drivers/iio/accel/sca3300.c
@@ -64,6 +64,9 @@ enum sca3300_scan_indexes {
SCA3300_ACC_Y,
SCA3300_ACC_Z,
SCA3300_TEMP,
+ SCA3300_INCLI_X,
+ SCA3300_INCLI_Y,
+ SCA3300_INCLI_Z,
SCA3300_TIMESTAMP,
};
@@ -88,6 +91,24 @@ enum sca3300_scan_indexes {
}, \
}
+#define SCA3300_INCLI_CHANNEL(index, reg, axis) { \
+ .type = IIO_INCLI, \
+ .address = reg, \
+ .modified = 1, \
+ .channel2 = IIO_MOD_##axis, \
+ .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
+ .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
+ .info_mask_shared_by_type_available = \
+ BIT(IIO_CHAN_INFO_SCALE), \
+ .scan_index = index, \
+ .scan_type = { \
+ .sign = 's', \
+ .realbits = 16, \
+ .storagebits = 16, \
+ .endianness = IIO_CPU, \
+ }, \
+}
+
#define SCA3300_TEMP_CHANNEL(index, reg) { \
.type = IIO_TEMP, \
.address = reg, \
@@ -115,6 +136,9 @@ static const struct iio_chan_spec scl3300_channels[] = {
SCA3300_ACCEL_CHANNEL(SCA3300_ACC_Y, 0x2, Y),
SCA3300_ACCEL_CHANNEL(SCA3300_ACC_Z, 0x3, Z),
SCA3300_TEMP_CHANNEL(SCA3300_TEMP, 0x05),
+ SCA3300_INCLI_CHANNEL(SCA3300_INCLI_X, 0x09, X),
+ SCA3300_INCLI_CHANNEL(SCA3300_INCLI_Y, 0x0A, Y),
+ SCA3300_INCLI_CHANNEL(SCA3300_INCLI_Z, 0x0B, Z),
IIO_CHAN_SOFT_TIMESTAMP(SCA3300_TIMESTAMP),
};
@@ -124,17 +148,28 @@ static const int scl3300_lp_freq_table[] = {40, 70, 10, 10};
static const int sca3300_accel_scale_table[][2] = {{0, 370}, {0, 741}, {0, 185}, {0, 185}};
static const int scl3300_accel_scale_table[][2] = {{0, 167}, {0, 333}, {0, 83}, {0, 83}};
+static const int scl3300_incli_scale_table[][2] = {{0, 5495}, {0, 5495}, {0, 5495}, {0, 5495}};
+
static const unsigned long sca3300_scan_masks[] = {
BIT(SCA3300_ACC_X) | BIT(SCA3300_ACC_Y) | BIT(SCA3300_ACC_Z) |
BIT(SCA3300_TEMP),
0,
};
+static const unsigned long scl3300_scan_masks[] = {
+ BIT(SCA3300_ACC_X) | BIT(SCA3300_ACC_Y) | BIT(SCA3300_ACC_Z) |
+ BIT(SCA3300_TEMP) |
+ BIT(SCA3300_INCLI_X) | BIT(SCA3300_INCLI_Y) | BIT(SCA3300_INCLI_Z),
+ 0,
+};
+
struct sca3300_chip_info {
const struct iio_chan_spec *channels;
enum sca3300_chip_type chip_type;
const int (*accel_scale_table)[2];
+ const int (*incli_scale_table)[2];
unsigned int num_accel_scales;
+ unsigned int num_incli_scales;
unsigned long scan_masks;
unsigned int num_freqs;
const int *freq_table;
@@ -172,14 +207,18 @@ static const struct sca3300_chip_info sca3300_chip_info_tbl[] = {
.scan_masks = sca3300_scan_masks,
.channels = sca3300_channels,
.chip_type = CHIP_SCA3300,
+ .incli_scale_table = NULL,
+ .num_incli_scales = 0,
.name = "sca3300",
.chip_id = 0x51,
.num_freqs = 2,
},
[CHIP_SCL3300] = {
.num_accel_scales = ARRAY_SIZE(scl3300_accel_scale_table)*2-1,
+ .num_incli_scales = ARRAY_SIZE(scl3300_lp_freq_table)-1,
.num_channels = ARRAY_SIZE(scl3300_channels),
.accel_scale_table = scl3300_accel_scale_table,
+ .incli_scale_table = scl3300_incli_scale_table,
.freq_table = scl3300_lp_freq_table,
.scan_masks = sca3300_scan_masks,
.channels = scl3300_channels,
@@ -378,6 +417,10 @@ static int sca3300_read_raw(struct iio_dev *indio_dev,
if (ret)
return ret;
switch (chan->type) {
+ case IIO_INCLI:
+ *val = data->chip_info->incli_scale_table[reg_val][0];
+ *val2 = data->chip_info->incli_scale_table[reg_val][1];
+ return IIO_VAL_INT_PLUS_MICRO;
case IIO_ACCEL:
*val = data->chip_info->accel_scale_table[reg_val][0];
*val2 = data->chip_info->accel_scale_table[reg_val][1];
@@ -507,6 +550,11 @@ static int sca3300_read_avail(struct iio_dev *indio_dev,
switch (mask) {
case IIO_CHAN_INFO_SCALE:
switch (chan->type) {
+ case IIO_INCLI:
+ *vals = (const int *)data->chip_info->incli_scale_table;
+ *length = data->chip_info->num_incli_scales;
+ *type = IIO_VAL_INT_PLUS_MICRO;
+ return IIO_AVAIL_LIST;
case IIO_ACCEL:
*vals = (const int *)data->chip_info->accel_scale_table;
*length = data->chip_info->num_accel_scales;
--
2.25.1
next prev parent reply other threads:[~2022-02-17 6:27 UTC|newest]
Thread overview: 13+ messages / expand[flat|nested] mbox.gz Atom feed top
2022-02-17 6:27 [PATCH V2 0/5] iio: accel: sca3300: add compitible for scl3300 LI Qingwu
2022-02-17 6:27 ` [PATCH V2 1/5] dt-bindings: iio: accel: sca3300: Document murata,scl3300 LI Qingwu
2022-02-17 23:03 ` Rob Herring
2022-02-18 5:34 ` LI Qingwu
2022-02-17 6:27 ` [PATCH V2 2/5] iio: accel: sca3300: add define for temp channel for reuse LI Qingwu
2022-02-17 6:27 ` [PATCH V2 3/5] iio: accel: sca3300: modified to support multi chips LI Qingwu
2022-02-18 12:32 ` Andy Shevchenko
2022-02-19 18:04 ` Jonathan Cameron
2022-02-17 6:27 ` [PATCH V2 4/5] iio: accel: sca3300: Add support for SCL3300 LI Qingwu
2022-02-19 18:10 ` Jonathan Cameron
2022-02-17 6:27 ` LI Qingwu [this message]
2022-02-19 18:15 ` [PATCH V2 5/5] iio: accel: sca3300: Add inclination channels Jonathan Cameron
2022-02-19 17:46 ` [PATCH V2 0/5] iio: accel: sca3300: add compitible for scl3300 Jonathan Cameron
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20220217062705.2867149-6-Qing-wu.Li@leica-geosystems.com.cn \
--to=qing-wu.li@leica-geosystems.com.cn \
--cc=andy.shevchenko@gmail.com \
--cc=bsp-development.geo@leica-geosystems.com \
--cc=devicetree@vger.kernel.org \
--cc=jic23@kernel.org \
--cc=lars@metafoo.de \
--cc=linux-iio@vger.kernel.org \
--cc=linux-kernel@vger.kernel.org \
--cc=robh+dt@kernel.org \
--cc=tomas.melin@vaisala.com \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).