+
+int sensor_get_available_frequencies (int s)
+{
+ int dev_num = sensor[s].dev_num, err, i;
+ char avail_sysfs_path[PATH_MAX], freqs_buf[100];
+ char *p, *end;
+ float f;
+
+ sensor[s].avail_freqs_count = 0;
+ sensor[s].avail_freqs = 0;
+
+ sprintf(avail_sysfs_path, DEVICE_AVAIL_FREQ_PATH, dev_num);
+
+ err = sysfs_read_str(avail_sysfs_path, freqs_buf, sizeof(freqs_buf));
+ if (err < 0)
+ return 0;
+
+ for (p = freqs_buf, f = strtof(p, &end); p != end; p = end, f = strtof(p, &end))
+ sensor[s].avail_freqs_count++;
+
+ if (sensor[s].avail_freqs_count) {
+ sensor[s].avail_freqs = (float*) calloc(sensor[s].avail_freqs_count, sizeof(float));
+
+ for (p = freqs_buf, f = strtof(p, &end), i = 0; p != end; p = end, f = strtof(p, &end), i++)
+ sensor[s].avail_freqs[i] = f;
+ }
+
+ return 0;
+}
+
+int sensor_get_mounting_matrix (int s, float mm[9])
+{
+ int dev_num = sensor[s].dev_num, err, i;
+ char mm_path[PATH_MAX], mm_buf[100];
+ char *tmp1 = mm_buf, *tmp2;
+
+ switch (sensor[s].type) {
+ case SENSOR_TYPE_ACCELEROMETER:
+ case SENSOR_TYPE_MAGNETIC_FIELD:
+ case SENSOR_TYPE_GYROSCOPE:
+ case SENSOR_TYPE_PROXIMITY:
+ break;
+ default:
+ return 0;
+ }
+
+ sprintf(mm_path, MOUNTING_MATRIX_PATH, dev_num);
+
+ err = sysfs_read_str(mm_path, mm_buf, sizeof(mm_buf));
+ if (err < 0)
+ return 0;
+
+ for(i = 0; i < 9; i++) {
+ float f;
+
+ f = strtof(tmp1, &tmp2);
+ if (!f && tmp1 == tmp2)
+ return 0;
+ mm[i] = f;
+ tmp1 = tmp2 + 1;
+ }
+
+ /*
+ * For proximity sensors, interpret a negative final z value as a hint that the sensor is back mounted. In that case, mark the sensor as secondary to
+ * ensure that it gets listed after other sensors of same type that would be front-mounted. Most applications will only ask for the default proximity
+ * sensor and it makes more sense to point to, say, the IR based proximity sensor rather than SAR based one if we have both, as on SoFIA LTE MRD boards.
+ */
+ if (sensor[s].type == SENSOR_TYPE_PROXIMITY) {
+ if (mm[8] < 0) {
+ sensor[s].quirks |= QUIRK_SECONDARY;
+ }
+ return 0;
+ }
+
+ ALOGI("%s: %f %f %f %f %f %f %f %f %f\n", __func__, mm[0], mm[1], mm[2], mm[3], mm[4], mm[5], mm[6], mm[7], mm[8]);
+ return 1;
+}
+
+
+char* sensor_get_string_type (int s)
+{
+ switch (sensor_desc[s].type) {
+ case SENSOR_TYPE_ACCELEROMETER:
+ return SENSOR_STRING_TYPE_ACCELEROMETER;
+
+ case SENSOR_TYPE_MAGNETIC_FIELD:
+ return SENSOR_STRING_TYPE_MAGNETIC_FIELD;
+
+ case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
+ return SENSOR_STRING_TYPE_MAGNETIC_FIELD_UNCALIBRATED;
+
+ case SENSOR_TYPE_ORIENTATION:
+ return SENSOR_STRING_TYPE_ORIENTATION;
+
+ case SENSOR_TYPE_GYROSCOPE:
+ return SENSOR_STRING_TYPE_GYROSCOPE;
+
+ case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
+ return SENSOR_STRING_TYPE_GYROSCOPE_UNCALIBRATED;
+
+ case SENSOR_TYPE_LIGHT:
+ return SENSOR_STRING_TYPE_LIGHT;
+
+ case SENSOR_TYPE_AMBIENT_TEMPERATURE:
+ return SENSOR_STRING_TYPE_AMBIENT_TEMPERATURE;
+
+ case SENSOR_TYPE_TEMPERATURE:
+ return SENSOR_STRING_TYPE_TEMPERATURE;
+
+ case SENSOR_TYPE_PROXIMITY:
+ return SENSOR_STRING_TYPE_PROXIMITY;
+
+ case SENSOR_TYPE_PRESSURE:
+ return SENSOR_STRING_TYPE_PRESSURE;
+
+ case SENSOR_TYPE_RELATIVE_HUMIDITY:
+ return SENSOR_STRING_TYPE_RELATIVE_HUMIDITY;
+
+ default:
+ return "";
+ }
+}
+
+
+flag_t sensor_get_flags (int s)
+{
+ flag_t flags = 0;
+
+ switch (sensor_desc[s].type) {
+ case SENSOR_TYPE_LIGHT:
+ case SENSOR_TYPE_AMBIENT_TEMPERATURE:
+ case SENSOR_TYPE_TEMPERATURE:
+ case SENSOR_TYPE_RELATIVE_HUMIDITY:
+ case SENSOR_TYPE_STEP_COUNTER:
+ flags |= SENSOR_FLAG_ON_CHANGE_MODE;
+ break;
+
+
+ case SENSOR_TYPE_PROXIMITY:
+ flags |= SENSOR_FLAG_WAKE_UP;
+ flags |= SENSOR_FLAG_ON_CHANGE_MODE;
+ break;
+ case SENSOR_TYPE_STEP_DETECTOR:
+ flags |= SENSOR_FLAG_SPECIAL_REPORTING_MODE;
+ break;
+ default:
+ break;
+ }
+ return flags;
+}
+
+
+static int get_cdd_freq (int s, int must)
+{
+ switch (sensor_desc[s].type) {
+ case SENSOR_TYPE_ACCELEROMETER:
+ return (must ? 100 : 200); /* must 100 Hz, should 200 Hz, CDD compliant */
+
+ case SENSOR_TYPE_GYROSCOPE:
+ return (must ? 200 : 200); /* must 200 Hz, should 200 Hz, CDD compliant */
+
+ case SENSOR_TYPE_MAGNETIC_FIELD:
+ return (must ? 10 : 50); /* must 10 Hz, should 50 Hz, CDD compliant */
+
+ case SENSOR_TYPE_LIGHT:
+ case SENSOR_TYPE_AMBIENT_TEMPERATURE:
+ case SENSOR_TYPE_TEMPERATURE:
+ return (must ? 1 : 2); /* must 1 Hz, should 2Hz, not mentioned in CDD */
+
+ default:
+ return 1; /* Use 1 Hz by default, e.g. for proximity */
+ }
+}
+
+/*
+ * 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
+ * this sensor supports. When lower frequencies are requested through batch()/setDelay() the events will be generated at this frequency instead. It can be used
+ * 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
+ * 64 bit on 64 bit architectures only for binary compatibility reasons. Availability: SENSORS_DEVICE_API_VERSION_1_3
+ */
+max_delay_t sensor_get_max_delay (int s)
+{
+ int dev_num = sensor[s].dev_num, i;
+ float min_supported_rate;
+ float rate_cap;
+
+ /*
+ * continuous, on-change: maximum sampling period allowed in microseconds.
+ * one-shot, special : 0
+ */
+ switch (REPORTING_MODE(sensor_desc[s].flags)) {
+ case SENSOR_FLAG_ONE_SHOT_MODE:
+ case SENSOR_FLAG_SPECIAL_REPORTING_MODE:
+ return 0;
+
+ case SENSOR_FLAG_ON_CHANGE_MODE:
+ return MAX_ON_CHANGE_SAMPLING_PERIOD_US;
+
+ default:
+ break;
+ }
+
+ if (sensor[s].is_virtual) {
+ switch (sensor[s].type) {
+ case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
+ case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
+ return sensor_desc[sensor[s].base[0]].maxDelay;
+ default:
+ return 0;
+ }
+ }
+
+ switch (sensor[s].mode) {
+ case MODE_TRIGGER:
+ /* For interrupt-based devices, obey the list of supported sampling rates */
+ if (sensor[s].avail_freqs_count) {
+ min_supported_rate = 1000;
+ for (i = 0; i < sensor[s].avail_freqs_count; i++) {
+ if (sensor[s].avail_freqs[i] < min_supported_rate)
+ min_supported_rate = sensor[s].avail_freqs[i];
+ }
+ break;
+ }
+ /* Fall through ... */
+
+ default:
+ /* Report 1 Hz */
+ min_supported_rate = 1;
+ break;
+ }
+
+ /* Check if a minimum rate was specified for this sensor */
+ rate_cap = sensor_get_min_freq(s);
+
+ if (min_supported_rate < rate_cap)
+ min_supported_rate = rate_cap;
+
+ /* return 0 for wrong values */
+ if (min_supported_rate < 0.1)
+ return 0;
+
+ /* Return microseconds */
+ return (max_delay_t) (1000000.0 / min_supported_rate);
+}
+
+float sensor_get_max_static_freq(int s)
+{
+ float max_from_prop = sensor_get_max_freq(s);
+
+ /* If we have max specified via a property use it */
+ if (max_from_prop != ANDROID_MAX_FREQ) {
+ return max_from_prop;
+ } else {
+ /* The should rate */
+ return get_cdd_freq(s, 0);
+ }
+}
+
+int32_t sensor_get_min_delay (int s)
+{
+ int dev_num = sensor[s].dev_num, i;
+ float max_supported_rate = 0;
+ float max_from_prop = sensor_get_max_freq(s);
+
+ /* continuous, on change: minimum sampling period allowed in microseconds.
+ * special : 0, unless otherwise noted
+ * one-shot:-1
+ */
+ switch (REPORTING_MODE(sensor_desc[s].flags)) {
+ case SENSOR_FLAG_ON_CHANGE_MODE:
+ return MIN_ON_CHANGE_SAMPLING_PERIOD_US;
+
+ case SENSOR_FLAG_SPECIAL_REPORTING_MODE:
+ return 0;
+
+ case SENSOR_FLAG_ONE_SHOT_MODE:
+ return -1;
+
+ default:
+ break;
+ }
+
+ if (sensor[s].is_virtual) {
+ switch (sensor[s].type) {
+ case SENSOR_TYPE_GYROSCOPE_UNCALIBRATED:
+ case SENSOR_TYPE_MAGNETIC_FIELD_UNCALIBRATED:
+ return sensor_desc[sensor[s].base[0]].minDelay;
+ default:
+ return 0;
+ }
+ }
+
+ if (!sensor[s].avail_freqs_count) {
+ if (sensor[s].mode == MODE_POLL) {
+ /* If we have max specified via a property use it */
+ if (max_from_prop != ANDROID_MAX_FREQ)
+ max_supported_rate = max_from_prop;
+ else
+ /* The should rate */
+ max_supported_rate = get_cdd_freq(s, 0);
+ }
+ } else {
+ for (i = 0; i < sensor[s].avail_freqs_count; i++) {
+ if (sensor[s].avail_freqs[i] > max_supported_rate &&
+ sensor[s].avail_freqs[i] <= max_from_prop) {
+ max_supported_rate = sensor[s].avail_freqs[i];
+ }
+ }
+ }
+
+ /* return 0 for wrong values */
+ if (max_supported_rate < 0.1)
+ return 0;
+
+ /* Return microseconds */
+ return (int32_t) (1000000.0 / max_supported_rate);
+}