/
gyroscopesensor.cpp
113 lines (85 loc) · 3.14 KB
/
gyroscopesensor.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
/**
@file gyroscopesensor.cpp
@brief GyroscopeSensor
<p>
Copyright (C) 2009-2010 Nokia Corporation
@author Timo Rongas <ext-timo.2.rongas@nokia.com>
@author Samuli Piippo <ext-samuli.1.piippo@nokia.com>
This file is part of Sensord.
Sensord is free software; you can redistribute it and/or modify
it under the terms of the GNU Lesser General Public License
version 2.1 as published by the Free Software Foundation.
Sensord is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with Sensord. If not, see <http://www.gnu.org/licenses/>.
</p>
*/
#include "gyroscopesensor.h"
#include "sensord/sensormanager.h"
#include "sensord/bin.h"
#include "sensord/bufferreader.h"
GyroscopeSensorChannel::GyroscopeSensorChannel(const QString& id) :
AbstractSensorChannel(id),
DbusEmitter<AngularVelocityData>(10),
previousSample_(0,0,0,0)
{
SensorManager& sm = SensorManager::instance();
gyroscopeAdaptor_ = sm.requestDeviceAdaptor("gyroscopeadaptor");
Q_ASSERT( gyroscopeAdaptor_ );
gyroscopeReader_ = new BufferReader<AngularVelocityData>(128);
outputBuffer_ = new RingBuffer<AngularVelocityData>(128);
// Create buffers for filter chain
filterBin_ = new Bin;
filterBin_->add(gyroscopeReader_, "gyroscope");
filterBin_->add(outputBuffer_, "output");
filterBin_->join("gyroscope", "source", "output", "sink");
// Join datasources to the chain
connectToSource(gyroscopeAdaptor_, "gyroscope", gyroscopeReader_);
marshallingBin_ = new Bin;
marshallingBin_->add(this, "sensorchannel");
outputBuffer_->join(this);
// Set MetaData
setDescription("x, y, and z axes angular velocity in mdps");
setRangeSource(gyroscopeAdaptor_);
addStandbyOverrideSource(gyroscopeAdaptor_);
setIntervalSource(gyroscopeAdaptor_);
isValid_ = true;
}
GyroscopeSensorChannel::~GyroscopeSensorChannel()
{
SensorManager& sm = SensorManager::instance();
disconnectFromSource(gyroscopeAdaptor_, "gyroscope", gyroscopeReader_);
sm.releaseDeviceAdaptor("gyroscopeadaptor");
delete gyroscopeReader_;
delete outputBuffer_;
delete marshallingBin_;
delete filterBin_;
}
bool GyroscopeSensorChannel::start()
{
sensordLogD() << "Starting GyroscopeSensorChannel";
if (AbstractSensorChannel::start()) {
marshallingBin_->start();
filterBin_->start();
gyroscopeAdaptor_->startSensor("gyroscope");
}
return true;
}
bool GyroscopeSensorChannel::stop()
{
sensordLogD() << "Stopping GyroscopeSensorChannel";
if (AbstractSensorChannel::stop()) {
gyroscopeAdaptor_->stopSensor("gyroscope");
filterBin_->stop();
marshallingBin_->stop();
}
return true;
}
void GyroscopeSensorChannel::emitToDbus(const AngularVelocityData& value)
{
previousSample_ = value;
writeToClients((const void*)(&value), sizeof(AngularVelocityData));
}