Skip to content
Projects
Groups
Snippets
Help
Loading...
Sign in / Register
Toggle navigation
J
jfx_kalman_filter_src
Project
Project
Details
Activity
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
0
Issues
0
List
Board
Labels
Milestones
Merge Requests
0
Merge Requests
0
CI / CD
CI / CD
Pipelines
Jobs
Schedules
Charts
Packages
Packages
Wiki
Wiki
Snippets
Snippets
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Open sidebar
oscar
jfx_kalman_filter_src
Commits
924a2370
Commit
924a2370
authored
Jul 22, 2022
by
oscar
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
update
parent
8c57ae11
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
6 additions
and
1 deletion
+6
-1
TrackingRos2.cpp
ros2/TrackingRos2.cpp
+6
-1
No files found.
ros2/TrackingRos2.cpp
View file @
924a2370
...
...
@@ -334,6 +334,10 @@ void TrackingRos2::TrackingPorcess(objTrackListPtr objsPtr) {
while
(
orient
.
y
<
-
_PI_
)
{
orient
.
y
+=
_PI_
*
2
;
}
geometry_msgs
::
msg
::
Vector3
&
linear
=
obj
.
kinematics
.
twist_with_covariance
.
twist
.
linear
;
linear
.
x
*=
10
;
linear
.
y
*=
10
;
geometry_msgs
::
msg
::
Point
&
poss
=
obj
.
kinematics
.
pose_with_covariance
.
pose
.
position
;
if
(
is_need_send
==
1
&&
orient
.
y
<
2
&&
poss
.
y
>
-
15
&&
poss
.
y
<
15
)
{
...
...
@@ -404,7 +408,8 @@ void TrackingRos2::TrackingPorcess(objTrackListPtr objsPtr) {
markerText
.
color
.
b
=
0.0
f
;
markerText
.
color
.
a
=
1.0
;
char
str
[
512
]
=
{};
sprintf
(
str
,
"%.2f:%d:%.2f"
,
obj
.
existence_probability
,
obj
.
classification
[
0
].
label
,
poss
.
x
);
sprintf
(
str
,
"%d:%.2f"
,
iter
.
first
,
linear
.
x
);
// sprintf(str, "%.2f:%d:%.2f",obj.existence_probability,obj.classification[0].label,poss.x);
markerText
.
text
=
str
;
makerTextArray
.
markers
.
emplace_back
(
markerText
);
sendObjs
.
objects
.
emplace_back
(
obj
);
...
...
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