sensorservicetest.cpp revision 24d72350f321c17b0bfe1ef3fd52d4070a1c02c3 
1/*
2 * Copyright (C) 2010 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 *      http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17#include <android/sensor.h>
18#include <gui/Sensor.h>
19#include <gui/SensorManager.h>
20#include <gui/SensorEventQueue.h>
21#include <utils/Looper.h>
22
23using namespace android;
24
25int receiver(int fd, int events, void* data)
26{
27    sp<SensorEventQueue> q((SensorEventQueue*)data);
28    ssize_t n;
29    ASensorEvent buffer[8];
30
31    static nsecs_t oldTimeStamp = 0;
32
33    while ((n = q->read(buffer, 8)) > 0) {
34        for (int i=0 ; i<n ; i++) {
35            if (buffer[i].type == Sensor::TYPE_GYROSCOPE) {
36                printf("time=%lld, value=<%5.1f,%5.1f,%5.1f>\n",
37                        buffer[i].timestamp,
38                        buffer[i].acceleration.x,
39                        buffer[i].acceleration.y,
40                        buffer[i].acceleration.z);
41            }
42
43            if (oldTimeStamp) {
44                float t = float(buffer[i].timestamp - oldTimeStamp) / s2ns(1);
45                printf("%f ms (%f Hz)\n", t*1000, 1.0/t);
46            }
47            oldTimeStamp = buffer[i].timestamp;
48
49        }
50    }
51    if (n<0 && n != -EAGAIN) {
52        printf("error reading events (%s)\n", strerror(-n));
53    }
54    return 1;
55}
56
57
58int main(int argc, char** argv)
59{
60    SensorManager& mgr(SensorManager::getInstance());
61
62    Sensor const* const* list;
63    ssize_t count = mgr.getSensorList(&list);
64    printf("numSensors=%d\n", int(count));
65
66    sp<SensorEventQueue> q = mgr.createEventQueue();
67    printf("queue=%p\n", q.get());
68
69    Sensor const* accelerometer = mgr.getDefaultSensor(Sensor::TYPE_GYROSCOPE);
70    printf("accelerometer=%p (%s)\n",
71            accelerometer, accelerometer->getName().string());
72    q->enableSensor(accelerometer);
73
74    q->setEventRate(accelerometer, ms2ns(10));
75
76    sp<Looper> loop = new Looper(false);
77    loop->addFd(q->getFd(), 0, ALOOPER_EVENT_INPUT, receiver, q.get());
78
79    do {
80        //printf("about to poll...\n");
81        int32_t ret = loop->pollOnce(-1);
82        switch (ret) {
83            case ALOOPER_POLL_WAKE:
84                //("ALOOPER_POLL_WAKE\n");
85                break;
86            case ALOOPER_POLL_CALLBACK:
87                //("ALOOPER_POLL_CALLBACK\n");
88                break;
89            case ALOOPER_POLL_TIMEOUT:
90                printf("ALOOPER_POLL_TIMEOUT\n");
91                break;
92            case ALOOPER_POLL_ERROR:
93                printf("ALOOPER_POLL_TIMEOUT\n");
94                break;
95            default:
96                printf("ugh? poll returned %d\n", ret);
97                break;
98        }
99    } while (1);
100
101
102    return 0;
103}
104