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
b982dec1
Commit
b982dec1
authored
Dec 29, 2021
by
oscar
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
去除打印
parent
568ab898
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
3 additions
and
3 deletions
+3
-3
Track3D.cpp
BaseTracker/Track3D.cpp
+3
-3
No files found.
BaseTracker/Track3D.cpp
View file @
b982dec1
...
...
@@ -34,8 +34,8 @@ double correct_angle(std::vector<point2d>& points)
Eigen
::
SelfAdjointEigenSolver
<
Eigen
::
MatrixXd
>
eig
(
C
);
// 产生的vec和val按照特征值升序排列
vec
=
eig
.
eigenvectors
();
val
=
eig
.
eigenvalues
();
SDK_LOG
(
SDK_INFO
,
"vec = [%f,%f,%f,%f]"
,
vec
(
0
,
0
),
vec
(
0
,
1
),
vec
(
1
,
0
),
vec
(
1
,
1
));
SDK_LOG
(
SDK_INFO
,
"val = [%f,%f]"
,
val
(
0
),
val
(
1
));
//
SDK_LOG(SDK_INFO, "vec = [%f,%f,%f,%f]", vec(0, 0), vec(0, 1), vec(1, 0), vec(1, 1));
//
SDK_LOG(SDK_INFO, "val = [%f,%f]", val(0), val(1));
// 打印
//cout << "X_copy: " << endl << X_copy
Eigen
::
Vector2d
dX
(
points
[
4
].
x
-
points
[
0
].
x
,
points
[
4
].
y
-
points
[
0
].
y
);
...
...
@@ -43,7 +43,7 @@ double correct_angle(std::vector<point2d>& points)
double
alpha
=
dX
.
transpose
()
*
orientation
;
if
(
alpha
<
0
)
orientation
=
-
orientation
;
SDK_LOG
(
SDK_INFO
,
"correct_angle alpha = %f, orientation[0] = %f, orientation[1] = %f"
,
alpha
,
orientation
[
0
],
orientation
[
1
]);
//
SDK_LOG(SDK_INFO, "correct_angle alpha = %f, orientation[0] = %f, orientation[1] = %f", alpha, orientation[0], orientation[1]);
double
center_rot_y
=
atan2
(
orientation
[
1
],
orientation
[
0
]);
return
center_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