|
@@ -42,6 +42,10 @@ struct gyro_3d_state {
|
|
|
struct hid_sensor_common common_attributes;
|
|
|
struct hid_sensor_hub_attribute_info gyro[GYRO_3D_CHANNEL_MAX];
|
|
|
u32 gyro_val[GYRO_3D_CHANNEL_MAX];
|
|
|
+ int scale_pre_decml;
|
|
|
+ int scale_post_decml;
|
|
|
+ int scale_precision;
|
|
|
+ int value_offset;
|
|
|
};
|
|
|
|
|
|
static const u32 gyro_3d_addresses[GYRO_3D_CHANNEL_MAX] = {
|
|
@@ -123,12 +127,12 @@ static int gyro_3d_read_raw(struct iio_dev *indio_dev,
|
|
|
ret_type = IIO_VAL_INT;
|
|
|
break;
|
|
|
case IIO_CHAN_INFO_SCALE:
|
|
|
- *val = gyro_state->gyro[CHANNEL_SCAN_INDEX_X].units;
|
|
|
- ret_type = IIO_VAL_INT;
|
|
|
+ *val = gyro_state->scale_pre_decml;
|
|
|
+ *val2 = gyro_state->scale_post_decml;
|
|
|
+ ret_type = gyro_state->scale_precision;
|
|
|
break;
|
|
|
case IIO_CHAN_INFO_OFFSET:
|
|
|
- *val = hid_sensor_convert_exponent(
|
|
|
- gyro_state->gyro[CHANNEL_SCAN_INDEX_X].unit_expo);
|
|
|
+ *val = gyro_state->value_offset;
|
|
|
ret_type = IIO_VAL_INT;
|
|
|
break;
|
|
|
case IIO_CHAN_INFO_SAMP_FREQ:
|
|
@@ -262,6 +266,11 @@ static int gyro_3d_parse_report(struct platform_device *pdev,
|
|
|
st->gyro[1].index, st->gyro[1].report_id,
|
|
|
st->gyro[2].index, st->gyro[2].report_id);
|
|
|
|
|
|
+ st->scale_precision = hid_sensor_format_scale(
|
|
|
+ HID_USAGE_SENSOR_GYRO_3D,
|
|
|
+ &st->gyro[CHANNEL_SCAN_INDEX_X],
|
|
|
+ &st->scale_pre_decml, &st->scale_post_decml);
|
|
|
+
|
|
|
/* Set Sensitivity field ids, when there is no individual modifier */
|
|
|
if (st->common_attributes.sensitivity.index < 0) {
|
|
|
sensor_hub_input_get_attribute_info(hsdev,
|