public inbox for linux-kernel@vger.kernel.org
 help / color / mirror / Atom feed
* [PATCH] hid_sensor_magn_3d: Fix scale for rotation from north channels
@ 2015-07-15  7:43 Reyad Attiyat
  2015-07-19 12:57 ` Jonathan Cameron
  2015-07-20 16:25 ` Srinivas Pandruvada
  0 siblings, 2 replies; 4+ messages in thread
From: Reyad Attiyat @ 2015-07-15  7:43 UTC (permalink / raw)
  To: jic23, srinivas.pandruvada; +Cc: linux-iio, linux-kernel, Reyad Attiyat

Some devices on a hid sensor hub will not report a measurement unit. This
causes the rotation from north channels to have an incorrect scale value.
This patch will set the unit to degrees if the maximum value is 360 when
the unit exponent value is accounted for.

Signed-off-by: Reyad Attiyat <reyad.attiyat@gmail.com>
---
 .../iio/common/hid-sensors/hid-sensor-attributes.c | 19 ++++++++++++++++
 drivers/iio/magnetometer/hid-sensor-magn-3d.c      | 26 +++++++++++++++++++++-
 include/linux/hid-sensor-hub.h                     |  4 ++++
 3 files changed, 48 insertions(+), 1 deletion(-)

diff --git a/drivers/iio/common/hid-sensors/hid-sensor-attributes.c b/drivers/iio/common/hid-sensors/hid-sensor-attributes.c
index e81f434..3c79847 100644
--- a/drivers/iio/common/hid-sensors/hid-sensor-attributes.c
+++ b/drivers/iio/common/hid-sensors/hid-sensor-attributes.c
@@ -46,6 +46,7 @@ static struct {
 
 	{HID_USAGE_SENSOR_COMPASS_3D, 0, 0, 1000},
 	{HID_USAGE_SENSOR_COMPASS_3D, HID_USAGE_SENSOR_UNITS_GAUSS, 1, 0},
+	{HID_USAGE_SENSOR_COMPASS_3D, HID_USAGE_SENSOR_UNITS_DEGREES, 1, 0},
 
 	{HID_USAGE_SENSOR_INCLINOMETER_3D, 0, 0, 17453},
 	{HID_USAGE_SENSOR_INCLINOMETER_3D,
@@ -317,6 +318,24 @@ static void adjust_exponent_micro(int *val0, int *val1, int scale0,
 	}
 }
 
+void hid_sensor_get_unit_expo_fraction(
+		struct hid_sensor_hub_attribute_info *attr_info,
+		int *num, int *denom)
+{
+	s32 exp = hid_sensor_convert_exponent(attr_info->unit_expo);
+
+	if (exp == 0) {
+		*num = *denom = 1;
+	} else if (exp < 0) {
+		*num = 1;
+		*denom = pow_10(abs(exp));
+	} else if (exp > 0) {
+		*num = pow_10(exp);
+		*denom = 1;
+	}
+}
+EXPORT_SYMBOL(hid_sensor_get_unit_expo_fraction);
+
 int hid_sensor_format_scale(u32 usage_id,
 			struct hid_sensor_hub_attribute_info *attr_info,
 			int *val0, int *val1)
diff --git a/drivers/iio/magnetometer/hid-sensor-magn-3d.c b/drivers/iio/magnetometer/hid-sensor-magn-3d.c
index d8a0c8d..173d2f5 100644
--- a/drivers/iio/magnetometer/hid-sensor-magn-3d.c
+++ b/drivers/iio/magnetometer/hid-sensor-magn-3d.c
@@ -311,6 +311,7 @@ static int magn_3d_parse_report(struct platform_device *pdev,
 	int i;
 	int attr_count = 0;
 	struct iio_chan_spec *_channels;
+	struct hid_sensor_hub_attribute_info *first_channel_attr_info;
 
 	/* Scan for each usage attribute supported */
 	for (i = 0; i < MAGN_3D_CHANNEL_MAX; i++) {
@@ -389,9 +390,32 @@ static int magn_3d_parse_report(struct platform_device *pdev,
 	dev_dbg(&pdev->dev, "magn_3d Setup %d IIO channels\n",
 			*chan_count);
 
+	first_channel_attr_info = &(st->magn[_channels[0].address]);
+
+	/* Try and set unit based off exponent, logical min and max */
+	if (!first_channel_attr_info->units) {
+		int num, denom;
+		s32 log_min = first_channel_attr_info->logical_minimum;
+		s32 log_max = first_channel_attr_info->logical_maximum;
+
+		dev_dbg(&pdev->dev, "magn_3d Units not set. Unit Expo %d Logical Min: %d Max: %d\n",
+					first_channel_attr_info->unit_expo,
+					log_min, log_max);
+
+		hid_sensor_get_unit_expo_fraction(first_channel_attr_info,
+						&num, &denom);
+
+		/* Check for unit Degrees */
+		if (log_min == 0 && num == 1 && (log_max == 360 * denom)) {
+			first_channel_attr_info->units =
+					HID_USAGE_SENSOR_UNITS_DEGREES;
+			dev_dbg(&pdev->dev, "magn_3d Set units to degrees.");
+		}
+
+	}
 	st->scale_precision = hid_sensor_format_scale(
 				HID_USAGE_SENSOR_COMPASS_3D,
-				&st->magn[CHANNEL_SCAN_INDEX_X],
+				first_channel_attr_info,
 				&st->scale_pre_decml, &st->scale_post_decml);
 
 	/* Set Sensitivity field ids, when there is no individual modifier */
diff --git a/include/linux/hid-sensor-hub.h b/include/linux/hid-sensor-hub.h
index 0042bf3..627fd68 100644
--- a/include/linux/hid-sensor-hub.h
+++ b/include/linux/hid-sensor-hub.h
@@ -267,6 +267,10 @@ int hid_sensor_format_scale(u32 usage_id,
 			    struct hid_sensor_hub_attribute_info *attr_info,
 			    int *val0, int *val1);
 
+void hid_sensor_get_unit_expo_fraction(
+			struct hid_sensor_hub_attribute_info *attr_info,
+			int *num, int *denom);
+
 s32 hid_sensor_read_poll_value(struct hid_sensor_common *st);
 
 #endif
-- 
2.4.3


^ permalink raw reply related	[flat|nested] 4+ messages in thread

end of thread, other threads:[~2015-07-20 16:28 UTC | newest]

Thread overview: 4+ messages (download: mbox.gz follow: Atom feed
-- links below jump to the message on this page --
2015-07-15  7:43 [PATCH] hid_sensor_magn_3d: Fix scale for rotation from north channels Reyad Attiyat
2015-07-19 12:57 ` Jonathan Cameron
2015-07-19 18:03   ` Reyad Attiyat
2015-07-20 16:25 ` Srinivas Pandruvada

This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox