New sensor HAL and test
Change-Id: I216e3dd0b2b45829fef7c682774d2cdd8271d4e7
diff --git a/tests/nusensors/nusensors.cpp b/tests/nusensors/nusensors.cpp
new file mode 100644
index 0000000..215c972
--- /dev/null
+++ b/tests/nusensors/nusensors.cpp
@@ -0,0 +1,176 @@
+/*
+ * Copyright (C) 2008 The Android Open Source Project
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include <stdint.h>
+#include <sys/cdefs.h>
+#include <sys/types.h>
+
+#include <cutils/log.h>
+
+#include <hardware/sensors.h>
+
+char const* getSensorName(int type) {
+ switch(type) {
+ case SENSOR_TYPE_ACCELEROMETER:
+ return "Acc";
+ case SENSOR_TYPE_MAGNETIC_FIELD:
+ return "Mag";
+ case SENSOR_TYPE_ORIENTATION:
+ return "Ori";
+ case SENSOR_TYPE_PROXIMITY:
+ return "Prx";
+ case SENSOR_TYPE_TEMPERATURE:
+ return "Tmp";
+ case SENSOR_TYPE_LIGHT:
+ return "Lux";
+ }
+ return "ukn";
+}
+
+int main(int argc, char** argv)
+{
+ int err;
+ struct sensors_poll_device_t* device;
+ struct sensors_module_t* module;
+
+ err = hw_get_module(SENSORS_HARDWARE_MODULE_ID, (hw_module_t const**)&module);
+ if (err != 0) {
+ printf("hw_get_module() failed (%s)\n", strerror(-err));
+ return 0;
+ }
+
+ struct sensor_t const* list;
+ int count = module->get_sensors_list(module, &list);
+ for (int i=0 ; i<count ; i++) {
+ printf("%s\n"
+ "\tvendor: %s\n"
+ "\tversion: %d\n"
+ "\thandle: %d\n"
+ "\ttype: %d\n"
+ "\tmaxRange: %f\n"
+ "\tresolution: %f\n"
+ "\tpower: %f mA\n",
+ list[i].name,
+ list[i].vendor,
+ list[i].version,
+ list[i].handle,
+ list[i].type,
+ list[i].maxRange,
+ list[i].resolution,
+ list[i].power);
+ }
+
+ sensors_data_t buffer[16];
+
+ err = sensors_open(&module->common, &device);
+ if (err != 0) {
+ printf("sensors_open() failed (%s)\n", strerror(-err));
+ return 0;
+ }
+
+ for (int i=0 ; i<count ; i++) {
+ err = device->activate(device, list[i].handle, 1);
+ if (err != 0) {
+ printf("activate() for '%s'failed (%s)\n",
+ list[i].name, strerror(-err));
+ return 0;
+ }
+ device->setDelay(device, list[i].handle, 10000000);
+ }
+
+ do {
+ int n = device->poll(device, buffer, 16);
+ if (n < 0) {
+ printf("poll() failed (%s)\n", strerror(-err));
+ break;
+ }
+
+ printf("read %d events:\n", n);
+ for (int i=0 ; i<n ; i++) {
+ const sensors_data_t& data = buffer[i];
+ switch(data.sensor) {
+ case SENSOR_TYPE_ACCELEROMETER:
+ printf("sensor=%s, time=%lld, value=<%5.1f,%5.1f,%5.1f>\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.acceleration.x,
+ data.acceleration.y,
+ data.acceleration.z);
+ break;
+ case SENSOR_TYPE_MAGNETIC_FIELD:
+ printf("sensor=%s, time=%lld, value=<%5.1f,%5.1f,%5.1f>\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.magnetic.x,
+ data.magnetic.y,
+ data.magnetic.z);
+ break;
+ case SENSOR_TYPE_ORIENTATION:
+ printf("sensor=%s, time=%lld, value=<%5.1f,%5.1f,%5.1f>\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.orientation.azimuth,
+ data.orientation.pitch,
+ data.orientation.roll);
+ break;
+ case SENSOR_TYPE_PROXIMITY:
+ printf("sensor=%s, time=%lld, value=%f\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.distance);
+ break;
+ case SENSOR_TYPE_TEMPERATURE:
+ printf("sensor=%s, time=%lld, value=%f\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.temperature);
+ break;
+ case SENSOR_TYPE_LIGHT:
+ printf("sensor=%s, time=%lld, value=%f\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.light);
+ break;
+ default:
+ printf("sensor=%s, time=%lld, value=<%f,%f,%f>\n",
+ getSensorName(data.sensor),
+ data.time,
+ data.acceleration.x,
+ data.acceleration.y,
+ data.acceleration.z);
+ break;
+ }
+ }
+
+
+ } while (1); // fix that
+
+
+ for (int i=0 ; i<count ; i++) {
+ err = device->activate(device, list[i].handle, 0);
+ if (err != 0) {
+ printf("deactivate() for '%s'failed (%s)\n",
+ list[i].name, strerror(-err));
+ return 0;
+ }
+ }
+
+ err = sensors_close(device);
+ if (err != 0) {
+ printf("sensors_close() failed (%s)\n", strerror(-err));
+ }
+ return 0;
+}