-
Notifications
You must be signed in to change notification settings - Fork 24
/
GyroscopeSensorShield.cpp
75 lines (62 loc) · 1.65 KB
/
GyroscopeSensorShield.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
/*
Project: 1Sheeld Library
File: GyroscopeSensorShield.cpp
Version: 1.0
Compiler: Arduino avr-gcc 4.3.2
Author: Integreight
Date: 2014.5
*/
#define FROM_ONESHEELD_LIBRARY
#include "OneSheeld.h"
#include "GyroscopeSensorShield.h"
//Class Constructor
GyroscopeSensorShield::GyroscopeSensorShield() : ShieldParent(GYROSCOPE_ID)
{
valueX=0;
valueY=0;
valueZ=0;
isCallBackAssigned=false;
}
//X-Axis getter function
float GyroscopeSensorShield::getX()
{
return valueX;
}
//Y-Axis getter function
float GyroscopeSensorShield::getY()
{
return valueY;
}
//Z-Axis getter function
float GyroscopeSensorShield::getZ()
{
return valueZ;
}
//GyroscopeSensor Input Data processing
void GyroscopeSensorShield::processData()
{
//Check Function-ID
byte functionId=getOneSheeldInstance().getFunctionId();
if(functionId==GYROSCOPE_VALUE)
{
//Process X-Axis Value
valueX=getOneSheeldInstance().convertBytesToFloat(getOneSheeldInstance().getArgumentData(0));
//Process Y-Axis Value
valueY=getOneSheeldInstance().convertBytesToFloat(getOneSheeldInstance().getArgumentData(1));
//Process Z-Axis Value
valueZ=getOneSheeldInstance().convertBytesToFloat(getOneSheeldInstance().getArgumentData(2));
//User Function Invoked
if(isCallBackAssigned && !isInACallback())
{
enteringACallback();
(*changeCallBack)(valueX,valueY,valueZ);
exitingACallback();
}
}
}
//Users Function Setter
void GyroscopeSensorShield::setOnValueChange(void (*userFunction)(float valueX, float valueY ,float valueZ))
{
changeCallBack=userFunction;
isCallBackAssigned=true;
}