description.c

   1 /*
   2  * Copyright (C) 2014 Intel Corporation.
   3  */
   4
   5 #include <stdlib.h>
   6 #include <ctype.h>
   7 #include <utils/Log.h>
   8 #include <cutils/properties.h>
   9 #include <hardware/sensors.h>
  10 #include "common.h"
  11 #include "enumeration.h"
  12 #include "description.h"
  13 #include "utils.h"
  14
  15 #define IIO_SENSOR_HAL_VERSION  1
  16
  17 #define MIN_ON_CHANGE_SAMPLING_PERIOD_US   200000 /* For on change sensors (temperature, proximity, ALS, etc.) report we support 5 Hz max (0.2 s min period) */
  18 #define MAX_ON_CHANGE_SAMPLING_PERIOD_US 10000000 /* 0.1 Hz min (10 s max period)*/
  19
  20 /*
  21  * About properties
  22  *
  23  * We acquire a number of parameters about sensors by reading properties.
  24  * The idea here is that someone (either a script, or daemon, sets them
  25  * depending on the set of sensors present on the machine.
  26  *
  27  * There are fallback paths in case the properties are not defined, but it is
  28  * highly desirable to at least have the following for each sensor:
  29  *
  30  * ro.iio.anglvel.name = Gyroscope
  31  * ro.iio.anglvel.vendor = Intel
  32  * ro.iio.anglvel.max_range = 35
  33  * ro.iio.anglvel.resolution = 0.002
  34  * ro.iio.anglvel.power = 6.1
  35  *
  36  * Besides these, we have a couple of knobs initially used to cope with Intel
  37  * Sensor Hub oddities, such as HID inspired units or firmware bugs:
  38  *
  39  * ro.iio.anglvel.transform = ISH
  40  * ro.iio.anglvel.quirks = init-rate
  41  *
  42  * The "terse" quirk indicates that the underlying driver only sends events
  43  * when the sensor reports a change. The HAL then periodically generates
  44  * duplicate events so the sensor behaves as a continously firing one.
  45  *
  46  * The "noisy" quirk indicates that the underlying driver has a unusually high
  47  * level of noise in its readings, and that the HAL has to accomodate it
  48  * somehow, e.g. in the magnetometer calibration code path.
  49  *
  50  * This one is used specifically to pass a calibration scale to ALS drivers:
  51  *
  52  * ro.iio.illuminance.name = CPLM3218x Ambient Light Sensor
  53  * ro.iio.illuminance.vendor = Capella Microsystems
  54  * ro.iio.illuminance.max_range = 167000
  55  * ro.iio.illuminance.resolution = 1
  56  * ro.iio.illuminance.power = .001
  57  * ro.iio.illuminance.illumincalib = 7400
  58  *
  59  * There's a 'opt_scale' specifier, documented as follows:
  60  *
  61  *  This adds support for a scaling factor that can be expressed
  62  *  using properties, for all sensors, on a channel basis. That
  63  *  scaling factor is applied after all other transforms have been
  64  *  applied, and is intended as a way to compensate for problems
  65  *  such as an incorrect axis polarity for a given sensor.
  66  *
  67  *  The syntax is <usual property prefix>.<channel>.opt_scale, e.g.
  68  *  ro.iio.accel.y.opt_scale = -1 to negate the sign of the y readings
  69  *  for the accelerometer.
  70  *
  71  *  For sensors using a single channel - and only those - the channel
  72  *  name is implicitly void and a syntax such as ro.iio.illuminance.
  73  *  opt_scale = 3 has to be used.
  74  *
  75  * 'panel' and 'rotation' specifiers can be used to express ACPI PLD placement
  76  * information ; if found they will be used in priority over the actual ACPI
  77  * data. That is intended as a way to verify values during development.
  78  *
  79  * It's possible to use the contents of the iio device name as a way to
  80  * discriminate between sensors. Several sensors of the same type can coexist:
  81  * e.g. ro.iio.temp.bmg160.name = BMG160 Thermometer will be used in priority
  82  * over ro.iio.temp.name = BMC150 Thermometer if the sensor for which we query
  83  * properties values happen to have its iio device name set to bmg160.
  84  */
  85
  86 static int sensor_get_st_prop (int s, const char* sel, char val[MAX_NAME_SIZE])
  87 {
  88         char prop_name[PROP_NAME_MAX];
  89         char prop_val[PROP_VALUE_MAX];
  90         char extended_sel[PROP_VALUE_MAX];
  91
  92         int i                   = sensor[s].catalog_index;
  93         const char *prefix      = sensor_catalog[i].tag;
  94
  95         /* First try most specialized form, like ro.iio.anglvel.bmg160.name */
  96
  97         snprintf(extended_sel, PROP_NAME_MAX, "%s.%s",
  98                  sensor[s].internal_name, sel);
  99
 100         snprintf(prop_name, PROP_NAME_MAX, PROP_BASE, prefix, extended_sel);
 101
 102         if (property_get(prop_name, prop_val, "")) {
 103                 strncpy(val, prop_val, MAX_NAME_SIZE-1);
 104                 val[MAX_NAME_SIZE-1] = '\0';
 105                 return 0;
 106         }
 107
 108         /* Fall back to simple form, like ro.iio.anglvel.name */
 109
 110         sprintf(prop_name, PROP_BASE, prefix, sel);
 111
 112         if (property_get(prop_name, prop_val, "")) {
 113                 strncpy(val, prop_val, MAX_NAME_SIZE-1);
 114                 val[MAX_NAME_SIZE-1] = '\0';
 115                 return 0;
 116         }
 117
 118         return -1;
 119 }
 120
 121
 122 int sensor_get_prop (int s, const char* sel, int* val)
 123 {
 124         char buf[MAX_NAME_SIZE];
 125
 126         if (sensor_get_st_prop(s, sel, buf))
 127                 return -1;
 128
 129         *val = atoi(buf);
 130         return 0;
 131 }
 132
 133
 134 int sensor_get_fl_prop (int s, const char* sel, float* val)
 135 {
 136         char buf[MAX_NAME_SIZE];
 137
 138         if (sensor_get_st_prop(s, sel, buf))
 139                 return -1;
 140
 141         *val = (float) strtod(buf, NULL);
 142         return 0;
 143 }
 144
 145
 146 char* sensor_get_name (int s)
 147 {
 148         char buf[MAX_NAME_SIZE];
 149
 150         if (sensor[s].is_virtual) {
 151                 switch (sensor[s].type) {
 152                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 153                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 154                                 strcpy(buf, sensor[sensor[s].base[0]].friendly_name);
 155                                 snprintf(sensor[s].friendly_name,
 156                                          MAX_NAME_SIZE,
 157                                          "%s %s", "Uncalibrated", buf);
 158                                 return sensor[s].friendly_name;
 159
 160                         default:
 161                                 return "";
 162                 }
 163         }
 164
 165         if (sensor[s].friendly_name[0] != '\0' ||
 166                 !sensor_get_st_prop(s, "name", sensor[s].friendly_name))
 167                         return sensor[s].friendly_name;
 168
 169         /* If we got a iio device name from sysfs, use it */
 170         if (sensor[s].internal_name[0]) {
 171                 snprintf(sensor[s].friendly_name, MAX_NAME_SIZE, "S%d-%s",
 172                          s, sensor[s].internal_name);
 173         } else {
 174                 sprintf(sensor[s].friendly_name, "S%d", s);
 175         }
 176
 177         return sensor[s].friendly_name;
 178 }
 179
 180
 181 char* sensor_get_vendor (int s)
 182 {
 183         if (sensor[s].is_virtual) {
 184                 switch (sensor[s].type) {
 185                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 186                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 187                                 return sensor[sensor[s].base[0]].vendor_name;
 188                         break;
 189
 190                         default:
 191                                 return "";
 192
 193                 }
 194         }
 195
 196         if (sensor[s].vendor_name[0] ||
 197                 !sensor_get_st_prop(s, "vendor", sensor[s].vendor_name))
 198                         return sensor[s].vendor_name;
 199
 200         return "";
 201 }
 202
 203
 204 int sensor_get_version (__attribute__((unused)) int s)
 205 {
 206         return IIO_SENSOR_HAL_VERSION;
 207 }
 208
 209
 210 float sensor_get_max_range (int s)
 211 {
 212         if (sensor[s].is_virtual) {
 213                 switch (sensor[s].type) {
 214                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 215                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 216                                 return sensor[sensor[s].base[0]].max_range;
 217
 218                         default:
 219                                 return 0.0;
 220                 }
 221         }
 222
 223         if (sensor[s].max_range != 0.0 ||
 224                 !sensor_get_fl_prop(s, "max_range", &sensor[s].max_range))
 225                         return sensor[s].max_range;
 226
 227         /* Try returning a sensible value given the sensor type */
 228
 229         /* We should cap returned samples accordingly... */
 230
 231         switch (sensor[s].type) {
 232                 case SENSOR_TYPE_ACCELEROMETER:         /* m/s^2        */
 233                         return 50;
 234
 235                 case SENSOR_TYPE_MAGNETIC_FIELD:        /* micro-tesla  */
 236                         return 500;
 237
 238                 case SENSOR_TYPE_ORIENTATION:           /* degrees      */
 239                         return 360;
 240
 241                 case SENSOR_TYPE_GYROSCOPE:             /* radians/s    */
 242                         return 10;
 243
 244                 case SENSOR_TYPE_LIGHT:                 /* SI lux units */
 245                         return 50000;
 246
 247                 case SENSOR_TYPE_AMBIENT_TEMPERATURE:   /* °C          */
 248                 case SENSOR_TYPE_TEMPERATURE:           /* °C          */
 249                 case SENSOR_TYPE_PROXIMITY:             /* centimeters  */
 250                 case SENSOR_TYPE_PRESSURE:              /* hecto-pascal */
 251                 case SENSOR_TYPE_RELATIVE_HUMIDITY:     /* percent */
 252                         return 100;
 253
 254                 default:
 255                         return 0;
 256                 }
 257 }
 258
 259 static float sensor_get_min_freq (int s)
 260 {
 261         /*
 262          * Check if a low cap has been specified for this sensor sampling rate.
 263          * In some case, even when the driver supports lower rate, we still
 264          * wish to receive a certain number of samples per seconds for various
 265          * reasons (calibration, filtering, no change in power consumption...).
 266          */
 267
 268         float min_freq;
 269
 270         if (!sensor_get_fl_prop(s, "min_freq", &min_freq))
 271                 return min_freq;
 272
 273         return 0;
 274 }
 275
 276
 277 static float sensor_get_max_freq (int s)
 278 {
 279         float max_freq;
 280
 281         if (!sensor_get_fl_prop(s, "max_freq", &max_freq))
 282                 return max_freq;
 283
 284         return 1000;
 285 }
 286
 287 int sensor_get_cal_steps (int s)
 288 {
 289         int cal_steps;
 290         if (!sensor_get_prop(s, "cal_steps", &cal_steps))
 291                 return cal_steps;
 292
 293         return 0;
 294 }
 295
 296 float sensor_get_resolution (int s)
 297 {
 298         if (sensor[s].is_virtual) {
 299                 switch (sensor[s].type) {
 300                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 301                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 302                                 return sensor[sensor[s].base[0]].resolution;
 303
 304                         default:
 305                                 return 0;
 306                 }
 307         }
 308
 309         if (sensor[s].resolution != 0.0 ||
 310                 !sensor_get_fl_prop(s, "resolution", &sensor[s].resolution))
 311                         return sensor[s].resolution;
 312
 313         return 0;
 314 }
 315
 316
 317 float sensor_get_power (int s)
 318 {
 319
 320         if (sensor[s].is_virtual) {
 321                 switch (sensor[s].type) {
 322                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 323                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 324                                 return sensor[sensor[s].base[0]].power;
 325
 326                         default:
 327                                 return 0;
 328                 }
 329         }
 330
 331         /* mA used while sensor is in use ; not sure about volts :) */
 332         if (sensor[s].power != 0.0 ||
 333                 !sensor_get_fl_prop(s, "power", &sensor[s].power))
 334                         return sensor[s].power;
 335
 336         return 0;
 337 }
 338
 339
 340 float sensor_get_illumincalib (int s)
 341 {
 342         /* calibrating the ALS Sensor*/
 343         if (sensor[s].illumincalib != 0.0 ||
 344                 !sensor_get_fl_prop(s, "illumincalib", &sensor[s].illumincalib)) {
 345                         return sensor[s].illumincalib;
 346         }
 347
 348         return 0;
 349 }
 350
 351
 352 uint32_t sensor_get_quirks (int s)
 353 {
 354         char quirks_buf[MAX_NAME_SIZE];
 355
 356         /* Read and decode quirks property on first reference */
 357         if (!(sensor[s].quirks & QUIRK_ALREADY_DECODED)) {
 358                 quirks_buf[0] = '\0';
 359                 sensor_get_st_prop(s, "quirks", quirks_buf);
 360
 361                 if (strstr(quirks_buf, "init-rate"))
 362                         sensor[s].quirks |= QUIRK_INITIAL_RATE;
 363
 364                 if (strstr(quirks_buf, "continuous"))
 365                         sensor[s].quirks |= QUIRK_FORCE_CONTINUOUS;
 366
 367                 if (strstr(quirks_buf, "terse"))
 368                         sensor[s].quirks |= QUIRK_TERSE_DRIVER;
 369
 370                 if (strstr(quirks_buf, "noisy"))
 371                         sensor[s].quirks |= QUIRK_NOISY;
 372
 373                 sensor[s].quirks |= QUIRK_ALREADY_DECODED;
 374         }
 375
 376         return sensor[s].quirks;
 377 }
 378
 379
 380 int sensor_get_order (int s, unsigned char map[MAX_CHANNELS])
 381 {
 382         char buf[MAX_NAME_SIZE];
 383         int i;
 384         int count = sensor_catalog[sensor[s].catalog_index].num_channels;
 385
 386         if (sensor_get_st_prop(s, "order", buf))
 387                 return 0; /* No order property */
 388
 389         /* Assume ASCII characters, in the '0'..'9' range */
 390
 391         for (i=0; i<count; i++)
 392                 if (buf[i] - '0' >= count) {
 393                         ALOGE("Order index out of range for sensor %d\n", s);
 394                         return 0;
 395                 }
 396
 397         for (i=0; i<count; i++)
 398                 map[i] = buf[i] - '0';
 399
 400         return 1;       /* OK to use modified ordering map */
 401 }
 402
 403
 404 char* sensor_get_string_type (int s)
 405 {
 406         switch (sensor[s].type) {
 407                 case SENSOR_TYPE_ACCELEROMETER:
 408                         return SENSOR_STRING_TYPE_ACCELEROMETER;
 409
 410                 case SENSOR_TYPE_MAGNETIC_FIELD:
 411                         return SENSOR_STRING_TYPE_MAGNETIC_FIELD;
 412
 413                 case SENSOR_TYPE_ORIENTATION:
 414                         return SENSOR_STRING_TYPE_ORIENTATION;
 415
 416                 case SENSOR_TYPE_GYROSCOPE:
 417                         return SENSOR_STRING_TYPE_GYROSCOPE;
 418
 419                 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 420                         return SENSOR_STRING_TYPE_GYROSCOPE_UNCALIBRATED;
 421
 422                 case SENSOR_TYPE_LIGHT:
 423                         return SENSOR_STRING_TYPE_LIGHT;
 424
 425                 case SENSOR_TYPE_AMBIENT_TEMPERATURE:
 426                         return SENSOR_STRING_TYPE_AMBIENT_TEMPERATURE;
 427
 428                 case SENSOR_TYPE_TEMPERATURE:
 429                         return SENSOR_STRING_TYPE_TEMPERATURE;
 430
 431                 case SENSOR_TYPE_PROXIMITY:
 432                         return SENSOR_STRING_TYPE_PROXIMITY;
 433
 434                 case SENSOR_TYPE_PRESSURE:
 435                         return SENSOR_STRING_TYPE_PRESSURE;
 436
 437                 case SENSOR_TYPE_RELATIVE_HUMIDITY:
 438                         return SENSOR_STRING_TYPE_RELATIVE_HUMIDITY;
 439
 440                 default:
 441                         return "";
 442                 }
 443 }
 444
 445
 446 flag_t sensor_get_flags (int s)
 447 {
 448         flag_t flags = 0x0;
 449
 450         switch (sensor[s].type) {
 451                 case SENSOR_TYPE_ACCELEROMETER:
 452                 case SENSOR_TYPE_MAGNETIC_FIELD:
 453                 case SENSOR_TYPE_ORIENTATION:
 454                 case SENSOR_TYPE_GYROSCOPE:
 455                 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 456                 case SENSOR_TYPE_PRESSURE:
 457                         flags |= SENSOR_FLAG_CONTINUOUS_MODE;
 458                         break;
 459
 460                 case SENSOR_TYPE_LIGHT:
 461                 case SENSOR_TYPE_AMBIENT_TEMPERATURE:
 462                 case SENSOR_TYPE_TEMPERATURE:
 463                 case SENSOR_TYPE_RELATIVE_HUMIDITY:
 464                         flags |= SENSOR_FLAG_ON_CHANGE_MODE;
 465                         break;
 466
 467
 468                 case SENSOR_TYPE_PROXIMITY:
 469                         flags |= SENSOR_FLAG_WAKE_UP;
 470                         flags |= SENSOR_FLAG_ON_CHANGE_MODE;
 471                         break;
 472
 473                 default:
 474                         ALOGI("Unknown sensor");
 475                 }
 476         return flags;
 477 }
 478
 479
 480 static int get_cdd_freq (int s, int must)
 481 {
 482         switch (sensor[s].type) {
 483                 case SENSOR_TYPE_ACCELEROMETER:
 484                         return (must ? 100 : 200); /* must 100 Hz, should 200 Hz, CDD compliant */
 485
 486                 case SENSOR_TYPE_GYROSCOPE:
 487                 case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 488                         return (must ? 200 : 200); /* must 200 Hz, should 200 Hz, CDD compliant */
 489
 490                 case SENSOR_TYPE_MAGNETIC_FIELD:
 491                         return (must ? 10 : 50);   /* must 10 Hz, should 50 Hz, CDD compliant */
 492
 493                 case SENSOR_TYPE_LIGHT:
 494                 case SENSOR_TYPE_AMBIENT_TEMPERATURE:
 495                 case SENSOR_TYPE_TEMPERATURE:
 496                         return (must ? 1 : 2);     /* must 1 Hz, should 2Hz, not mentioned in CDD */
 497
 498                 default:
 499                         return 1; /* Use 1 Hz by default, e.g. for proximity */
 500         }
 501 }
 502
 503 /*
 504  * This value is defined only for continuous mode and on-change sensors. It is the delay between two sensor events corresponding to the lowest frequency that
 505  * this sensor supports. When lower frequencies are requested through batch()/setDelay() the events will be generated at this frequency instead. It can be used
 506  * by the framework or applications to estimate when the batch FIFO may be full. maxDelay should always fit within a 32 bit signed integer. It is declared as
 507  * 64 bit on 64 bit architectures only for binary compatibility reasons. Availability: SENSORS_DEVICE_API_VERSION_1_3
 508  */
 509 max_delay_t sensor_get_max_delay (int s)
 510 {
 511         char avail_sysfs_path[PATH_MAX];
 512         int dev_num     = sensor[s].dev_num;
 513         char freqs_buf[100];
 514         char* cursor;
 515         float min_supported_rate = 1000;
 516         float rate_cap;
 517         float sr;
 518
 519         /*
 520          * continuous, on-change: maximum sampling period allowed in microseconds.
 521          * one-shot, special : 0
 522          */
 523         switch (REPORTING_MODE(sensor_desc[s].flags)) {
 524                 case SENSOR_FLAG_ONE_SHOT_MODE:
 525                 case SENSOR_FLAG_SPECIAL_REPORTING_MODE:
 526                         return 0;
 527
 528                 case SENSOR_FLAG_ON_CHANGE_MODE:
 529                         return MAX_ON_CHANGE_SAMPLING_PERIOD_US;
 530
 531                 default:
 532                         break;
 533         }
 534
 535         if (sensor[s].is_virtual) {
 536                 switch (sensor[s].type) {
 537                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 538                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 539                                 return sensor_desc[sensor[s].base[0]].maxDelay;
 540                         default:
 541                                 return 0;
 542                 }
 543         }
 544         sprintf(avail_sysfs_path, DEVICE_AVAIL_FREQ_PATH, dev_num);
 545
 546         if (sysfs_read_str(avail_sysfs_path, freqs_buf, sizeof(freqs_buf)) < 0) {
 547                 /* If poll mode sensor */
 548                 if (!sensor[s].num_channels) {
 549                         /* The must rate */
 550                         min_supported_rate = get_cdd_freq(s, 1);
 551                 }
 552         } else {
 553                 cursor = freqs_buf;
 554                 while (*cursor && cursor[0]) {
 555
 556                         /* Decode a single value */
 557                         sr = strtod(cursor, NULL);
 558
 559                         if (sr < min_supported_rate)
 560                                 min_supported_rate = sr;
 561
 562                         /* Skip digits */
 563                         while (cursor[0] && !isspace(cursor[0]))
 564                                 cursor++;
 565
 566                         /* Skip spaces */
 567                         while (cursor[0] && isspace(cursor[0]))
 568                                 cursor++;
 569                 }
 570         }
 571
 572         /* Check if a minimum rate was specified for this sensor */
 573         rate_cap = sensor_get_min_freq(s);
 574
 575         if (min_supported_rate < rate_cap)
 576                 min_supported_rate = rate_cap;
 577
 578         /* return 0 for wrong values */
 579         if (min_supported_rate < 0.1)
 580                 return 0;
 581
 582         /* Return microseconds */
 583         return (max_delay_t) (1000000.0 / min_supported_rate);
 584 }
 585
 586
 587 int32_t sensor_get_min_delay (int s)
 588 {
 589         char avail_sysfs_path[PATH_MAX];
 590         int dev_num     = sensor[s].dev_num;
 591         char freqs_buf[100];
 592         char* cursor;
 593         float max_supported_rate = 0;
 594         float sr;
 595
 596         /* continuous, on change: minimum sampling period allowed in microseconds.
 597          * special : 0, unless otherwise noted
 598          * one-shot:-1
 599          */
 600         switch (REPORTING_MODE(sensor_desc[s].flags)) {
 601                 case SENSOR_FLAG_ON_CHANGE_MODE:
 602                         return MIN_ON_CHANGE_SAMPLING_PERIOD_US;
 603
 604                 case SENSOR_FLAG_SPECIAL_REPORTING_MODE:
 605                         return 0;
 606
 607                 case SENSOR_FLAG_ONE_SHOT_MODE:
 608                         return -1;
 609
 610                 default:
 611                         break;
 612         }
 613
 614         if (sensor[s].is_virtual) {
 615                 switch (sensor[s].type) {
 616                         case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
 617                         case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
 618                                 return sensor_desc[sensor[s].base[0]].minDelay;
 619                         default:
 620                                 return 0;
 621                 }
 622         }
 623
 624         sprintf(avail_sysfs_path, DEVICE_AVAIL_FREQ_PATH, dev_num);
 625
 626         if (sysfs_read_str(avail_sysfs_path, freqs_buf, sizeof(freqs_buf)) < 0) {
 627                 /* If poll mode sensor */
 628                 if (!sensor[s].num_channels) {
 629                         /* The should rate */
 630                         max_supported_rate = get_cdd_freq(s, 0);
 631                 }
 632         } else {
 633                 cursor = freqs_buf;
 634                 while (*cursor && cursor[0]) {
 635
 636                         /* Decode a single value */
 637                         sr = strtod(cursor, NULL);
 638
 639                         if (sr > max_supported_rate && sr <= sensor_get_max_freq(s))
 640                                 max_supported_rate = sr;
 641
 642                         /* Skip digits */
 643                         while (cursor[0] && !isspace(cursor[0]))
 644                                 cursor++;
 645
 646                         /* Skip spaces */
 647                         while (cursor[0] && isspace(cursor[0]))
 648                                 cursor++;
 649                 }
 650         }
 651
 652         /* return 0 for wrong values */
 653         if (max_supported_rate < 0.1)
 654                 return 0;
 655
 656         /* Return microseconds */
 657         return (int32_t) (1000000.0 / max_supported_rate);
 658 }