Skip to content
Toggle navigation
P
Projects
G
Groups
S
Snippets
Help
Hideaki Tai
/
omni_main
This project
Loading...
Sign in
Toggle navigation
Go to a project
Project
Repository
Issues
0
Merge Requests
0
Pipelines
Wiki
Snippets
Members
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Commit
93b83144
authored
Dec 03, 2018
by
Hideaki Tai
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
fix value type conversion error
parent
44d373e9
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
14 additions
and
11 deletions
+14
-11
lib/Whill/ProtocolUnpacker.h
+14
-11
No files found.
lib/Whill/ProtocolUnpacker.h
View file @
93b83144
...
...
@@ -44,24 +44,27 @@ public:
uint8_t
turnDecel
()
{
return
data
(
10
);
}
// DATASET::SENSOR_INFO
float
sensorAccelX
()
{
return
(
uint16_t
)((
float
)((
data
(
1
)
<<
8
)
|
|
(
data
(
2
)))
*
0
.
122
f
);
}
// [mg]
float
sensorAccelY
()
{
return
(
uint16_t
)((
float
)((
data
(
3
)
<<
8
)
|
|
(
data
(
4
)))
*
0
.
122
f
);
}
// [mg]
float
sensorAccelZ
()
{
return
(
uint16_t
)((
float
)((
data
(
5
)
<<
8
)
|
|
(
data
(
6
)))
*
0
.
122
f
);
}
// [mg]
float
sensorGyroX
()
{
return
(
uint16_t
)((
float
)((
data
(
7
)
<<
8
)
|
|
(
data
(
8
)))
*
4
.
375
f
);
}
// [mdps]
float
sensorGyroY
()
{
return
(
uint16_t
)((
float
)((
data
(
9
)
<<
8
)
|
|
(
data
(
10
)))
*
4
.
375
f
);
}
// [mdps]
float
sensorGyroZ
()
{
return
(
uint16_t
)((
float
)((
data
(
11
)
<<
8
)
|
|
(
data
(
12
)))
*
4
.
375
f
);
}
// [mdps]
float
sensorAccelX
()
{
return
(
uint16_t
)((
float
)((
data
(
1
)
<<
8
)
|
(
data
(
2
)))
*
0
.
122
f
);
}
// [mg]
float
sensorAccelY
()
{
return
(
uint16_t
)((
float
)((
data
(
3
)
<<
8
)
|
(
data
(
4
)))
*
0
.
122
f
);
}
// [mg]
float
sensorAccelZ
()
{
return
(
uint16_t
)((
float
)((
data
(
5
)
<<
8
)
|
(
data
(
6
)))
*
0
.
122
f
);
}
// [mg]
float
sensorGyroX
()
{
return
(
uint16_t
)((
float
)((
data
(
7
)
<<
8
)
|
(
data
(
8
)))
*
4
.
375
f
);
}
// [mdps]
float
sensorGyroY
()
{
return
(
uint16_t
)((
float
)((
data
(
9
)
<<
8
)
|
(
data
(
10
)))
*
4
.
375
f
);
}
// [mdps]
float
sensorGyroZ
()
{
return
(
uint16_t
)((
float
)((
data
(
11
)
<<
8
)
|
(
data
(
12
)))
*
4
.
375
f
);
}
// [mdps]
int8_t
joystickFront
()
{
return
(
int8_t
)
data
(
13
);
}
// -100 - +100
int8_t
joystickSide
()
{
return
(
int8_t
)
data
(
14
);
}
// -100 - +100
uint8_t
battery
()
{
return
data
(
15
);
}
// 0 - 100[%]
int16_t
batteryCurrent
()
{
return
(
int16_t
)((
data
(
16
)
<<
8
)
|
|
(
data
(
17
)))
*
2
;
}
// [mA], sampling rate is 4Hz
float
angleRadR
()
{
return
(
float
)(
data
(
18
)
<<
8
)
||
(
data
(
19
))
*
0
.
001
f
;
}
// [rad], range is (-PI, PI)
float
angleRadL
()
{
return
(
float
)(
data
(
20
)
<<
8
)
||
(
data
(
21
))
*
0
.
001
f
;
}
// [rad], range is (-PI, PI)
float
speedR
()
{
return
(
float
)(
data
(
22
)
<<
8
)
||
(
data
(
23
))
*
0
.
004
f
;
}
// [km/h]
float
speedL
()
{
return
(
float
)(
data
(
24
)
<<
8
)
||
(
data
(
25
))
*
0
.
004
f
;
}
// [km/h]
int16_t
batteryCurrent
()
{
return
(
int16_t
)((
data
(
16
)
<<
8
)
|
(
data
(
17
)))
*
2
;
}
// [mA], sampling rate is 4Hz
float
angleRadR
()
{
return
(
float
)(
int16_t
)((
data
(
18
)
<<
8
)
|
(
data
(
19
)
))
*
0
.
001
f
;
}
// [rad], range is (-PI, PI)
float
angleRadL
()
{
return
(
float
)(
int16_t
)((
data
(
20
)
<<
8
)
|
(
data
(
21
)
))
*
0
.
001
f
;
}
// [rad], range is (-PI, PI)
float
speedR
()
{
return
(
float
)(
int16_t
)((
data
(
22
)
<<
8
)
|
(
data
(
23
)
))
*
0
.
004
f
;
}
// [km/h]
float
speedL
()
{
return
(
float
)(
int16_t
)((
data
(
24
)
<<
8
)
|
(
data
(
25
)
))
*
0
.
004
f
;
}
// [km/h]
bool
powerState
()
{
return
(
bool
)
data
(
26
);
}
uint8_t
speedModeIndicator
()
{
return
data
(
27
);
}
uint8_t
errorCode
()
{
return
data
(
28
);
}
// TODO: Gear Ratio 20.23:1
// TODO: where to apply it??
private
:
static
const
std
::
size_t
READ_BUFFER_SIZE
=
32
;
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment