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
114f46e5
Commit
114f46e5
authored
Dec 28, 2021
by
oscar
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
提交逻辑漏的内容
parent
6e24124e
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
8 additions
and
2 deletions
+8
-2
Track3D.cpp
BaseTracker/Track3D.cpp
+8
-2
No files found.
BaseTracker/Track3D.cpp
View file @
114f46e5
...
...
@@ -298,7 +298,13 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
{
if
(
kf_
==
nullptr
)
return
;
double
rot_y
=
data
[
3
];
if
(
data
.
size
()
!=
8
)
{
SDK_LOG
(
SDK_INFO
,
"UpdateDataCheck data size is not 8"
);
return
;
}
std
::
vector
<
float
>
tmp
(
data
.
begin
()
+
1
,
data
.
end
());
double
rot_y
=
tmp
[
3
];
if
(
m_points
.
size
()
>=
5
&&
(
abs
(
m_points
[
4
].
x
-
m_points
[
0
].
x
)
>
DIST_THRED
||
abs
(
m_points
[
4
].
y
-
m_points
[
0
].
y
)
>
DIST_THRED
))
{
double
center_rot_y
=
correct_angle
(
m_points
);
...
...
@@ -334,7 +340,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
}
float
detaT
=
abs
(
deta
)
>
abs
(
deta2
)
?
deta2
:
deta
;
rot_y
=
x_angle
+
detaT
;
out
=
data
;
out
=
tmp
;
out
[
3
]
=
rot_y
;
}
...
...
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