-
Notifications
You must be signed in to change notification settings - Fork 15
Expand file tree
/
Copy pathSensor.cpp
More file actions
118 lines (108 loc) · 3.07 KB
/
Sensor.cpp
File metadata and controls
118 lines (108 loc) · 3.07 KB
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
114
115
116
117
118
////////////////////////////////////////////////////////////
//
// SFML - Simple and Fast Multimedia Library
// Copyright (C) 2007-2015 Laurent Gomila ([email protected])
//
// This software is provided 'as-is', without any express or implied warranty.
// In no event will the authors be held liable for any damages arising from the use of this software.
//
// Permission is granted to anyone to use this software for any purpose,
// including commercial applications, and to alter it and redistribute it freely,
// subject to the following restrictions:
//
// 1. The origin of this software must not be misrepresented;
// you must not claim that you wrote the original software.
// If you use this software in a product, an acknowledgment
// in the product documentation would be appreciated but is not required.
//
// 2. Altered source versions must be plainly marked as such,
// and must not be misrepresented as being the original software.
//
// 3. This notice may not be removed or altered from any source distribution.
//
////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////
// Headers
////////////////////////////////////////////////////////////
#include <cpp3ds/Window/Sensor.hpp>
#ifndef EMULATION
#include <3ds.h>
#endif
namespace cpp3ds
{
bool Sensor::m_accel_enabled = false;
bool Sensor::m_gyro_enabled = false;
Vector3f Sensor::m_gyro = {0,0,0};
Vector3f Sensor::m_accel = {0,0,0};
////////////////////////////////////////////////////////////
bool Sensor::isAvailable(Type sensor)
{
switch(sensor) {
case Sensor::Gyroscope:
case Sensor::Accelerometer:
return true;
default:
return false;
}
}
////////////////////////////////////////////////////////////
void Sensor::setEnabled(Type sensor, bool enabled)
{
#ifndef EMULATION
if (sensor == Sensor::Gyroscope && enabled != m_gyro_enabled) {
m_gyro_enabled = enabled;
if (enabled)
HIDUSER_EnableGyroscope();
else
HIDUSER_DisableGyroscope();
}
else if (sensor == Sensor::Accelerometer && enabled != m_accel_enabled) {
m_accel_enabled = enabled;
if (enabled)
HIDUSER_EnableAccelerometer();
else
HIDUSER_DisableAccelerometer();
}
#endif
}
////////////////////////////////////////////////////////////
bool Sensor::isEnabled(Type sensor)
{
switch(sensor) {
case Sensor::Gyroscope:
return m_gyro_enabled;
case Sensor::Accelerometer:
return m_accel_enabled;
default:
return false;
}
}
////////////////////////////////////////////////////////////
Vector3f Sensor::getValue(Type sensor)
{
switch(sensor) {
case Sensor::Gyroscope:
return m_gyro;
case Sensor::Accelerometer:
return m_accel;
default:
return Vector3f(0,0,0);
}
}
////////////////////////////////////////////////////////////
void Sensor::update()
{
#ifndef EMULATION
if(m_gyro_enabled) {
angularRate gyro;
hidGyroRead(&gyro);
m_gyro = Vector3f{gyro.x/100.f, gyro.y/100.f, gyro.z/100.f};
}
if(m_accel_enabled) {
accelVector accel;
hidAccelRead(&accel);
m_accel = {accel.x/100.f, accel.y/100.f, accel.z/100.f};
}
#endif
}
} // namespace cpp3ds