Skip to content
体验新版
项目
组织
正在加载...
登录
切换导航
打开侧边栏
Pinoxchio
apollo
提交
d77b9001
A
apollo
项目概览
Pinoxchio
/
apollo
与 Fork 源项目一致
从无法访问的项目Fork
通知
2
Star
0
Fork
0
代码
文件
提交
分支
Tags
贡献者
分支图
Diff
Issue
0
列表
看板
标记
里程碑
合并请求
0
Wiki
0
Wiki
分析
仓库
DevOps
项目成员
Pages
A
apollo
项目概览
项目概览
详情
发布
仓库
仓库
文件
提交
分支
标签
贡献者
分支图
比较
Issue
0
Issue
0
列表
看板
标记
里程碑
合并请求
0
合并请求
0
Pages
分析
分析
仓库分析
DevOps
Wiki
0
Wiki
成员
成员
收起侧边栏
关闭侧边栏
动态
分支图
创建新Issue
提交
Issue看板
前往新版Gitcode,体验更适合开发者的 AI 搜索 >>
提交
d77b9001
编写于
12月 08, 2018
作者:
X
Xiangquan Xiao
提交者:
Jiangtao Hu
12月 13, 2018
浏览文件
操作
浏览文件
下载
电子邮件补丁
差异文件
Robot: Fix float assignment warnings. (#2288)
上级
d6f08899
变更
58
隐藏空白更改
内联
并排
Showing
58 changed file
with
148 addition
and
148 deletion
+148
-148
modules/common/math/math_utils.h
modules/common/math/math_utils.h
+1
-1
modules/drivers/velodyne/parser/util.cc
modules/drivers/velodyne/parser/util.cc
+1
-1
modules/drivers/velodyne/parser/velodyne128_parser.cc
modules/drivers/velodyne/parser/velodyne128_parser.cc
+1
-1
modules/drivers/velodyne/parser/velodyne16_parser.cc
modules/drivers/velodyne/parser/velodyne16_parser.cc
+3
-3
modules/localization/msf/common/util/voxel_grid_covariance_hdmap.h
...ocalization/msf/common/util/voxel_grid_covariance_hdmap.h
+1
-1
modules/localization/msf/local_integ/localization_lidar.cc
modules/localization/msf/local_integ/localization_lidar.cc
+1
-1
modules/localization/msf/local_map/lossy_map/lossy_map_matrix_2d.h
...ocalization/msf/local_map/lossy_map/lossy_map_matrix_2d.h
+2
-2
modules/localization/msf/local_tool/map_creation/lossless_map_to_lossy_map.cc
.../msf/local_tool/map_creation/lossless_map_to_lossy_map.cc
+6
-6
modules/perception/base/object.h
modules/perception/base/object.h
+1
-1
modules/perception/base/vehicle_struct.h
modules/perception/base/vehicle_struct.h
+6
-6
modules/perception/camera/common/util.cc
modules/perception/camera/common/util.cc
+1
-1
modules/perception/camera/lib/lane/postprocessor/denseline/denseline_lane_postprocessor.cc
...e/postprocessor/denseline/denseline_lane_postprocessor.cc
+5
-5
modules/perception/camera/lib/obstacle/detector/yolo/region_output.h
...ception/camera/lib/obstacle/detector/yolo/region_output.h
+4
-4
modules/perception/camera/lib/obstacle/tracker/common/similar.cc
.../perception/camera/lib/obstacle/tracker/common/similar.cc
+1
-1
modules/perception/camera/lib/obstacle/tracker/omt/obstacle_reference.cc
...ion/camera/lib/obstacle/tracker/omt/obstacle_reference.cc
+2
-2
modules/perception/camera/lib/obstacle/tracker/omt/obstacle_reference.h
...tion/camera/lib/obstacle/tracker/omt/obstacle_reference.h
+3
-3
modules/perception/camera/lib/obstacle/tracker/omt/omt_obstacle_tracker.cc
...n/camera/lib/obstacle/tracker/omt/omt_obstacle_tracker.cc
+2
-2
modules/perception/camera/lib/traffic_light/detector/detection/cropbox.h
...ion/camera/lib/traffic_light/detector/detection/cropbox.h
+1
-1
modules/perception/camera/test/camera_lib_calibration_service_online_calibration_service_test.cc
...ib_calibration_service_online_calibration_service_test.cc
+2
-2
modules/perception/camera/test/camera_lib_lane_common_functions_test.cc
...tion/camera/test/camera_lib_lane_common_functions_test.cc
+2
-2
modules/perception/camera/test/camera_lib_obstacle_detector_yolo_region_output_test.cc
...t/camera_lib_obstacle_detector_yolo_region_output_test.cc
+1
-1
modules/perception/camera/test/camera_lib_obstacle_tracker_common_test.cc
...on/camera/test/camera_lib_obstacle_tracker_common_test.cc
+1
-1
modules/perception/camera/test/camera_lib_obstacle_tracker_omt_omt_obstacle_tracker_test.cc
...era_lib_obstacle_tracker_omt_omt_obstacle_tracker_test.cc
+11
-11
modules/perception/camera/tools/obstacle_detection/obstacle_detection.cc
...ion/camera/tools/obstacle_detection/obstacle_detection.cc
+6
-6
modules/perception/camera/tools/offline/offline_obstacle_pipeline.cc
...ception/camera/tools/offline/offline_obstacle_pipeline.cc
+1
-1
modules/perception/common/graph/gated_hungarian_bigraph_matcher_test.cc
...tion/common/graph/gated_hungarian_bigraph_matcher_test.cc
+8
-8
modules/perception/common/graph/graph_segmentor.h
modules/perception/common/graph/graph_segmentor.h
+1
-1
modules/perception/common/i_lib/pc/i_ground.cc
modules/perception/common/i_lib/pc/i_ground.cc
+14
-14
modules/perception/common/image_processing/hough_transfer.h
modules/perception/common/image_processing/hough_transfer.h
+3
-3
modules/perception/common/io/io_util.cc
modules/perception/common/io/io_util.cc
+2
-2
modules/perception/common/point_cloud_processing/downsampling_test.cc
...eption/common/point_cloud_processing/downsampling_test.cc
+1
-1
modules/perception/fusion/common/camera_util.cc
modules/perception/fusion/common/camera_util.cc
+1
-1
modules/perception/fusion/lib/data_association/hm_data_association/track_object_similarity.cc
...ssociation/hm_data_association/track_object_similarity.cc
+4
-4
modules/perception/fusion/lib/data_fusion/shape_fusion/pbf_shape_fusion/pbf_shape_fusion.cc
..._fusion/shape_fusion/pbf_shape_fusion/pbf_shape_fusion.cc
+1
-1
modules/perception/inference/operators/roipooling_layer_test.cc
...s/perception/inference/operators/roipooling_layer_test.cc
+1
-1
modules/perception/inference/test/inference_util_test.cc
modules/perception/inference/test/inference_util_test.cc
+1
-1
modules/perception/lidar/common/feature_descriptor.h
modules/perception/lidar/common/feature_descriptor.h
+3
-3
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector.cc
...mporal_ground_detector/spatio_temporal_ground_detector.cc
+1
-1
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector.h
...emporal_ground_detector/spatio_temporal_ground_detector.h
+1
-1
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector_test.cc
...l_ground_detector/spatio_temporal_ground_detector_test.cc
+2
-2
modules/perception/lidar/lib/interface/base_bipartite_graph_matcher.h
...eption/lidar/lib/interface/base_bipartite_graph_matcher.h
+2
-2
modules/perception/lidar/lib/pointcloud_preprocessor/pointcloud_preprocessor.h
...dar/lib/pointcloud_preprocessor/pointcloud_preprocessor.h
+5
-5
modules/perception/lidar/lib/segmentation/cnnseg/feature_generator.cc
...eption/lidar/lib/segmentation/cnnseg/feature_generator.cc
+1
-1
modules/perception/lidar/lib/segmentation/cnnseg/feature_generator.h
...ception/lidar/lib/segmentation/cnnseg/feature_generator.h
+3
-3
modules/perception/lidar/lib/segmentation/cnnseg/spp_engine/spp_struct.h
...ion/lidar/lib/segmentation/cnnseg/spp_engine/spp_struct.h
+1
-1
modules/perception/lidar/lib/tracker/association/distance_collection.cc
...tion/lidar/lib/tracker/association/distance_collection.cc
+2
-2
modules/perception/lidar/lib/tracker/common/tracked_object.h
modules/perception/lidar/lib/tracker/common/tracked_object.h
+1
-1
modules/perception/lidar/lib/tracker/multi_lidar_fusion/mlf_motion_measurement.cc
.../lib/tracker/multi_lidar_fusion/mlf_motion_measurement.cc
+1
-1
modules/perception/onboard/component/fusion_camera_detection_component.cc
...on/onboard/component/fusion_camera_detection_component.cc
+2
-2
modules/perception/onboard/component/segmentation_component.h
...les/perception/onboard/component/segmentation_component.h
+1
-1
modules/perception/radar/lib/preprocessor/conti_ars_preprocessor/conti_ars_preprocessor.h
...processor/conti_ars_preprocessor/conti_ars_preprocessor.h
+1
-1
modules/planning/common/reference_line_info.cc
modules/planning/common/reference_line_info.cc
+4
-4
modules/planning/open_space/distance_approach_problem_test.cc
...les/planning/open_space/distance_approach_problem_test.cc
+1
-1
modules/planning/open_space/dual_variable_warm_start_ipopt_interface_test.cc
...en_space/dual_variable_warm_start_ipopt_interface_test.cc
+1
-1
modules/prediction/evaluator/vehicle/rnn_evaluator.cc
modules/prediction/evaluator/vehicle/rnn_evaluator.cc
+6
-6
modules/prediction/network/net_layer.cc
modules/prediction/network/net_layer.cc
+2
-2
modules/prediction/network/net_layer.h
modules/prediction/network/net_layer.h
+2
-2
modules/transform/buffer_interface.h
modules/transform/buffer_interface.h
+2
-2
未找到文件。
modules/common/math/math_utils.h
浏览文件 @
d77b9001
...
@@ -186,7 +186,7 @@ inline void L2Norm(int feat_dim, float *feat_data) {
...
@@ -186,7 +186,7 @@ inline void L2Norm(int feat_dim, float *feat_data) {
return
;
return
;
}
}
// feature normalization
// feature normalization
float
l2norm
=
0.0
;
float
l2norm
=
0.0
f
;
for
(
int
i
=
0
;
i
<
feat_dim
;
++
i
)
{
for
(
int
i
=
0
;
i
<
feat_dim
;
++
i
)
{
l2norm
+=
feat_data
[
i
]
*
feat_data
[
i
];
l2norm
+=
feat_data
[
i
]
*
feat_data
[
i
];
}
}
...
...
modules/drivers/velodyne/parser/util.cc
浏览文件 @
d77b9001
...
@@ -24,7 +24,7 @@ void init_sin_cos_rot_table(float* sin_rot_table, float* cos_rot_table,
...
@@ -24,7 +24,7 @@ void init_sin_cos_rot_table(float* sin_rot_table, float* cos_rot_table,
uint16_t
rotation
,
float
rotation_resolution
)
{
uint16_t
rotation
,
float
rotation_resolution
)
{
for
(
uint16_t
i
=
0
;
i
<
rotation
;
++
i
)
{
for
(
uint16_t
i
=
0
;
i
<
rotation
;
++
i
)
{
// float rotation = angles::from_degrees(rotation_resolution * i);
// float rotation = angles::from_degrees(rotation_resolution * i);
float
rotation
=
rotation_resolution
*
i
*
M_PI
/
180.0
;
float
rotation
=
rotation_resolution
*
i
*
M_PI
/
180.0
f
;
cos_rot_table
[
i
]
=
cosf
(
rotation
);
cos_rot_table
[
i
]
=
cosf
(
rotation
);
sin_rot_table
[
i
]
=
sinf
(
rotation
);
sin_rot_table
[
i
]
=
sinf
(
rotation
);
}
}
...
...
modules/drivers/velodyne/parser/velodyne128_parser.cc
浏览文件 @
d77b9001
...
@@ -73,7 +73,7 @@ void Velodyne128Parser::Order(std::shared_ptr<PointCloud> cloud) {
...
@@ -73,7 +73,7 @@ void Velodyne128Parser::Order(std::shared_ptr<PointCloud> cloud) {
void
Velodyne128Parser
::
Unpack
(
const
VelodynePacket
&
pkt
,
void
Velodyne128Parser
::
Unpack
(
const
VelodynePacket
&
pkt
,
std
::
shared_ptr
<
PointCloud
>
pc
)
{
std
::
shared_ptr
<
PointCloud
>
pc
)
{
float
azimuth_diff
,
azimuth_corrected_f
;
float
azimuth_diff
,
azimuth_corrected_f
;
float
last_azimuth_diff
=
0
;
float
last_azimuth_diff
=
0
.0
f
;
uint16_t
azimuth
,
azimuth_next
,
azimuth_corrected
;
uint16_t
azimuth
,
azimuth_next
,
azimuth_corrected
;
// float x_coord, y_coord, z_coord;
// float x_coord, y_coord, z_coord;
// const raw_packet_t *raw = (const raw_packet_t *)&pkt.data[0];
// const raw_packet_t *raw = (const raw_packet_t *)&pkt.data[0];
...
...
modules/drivers/velodyne/parser/velodyne16_parser.cc
浏览文件 @
d77b9001
...
@@ -67,9 +67,9 @@ uint64_t Velodyne16Parser::GetTimestamp(double base_time, float time_offset,
...
@@ -67,9 +67,9 @@ uint64_t Velodyne16Parser::GetTimestamp(double base_time, float time_offset,
*/
*/
void
Velodyne16Parser
::
Unpack
(
const
VelodynePacket
&
pkt
,
void
Velodyne16Parser
::
Unpack
(
const
VelodynePacket
&
pkt
,
std
::
shared_ptr
<
PointCloud
>
pc
)
{
std
::
shared_ptr
<
PointCloud
>
pc
)
{
float
azimuth_diff
=
0.0
;
float
azimuth_diff
=
0.0
f
;
float
last_azimuth_diff
=
0.0
;
float
last_azimuth_diff
=
0.0
f
;
float
azimuth_corrected_f
=
0.0
;
float
azimuth_corrected_f
=
0.0
f
;
int
azimuth_corrected
=
0.0
;
int
azimuth_corrected
=
0.0
;
// const RawPacket* raw = (const RawPacket*)&pkt.data[0];
// const RawPacket* raw = (const RawPacket*)&pkt.data[0];
...
...
modules/localization/msf/common/util/voxel_grid_covariance_hdmap.h
浏览文件 @
d77b9001
...
@@ -340,7 +340,7 @@ class VoxelGridCovariance : public pcl::VoxelGrid<PointT> {
...
@@ -340,7 +340,7 @@ class VoxelGridCovariance : public pcl::VoxelGrid<PointT> {
// Get the distance value
// Get the distance value
const
uint8_t
*
pt_data
=
const
uint8_t
*
pt_data
=
reinterpret_cast
<
const
uint8_t
*>
(
&
input_
->
points
[
cp
]);
reinterpret_cast
<
const
uint8_t
*>
(
&
input_
->
points
[
cp
]);
float
distance_value
=
0
;
float
distance_value
=
0
.0
f
;
memcpy
(
&
distance_value
,
pt_data
+
fields
[
distance_idx
].
offset
,
memcpy
(
&
distance_value
,
pt_data
+
fields
[
distance_idx
].
offset
,
sizeof
(
float
));
sizeof
(
float
));
...
...
modules/localization/msf/local_integ/localization_lidar.cc
浏览文件 @
d77b9001
...
@@ -253,7 +253,7 @@ void LocalizationLidar::RefineAltitudeFromMap(Eigen::Affine3d *pose) {
...
@@ -253,7 +253,7 @@ void LocalizationLidar::RefineAltitudeFromMap(Eigen::Affine3d *pose) {
pre_vehicle_ground_height_
=
lidar_pose
.
translation
()(
2
)
-
height_diff
;
pre_vehicle_ground_height_
=
lidar_pose
.
translation
()(
2
)
-
height_diff
;
}
}
float
vehicle_ground_alt
=
0.0
;
float
vehicle_ground_alt
=
0.0
f
;
unsigned
int
x
=
0
;
unsigned
int
x
=
0
;
unsigned
int
y
=
0
;
unsigned
int
y
=
0
;
if
(
node
->
GetCoordinate
(
lidar_trans
,
&
x
,
&
y
))
{
if
(
node
->
GetCoordinate
(
lidar_trans
,
&
x
,
&
y
))
{
...
...
modules/localization/msf/local_map/lossy_map/lossy_map_matrix_2d.h
浏览文件 @
d77b9001
...
@@ -116,9 +116,9 @@ class LossyMapMatrix2D : public BaseMapMatrix {
...
@@ -116,9 +116,9 @@ class LossyMapMatrix2D : public BaseMapMatrix {
const
int
var_range_
=
1023
;
// 65535;
const
int
var_range_
=
1023
;
// 65535;
const
int
var_ratio_
=
4
;
// 256;
const
int
var_ratio_
=
4
;
// 256;
// const unsigned int _alt_range = 1023;//65535;
// const unsigned int _alt_range = 1023;//65535;
const
float
alt_ground_interval_
=
0.04
;
const
float
alt_ground_interval_
=
0.04
f
;
const
uint16_t
ground_void_flag_
=
0xffff
;
const
uint16_t
ground_void_flag_
=
0xffff
;
const
float
alt_avg_interval_
=
0.04
;
const
float
alt_avg_interval_
=
0.04
f
;
const
int
count_range_
=
2
;
// 30;
const
int
count_range_
=
2
;
// 30;
mutable
float
alt_avg_min_
;
mutable
float
alt_avg_min_
;
mutable
float
alt_avg_max_
;
mutable
float
alt_avg_max_
;
...
...
modules/localization/msf/local_tool/map_creation/lossless_map_to_lossy_map.cc
浏览文件 @
d77b9001
...
@@ -174,11 +174,11 @@ int main(int argc, char** argv) {
...
@@ -174,11 +174,11 @@ int main(int argc, char** argv) {
for
(;
itr
!=
buf
.
end
();
++
itr
,
++
index
)
{
for
(;
itr
!=
buf
.
end
();
++
itr
,
++
index
)
{
// int single_alt = 0;
// int single_alt = 0;
// int double_alt = 0;
// int double_alt = 0;
// float delta_alt_max = 0.0;
// float delta_alt_max = 0.0
f
;
// float delta_alt_min = 100.0;
// float delta_alt_min = 100.0
f
;
// int delta_alt_minus_num = 0;
// int delta_alt_minus_num = 0;
// float alt_max = 0.0;
// float alt_max = 0.0
f
;
// float alt_min = 100.0;
// float alt_min = 100.0
f
;
LosslessMapNode
*
lossless_node
=
LosslessMapNode
*
lossless_node
=
static_cast
<
LosslessMapNode
*>
(
lossless_map
.
GetMapNodeSafe
(
*
itr
));
static_cast
<
LosslessMapNode
*>
(
lossless_map
.
GetMapNodeSafe
(
*
itr
));
...
@@ -203,8 +203,8 @@ int main(int argc, char** argv) {
...
@@ -203,8 +203,8 @@ int main(int argc, char** argv) {
unsigned
int
count
=
lossless_node
->
GetCount
(
row
,
col
);
unsigned
int
count
=
lossless_node
->
GetCount
(
row
,
col
);
// Read altitude
// Read altitude
float
altitude_ground
=
0.0
;
float
altitude_ground
=
0.0
f
;
float
altitude_avg
=
0.0
;
float
altitude_avg
=
0.0
f
;
bool
is_ground_useful
=
false
;
bool
is_ground_useful
=
false
;
std
::
vector
<
float
>
layer_alts
;
std
::
vector
<
float
>
layer_alts
;
std
::
vector
<
unsigned
int
>
layer_counts
;
std
::
vector
<
unsigned
int
>
layer_counts
;
...
...
modules/perception/base/object.h
浏览文件 @
d77b9001
...
@@ -87,7 +87,7 @@ struct alignas(16) Object {
...
@@ -87,7 +87,7 @@ struct alignas(16) Object {
// @brief if the velocity estimation is converged, true by default
// @brief if the velocity estimation is converged, true by default
bool
velocity_converged
=
true
;
bool
velocity_converged
=
true
;
// @brief velocity confidence, required
// @brief velocity confidence, required
float
velocity_confidence
=
1.0
;
float
velocity_confidence
=
1.0
f
;
// @brief acceleration of the object, required
// @brief acceleration of the object, required
Eigen
::
Vector3f
acceleration
=
Eigen
::
Vector3f
(
0
,
0
,
0
);
Eigen
::
Vector3f
acceleration
=
Eigen
::
Vector3f
(
0
,
0
,
0
);
// @brief covariance matrix of the acceleration uncertainty, required
// @brief covariance matrix of the acceleration uncertainty, required
...
...
modules/perception/base/vehicle_struct.h
浏览文件 @
d77b9001
...
@@ -20,12 +20,12 @@ namespace perception {
...
@@ -20,12 +20,12 @@ namespace perception {
namespace
base
{
namespace
base
{
struct
CarLight
{
struct
CarLight
{
float
brake_visible
=
0
;
float
brake_visible
=
0
.0
f
;
float
brake_switch_on
=
0
;
float
brake_switch_on
=
0
.0
f
;
float
left_turn_visible
=
0
;
float
left_turn_visible
=
0
.0
f
;
float
left_turn_switch_on
=
0
;
float
left_turn_switch_on
=
0
.0
f
;
float
right_turn_visible
=
0
;
float
right_turn_visible
=
0
.0
f
;
float
right_turn_switch_on
=
0
;
float
right_turn_switch_on
=
0
.0
f
;
void
Reset
()
{
void
Reset
()
{
brake_visible
=
0
;
brake_visible
=
0
;
...
...
modules/perception/camera/common/util.cc
浏览文件 @
d77b9001
...
@@ -118,7 +118,7 @@ bool ResizeCPU(const base::Blob<uint8_t> &src_blob,
...
@@ -118,7 +118,7 @@ bool ResizeCPU(const base::Blob<uint8_t> &src_blob,
const
int
y2_read
=
std
::
min
(
y2
,
height
-
1
);
const
int
y2_read
=
std
::
min
(
y2
,
height
-
1
);
int
src_reg
=
0
;
int
src_reg
=
0
;
for
(
int
c
=
0
;
c
<
channel
;
c
++
)
{
for
(
int
c
=
0
;
c
<
channel
;
c
++
)
{
float
out
=
0
;
float
out
=
0
.0
f
;
int
idx11
=
(
y1_read
*
stepwidth
+
x1_read
)
*
channel
;
int
idx11
=
(
y1_read
*
stepwidth
+
x1_read
)
*
channel
;
src_reg
=
src
[
idx11
+
c
];
src_reg
=
src
[
idx11
+
c
];
...
...
modules/perception/camera/lib/lane/postprocessor/denseline/denseline_lane_postprocessor.cc
浏览文件 @
d77b9001
...
@@ -182,7 +182,7 @@ void DenselineLanePostprocessor::CalLaneMap(
...
@@ -182,7 +182,7 @@ void DenselineLanePostprocessor::CalLaneMap(
score_channel
[
2
]
=
output_data
[
channel2_pos
+
x
];
score_channel
[
2
]
=
output_data
[
channel2_pos
+
x
];
score_channel
[
3
]
=
output_data
[
channel3_pos
+
x
];
score_channel
[
3
]
=
output_data
[
channel3_pos
+
x
];
// utilize softmax to get the probability
// utilize softmax to get the probability
float
sum_score
=
0
;
float
sum_score
=
0
.0
f
;
for
(
int
i
=
0
;
i
<
4
;
i
++
)
{
for
(
int
i
=
0
;
i
<
4
;
i
++
)
{
score_channel
[
i
]
=
static_cast
<
float
>
(
exp
(
score_channel
[
i
]));
score_channel
[
i
]
=
static_cast
<
float
>
(
exp
(
score_channel
[
i
]));
sum_score
+=
score_channel
[
i
];
sum_score
+=
score_channel
[
i
];
...
@@ -717,13 +717,13 @@ void DenselineLanePostprocessor::AddImageLaneline(
...
@@ -717,13 +717,13 @@ void DenselineLanePostprocessor::AddImageLaneline(
return
;
return
;
}
}
// check the validity of laneline
// check the validity of laneline
float
sum_dist
=
0
;
float
sum_dist
=
0
.0
f
;
float
avg_dist
=
0
;
float
avg_dist
=
0
.0
f
;
int
count
=
0
;
int
count
=
0
;
for
(
int
i
=
0
;
i
<
image_point_set_size
;
i
++
)
{
for
(
int
i
=
0
;
i
<
image_point_set_size
;
i
++
)
{
float
x_pos
=
img_pos_vec
[
i
](
0
,
0
);
float
x_pos
=
img_pos_vec
[
i
](
0
,
0
);
float
y_pos
=
img_pos_vec
[
i
](
1
,
0
);
float
y_pos
=
img_pos_vec
[
i
](
1
,
0
);
float
x_poly
=
0
;
float
x_poly
=
0
.0
f
;
PolyEval
(
y_pos
,
max_poly_order
,
img_coeff
,
&
x_poly
);
PolyEval
(
y_pos
,
max_poly_order
,
img_coeff
,
&
x_poly
);
float
dist
=
static_cast
<
float
>
(
fabs
(
x_poly
-
x_pos
));
float
dist
=
static_cast
<
float
>
(
fabs
(
x_poly
-
x_pos
));
sum_dist
+=
dist
;
sum_dist
+=
dist
;
...
@@ -762,7 +762,7 @@ void DenselineLanePostprocessor::PolyFitCameraLaneline(
...
@@ -762,7 +762,7 @@ void DenselineLanePostprocessor::PolyFitCameraLaneline(
// z: longitudinal direction
// z: longitudinal direction
// x: latitudinal direction
// x: latitudinal direction
float
x_start
=
camera_point_set
[
0
].
z
;
float
x_start
=
camera_point_set
[
0
].
z
;
float
x_end
=
0
;
float
x_end
=
0
.0
f
;
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
camera_coeff
;
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
camera_coeff
;
std
::
vector
<
Eigen
::
Matrix
<
float
,
2
,
1
>
>
camera_pos_vec
;
std
::
vector
<
Eigen
::
Matrix
<
float
,
2
,
1
>
>
camera_pos_vec
;
for
(
int
i
=
0
;
i
<
static_cast
<
int
>
(
camera_point_set
.
size
());
i
++
)
{
for
(
int
i
=
0
;
i
<
static_cast
<
int
>
(
camera_point_set
.
size
());
i
++
)
{
...
...
modules/perception/camera/lib/obstacle/detector/yolo/region_output.h
浏览文件 @
d77b9001
...
@@ -98,10 +98,10 @@ struct YoloBlobs {
...
@@ -98,10 +98,10 @@ struct YoloBlobs {
std
::
shared_ptr
<
base
::
Blob
<
float
>>
expand_blob
;
std
::
shared_ptr
<
base
::
Blob
<
float
>>
expand_blob
;
};
};
struct
MinDims
{
struct
MinDims
{
float
min_2d_height
=
0
;
float
min_2d_height
=
0
.0
f
;
float
min_3d_height
=
0
;
float
min_3d_height
=
0
.0
f
;
float
min_3d_length
=
0
;
float
min_3d_length
=
0
.0
f
;
float
min_3d_width
=
0
;
float
min_3d_width
=
0
.0
f
;
};
};
__host__
__device__
__host__
__device__
...
...
modules/perception/camera/lib/obstacle/tracker/common/similar.cc
浏览文件 @
d77b9001
...
@@ -34,7 +34,7 @@ bool CosineSimilar::Calc(CameraFrame *frame1,
...
@@ -34,7 +34,7 @@ bool CosineSimilar::Calc(CameraFrame *frame1,
->
camera_supplement
.
object_feature
.
size
();
->
camera_supplement
.
object_feature
.
size
();
for
(
auto
&
object1
:
frame1
->
detected_objects
)
{
for
(
auto
&
object1
:
frame1
->
detected_objects
)
{
for
(
auto
&
object2
:
frame2
->
detected_objects
)
{
for
(
auto
&
object2
:
frame2
->
detected_objects
)
{
float
s
=
0
;
float
s
=
0
.0
f
;
for
(
size_t
k
=
0
;
k
<
dim
;
++
k
)
{
for
(
size_t
k
=
0
;
k
<
dim
;
++
k
)
{
s
+=
object1
->
camera_supplement
.
object_feature
[
k
]
s
+=
object1
->
camera_supplement
.
object_feature
[
k
]
*
object2
->
camera_supplement
.
object_feature
[
k
];
*
object2
->
camera_supplement
.
object_feature
[
k
];
...
...
modules/perception/camera/lib/obstacle/tracker/omt/obstacle_reference.cc
浏览文件 @
d77b9001
...
@@ -148,8 +148,8 @@ void ObstacleReference::CorrectSize(CameraFrame *frame) {
...
@@ -148,8 +148,8 @@ void ObstacleReference::CorrectSize(CameraFrame *frame) {
if
(
Contain
(
object_template_manager_
->
TypeRefinedByTemplate
(),
if
(
Contain
(
object_template_manager_
->
TypeRefinedByTemplate
(),
obj
->
sub_type
))
{
obj
->
sub_type
))
{
float
min_template_volume
=
0
;
float
min_template_volume
=
0
.0
f
;
float
max_template_volume
=
0
;
float
max_template_volume
=
0
.0
f
;
auto
min_tmplt
=
kMinTemplateHWL
.
at
(
obj
->
sub_type
);
auto
min_tmplt
=
kMinTemplateHWL
.
at
(
obj
->
sub_type
);
auto
max_tmplt
=
kMaxTemplateHWL
.
at
(
obj
->
sub_type
);
auto
max_tmplt
=
kMaxTemplateHWL
.
at
(
obj
->
sub_type
);
min_template_volume
=
min_tmplt
[
0
]
*
min_tmplt
[
1
]
*
min_tmplt
[
2
];
min_template_volume
=
min_tmplt
[
0
]
*
min_tmplt
[
1
]
*
min_tmplt
[
2
];
...
...
modules/perception/camera/lib/obstacle/tracker/omt/obstacle_reference.h
浏览文件 @
d77b9001
...
@@ -31,9 +31,9 @@ namespace perception {
...
@@ -31,9 +31,9 @@ namespace perception {
namespace
camera
{
namespace
camera
{
struct
Reference
{
struct
Reference
{
float
area
=
0
;
float
area
=
0
.0
f
;
float
k
=
0
;
float
k
=
0
.0
f
;
float
ymax
=
0
;
float
ymax
=
0
.0
f
;
};
};
class
ObstacleReference
{
class
ObstacleReference
{
...
...
modules/perception/camera/lib/obstacle/tracker/omt/omt_obstacle_tracker.cc
浏览文件 @
d77b9001
...
@@ -97,7 +97,7 @@ bool OMTObstacleTracker::CombineDuplicateTargets() {
...
@@ -97,7 +97,7 @@ bool OMTObstacleTracker::CombineDuplicateTargets() {
continue
;
continue
;
}
}
int
count
=
0
;
int
count
=
0
;
float
score
=
0
;
float
score
=
0
.0
f
;
int
index1
=
0
;
int
index1
=
0
;
int
index2
=
0
;
int
index2
=
0
;
while
(
index1
<
targets_
[
i
].
Size
()
&&
index2
<
targets_
[
j
].
Size
())
{
while
(
index1
<
targets_
[
i
].
Size
()
&&
index2
<
targets_
[
j
].
Size
())
{
...
@@ -262,7 +262,7 @@ float OMTObstacleTracker::ScoreShape(const Target &target,
...
@@ -262,7 +262,7 @@ float OMTObstacleTracker::ScoreShape(const Target &target,
float
OMTObstacleTracker
::
ScoreAppearance
(
const
Target
&
target
,
float
OMTObstacleTracker
::
ScoreAppearance
(
const
Target
&
target
,
TrackObjectPtr
track_obj
)
{
TrackObjectPtr
track_obj
)
{
float
energy
=
0
;
float
energy
=
0
.0
f
;
int
count
=
0
;
int
count
=
0
;
auto
sensor_name
=
track_obj
->
indicator
.
sensor_name
;
auto
sensor_name
=
track_obj
->
indicator
.
sensor_name
;
for
(
int
i
=
target
.
Size
()
-
1
;
i
>=
0
;
--
i
)
{
for
(
int
i
=
target
.
Size
()
-
1
;
i
>=
0
;
--
i
)
{
...
...
modules/perception/camera/lib/traffic_light/detector/detection/cropbox.h
浏览文件 @
d77b9001
...
@@ -39,7 +39,7 @@ class CropBox : public IGetBox {
...
@@ -39,7 +39,7 @@ class CropBox : public IGetBox {
const
base
::
TrafficLightPtr
&
light
,
base
::
RectI
*
crop_box
);
const
base
::
TrafficLightPtr
&
light
,
base
::
RectI
*
crop_box
);
private:
private:
float
crop_scale_
=
2.5
;
float
crop_scale_
=
2.5
f
;
int
min_crop_size_
=
270
;
int
min_crop_size_
=
270
;
};
};
...
...
modules/perception/camera/test/camera_lib_calibration_service_online_calibration_service_test.cc
浏览文件 @
d77b9001
...
@@ -64,8 +64,8 @@ TEST(OnlineCalibrationServiceTest, online_calibration_service_test) {
...
@@ -64,8 +64,8 @@ TEST(OnlineCalibrationServiceTest, online_calibration_service_test) {
OnlineCalibrationService
*
online_calib_service
OnlineCalibrationService
*
online_calib_service
=
dynamic_cast
<
OnlineCalibrationService
*>
(
calibration_service
);
=
dynamic_cast
<
OnlineCalibrationService
*>
(
calibration_service
);
if
(
online_calib_service
!=
nullptr
)
{
if
(
online_calib_service
!=
nullptr
)
{
float
camera_ground_height_query
=
0.0
;
float
camera_ground_height_query
=
0.0
f
;
float
camera_pitch_angle_query
=
0.0
;
float
camera_pitch_angle_query
=
0.0
f
;
EXPECT_FALSE
(
online_calib_service
->
BuildIndex
());
EXPECT_FALSE
(
online_calib_service
->
BuildIndex
());
EXPECT_FALSE
(
online_calib_service
->
QueryCameraToGroundHeightAndPitchAngle
(
EXPECT_FALSE
(
online_calib_service
->
QueryCameraToGroundHeightAndPitchAngle
(
&
camera_ground_height_query
,
&
camera_ground_height_query
,
...
...
modules/perception/camera/test/camera_lib_lane_common_functions_test.cc
浏览文件 @
d77b9001
...
@@ -70,7 +70,7 @@ TEST(CommonFunctions, poly_eval_test) {
...
@@ -70,7 +70,7 @@ TEST(CommonFunctions, poly_eval_test) {
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
coeff
;
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
coeff
;
int
order
=
max_poly_order
+
2
;
int
order
=
max_poly_order
+
2
;
float
x
=
1.0
f
;
float
x
=
1.0
f
;
float
y
=
0
;
float
y
=
0
.0
f
;
coeff
(
3
,
0
)
=
1.0
f
;
coeff
(
3
,
0
)
=
1.0
f
;
coeff
(
2
,
0
)
=
1.0
f
;
coeff
(
2
,
0
)
=
1.0
f
;
coeff
(
1
,
0
)
=
1.0
f
;
coeff
(
1
,
0
)
=
1.0
f
;
...
@@ -81,7 +81,7 @@ TEST(CommonFunctions, poly_eval_test) {
...
@@ -81,7 +81,7 @@ TEST(CommonFunctions, poly_eval_test) {
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
coeff
;
Eigen
::
Matrix
<
float
,
max_poly_order
+
1
,
1
>
coeff
;
int
order
=
max_poly_order
;
int
order
=
max_poly_order
;
float
x
=
1.0
f
;
float
x
=
1.0
f
;
float
y
=
0
;
float
y
=
0
.0
f
;
coeff
(
3
,
0
)
=
1.0
f
;
coeff
(
3
,
0
)
=
1.0
f
;
coeff
(
2
,
0
)
=
1.0
f
;
coeff
(
2
,
0
)
=
1.0
f
;
coeff
(
1
,
0
)
=
1.0
f
;
coeff
(
1
,
0
)
=
1.0
f
;
...
...
modules/perception/camera/test/camera_lib_obstacle_detector_yolo_region_output_test.cc
浏览文件 @
d77b9001
...
@@ -130,7 +130,7 @@ TEST(YoloCameraDetectorTest, box_test) {
...
@@ -130,7 +130,7 @@ TEST(YoloCameraDetectorTest, box_test) {
ASSERT_EQ
(
box3
.
xmin
,
1
);
ASSERT_EQ
(
box3
.
xmin
,
1
);
ASSERT_EQ
(
box3
.
xmax
,
10
);
ASSERT_EQ
(
box3
.
xmax
,
10
);
float
size
=
0
;
float
size
=
0
.0
f
;
init_box
(
&
box1
);
init_box
(
&
box1
);
box1
.
xmax
=
0
;
box1
.
xmax
=
0
;
size
=
get_bbox_size
(
box1
);
size
=
get_bbox_size
(
box1
);
...
...
modules/perception/camera/test/camera_lib_obstacle_tracker_common_test.cc
浏览文件 @
d77b9001
...
@@ -92,7 +92,7 @@ TEST(EKFTest, ekf_test) {
...
@@ -92,7 +92,7 @@ TEST(EKFTest, ekf_test) {
// Eigen::Vector3d x;
// Eigen::Vector3d x;
// Eigen::Vector3d z; // observation: x, y, theta
// Eigen::Vector3d z; // observation: x, y, theta
// float speed = 3.0f;
// float speed = 3.0f;
// float theta = 0.5;
// float theta = 0.5
f
;
// ekf.Init();
// ekf.Init();
// ekf.measure_noise_ *= 5;
// ekf.measure_noise_ *= 5;
// ekf.Predict(1.f);
// ekf.Predict(1.f);
...
...
modules/perception/camera/test/camera_lib_obstacle_tracker_omt_omt_obstacle_tracker_test.cc
浏览文件 @
d77b9001
...
@@ -73,12 +73,12 @@ int read_detections(const std::string &path, const int &feature_dim,
...
@@ -73,12 +73,12 @@ int read_detections(const std::string &path, const int &feature_dim,
frame
->
frame_id
=
frame_num
;
frame
->
frame_id
=
frame_num
;
frame
->
track_feature_blob
.
reset
(
new
base
::
Blob
<
float
>
);
frame
->
track_feature_blob
.
reset
(
new
base
::
Blob
<
float
>
);
(
frame
->
track_feature_blob
)
->
Reshape
({
det_count
,
feature_size
});
(
frame
->
track_feature_blob
)
->
Reshape
({
det_count
,
feature_size
});
float
x
=
0
;
float
x
=
0
.0
f
;
float
y
=
0
;
float
y
=
0
.0
f
;
float
width
=
0
;
float
width
=
0
.0
f
;
float
height
=
0
;
float
height
=
0
.0
f
;
float
feature
=
0.0
;
float
feature
=
0.0
f
;
float
score
=
0.0
;
float
score
=
0.0
f
;
frame
->
detected_objects
.
clear
();
frame
->
detected_objects
.
clear
();
for
(
int
i
=
0
;
i
<
det_count
;
++
i
)
{
for
(
int
i
=
0
;
i
<
det_count
;
++
i
)
{
fin
>>
x
>>
y
>>
width
>>
height
>>
score
;
fin
>>
x
>>
y
>>
width
>>
height
>>
score
;
...
@@ -307,10 +307,10 @@ TEST(FusionObstacleTrackerTest, FusionObstacleTracker_test) {
...
@@ -307,10 +307,10 @@ TEST(FusionObstacleTrackerTest, FusionObstacleTracker_test) {
while
(
fin_gt
>>
image_name
>>
det_count
)
{
while
(
fin_gt
>>
image_name
>>
det_count
)
{
std
::
vector
<
base
::
CameraObjectSupplement
>
bboxs
;
std
::
vector
<
base
::
CameraObjectSupplement
>
bboxs
;
base
::
CameraObjectSupplement
bbox
;
base
::
CameraObjectSupplement
bbox
;
float
x
=
0
;
float
x
=
0
.0
f
;
float
y
=
0
;
float
y
=
0
.0
f
;
float
width
=
0
;
float
width
=
0
.0
f
;
float
height
=
0
;
float
height
=
0
.0
f
;
int
id
=
0
;
int
id
=
0
;
for
(
int
i
=
0
;
i
<
det_count
;
++
i
)
{
for
(
int
i
=
0
;
i
<
det_count
;
++
i
)
{
fin_gt
>>
x
>>
y
>>
width
>>
height
>>
id
;
fin_gt
>>
x
>>
y
>>
width
>>
height
>>
id
;
...
@@ -386,7 +386,7 @@ TEST(FusionObstacleTrackerTest, FusionObstacleTracker_test) {
...
@@ -386,7 +386,7 @@ TEST(FusionObstacleTrackerTest, FusionObstacleTracker_test) {
<<
frame
.
tracked_objects
.
size
();
<<
frame
.
tracked_objects
.
size
();
for
(
auto
&
bbox_gt
:
det_gts
[
frame_num
])
{
for
(
auto
&
bbox_gt
:
det_gts
[
frame_num
])
{
int
id
=
-
1
;
int
id
=
-
1
;
float
max_iou
=
0
;
float
max_iou
=
0
.0
f
;
Eigen
::
Matrix
<
double
,
3
,
1
>
center0
,
size0
;
Eigen
::
Matrix
<
double
,
3
,
1
>
center0
,
size0
;
center0
[
0
]
=
bbox_gt
.
box
.
Center
().
x
;
center0
[
0
]
=
bbox_gt
.
box
.
Center
().
x
;
size0
[
0
]
=
bbox_gt
.
box
.
xmax
-
bbox_gt
.
box
.
xmin
;
size0
[
0
]
=
bbox_gt
.
box
.
xmax
-
bbox_gt
.
box
.
xmin
;
...
...
modules/perception/camera/tools/obstacle_detection/obstacle_detection.cc
浏览文件 @
d77b9001
...
@@ -101,13 +101,13 @@ bool LoadFromKitti(const std::string &kitti_path, CameraFrame *frame) {
...
@@ -101,13 +101,13 @@ bool LoadFromKitti(const std::string &kitti_path, CameraFrame *frame) {
while
(
!
feof
(
fp
))
{
while
(
!
feof
(
fp
))
{
base
::
ObjectPtr
obj
=
nullptr
;
base
::
ObjectPtr
obj
=
nullptr
;
obj
.
reset
(
new
base
::
Object
);
obj
.
reset
(
new
base
::
Object
);
float
trash
=
0.0
;
float
trash
=
0.0
f
;
float
score
=
0.0
;
float
score
=
0.0
f
;
char
type
[
255
];
char
type
[
255
];
float
x1
=
0.0
;
float
x1
=
0.0
f
;
float
y1
=
0.0
;
float
y1
=
0.0
f
;
float
x2
=
0.0
;
float
x2
=
0.0
f
;
float
y2
=
0.0
;
float
y2
=
0.0
f
;
memset
(
type
,
0
,
sizeof
(
type
));
memset
(
type
,
0
,
sizeof
(
type
));
int
ret
=
0
;
int
ret
=
0
;
...
...
modules/perception/camera/tools/offline/offline_obstacle_pipeline.cc
浏览文件 @
d77b9001
...
@@ -146,7 +146,7 @@ int work() {
...
@@ -146,7 +146,7 @@ int work() {
AINFO
<<
camera_names
[
i
]
<<
" height: "
<<
camera_ground_height
;
AINFO
<<
camera_names
[
i
]
<<
" height: "
<<
camera_ground_height
;
name_camera_ground_height_map
[
camera_names
[
i
]]
=
camera_ground_height
;
name_camera_ground_height_map
[
camera_names
[
i
]]
=
camera_ground_height
;
Eigen
::
Matrix3d
project_matrix
;
Eigen
::
Matrix3d
project_matrix
;
float
pitch_diff
=
0.0
;
float
pitch_diff
=
0.0
f
;
if
(
FLAGS_base_camera_name
==
camera_names
[
i
])
{
if
(
FLAGS_base_camera_name
==
camera_names
[
i
])
{
project_matrix
=
Eigen
::
Matrix3d
::
Identity
();
project_matrix
=
Eigen
::
Matrix3d
::
Identity
();
pitch_diff
=
0
;
pitch_diff
=
0
;
...
...
modules/perception/common/graph/gated_hungarian_bigraph_matcher_test.cc
浏览文件 @
d77b9001
...
@@ -43,8 +43,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize_badcase1) {
...
@@ -43,8 +43,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize_badcase1) {
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
global_costs
->
Reserve
(
1000
,
1000
);
global_costs
->
Reserve
(
1000
,
1000
);
float
bound_value
=
10
;
float
bound_value
=
10
.0
f
;
float
cost_thresh
=
2.5
;
float
cost_thresh
=
2.5
f
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
...
@@ -112,8 +112,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize_badcase_2) {
...
@@ -112,8 +112,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize_badcase_2) {
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
global_costs
->
Reserve
(
1000
,
1000
);
global_costs
->
Reserve
(
1000
,
1000
);
float
bound_value
=
10
;
float
bound_value
=
10
.0
f
;
float
cost_thresh
=
2.5
;
float
cost_thresh
=
2.5
f
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
...
@@ -163,8 +163,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize) {
...
@@ -163,8 +163,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Minimize) {
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
global_costs
->
Reserve
(
1000
,
1000
);
global_costs
->
Reserve
(
1000
,
1000
);
float
cost_thresh
=
1.0
;
float
cost_thresh
=
1.0
f
;
float
bound_value
=
2.0
;
float
bound_value
=
2.0
f
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMIN
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
...
@@ -414,8 +414,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Maximize) {
...
@@ -414,8 +414,8 @@ TEST_F(GatedHungarianMatcherTest, test_Match_Maximize) {
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
SecureMat
<
float
>*
global_costs
=
optimizer_
->
mutable_global_costs
();
global_costs
->
Reserve
(
1000
,
1000
);
global_costs
->
Reserve
(
1000
,
1000
);
float
cost_thresh
=
1.0
;
float
cost_thresh
=
1.0
f
;
float
bound_value
=
2.0
;
float
bound_value
=
2.0
f
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
opt_flag
=
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMAX
;
GatedHungarianMatcher
<
float
>::
OptimizeFlag
::
OPTMAX
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
std
::
vector
<
std
::
pair
<
size_t
,
size_t
>>
assignments
;
...
...
modules/perception/common/graph/graph_segmentor.h
浏览文件 @
d77b9001
...
@@ -27,7 +27,7 @@ namespace common {
...
@@ -27,7 +27,7 @@ namespace common {
// @brief: graph edge definition
// @brief: graph edge definition
struct
Edge
{
struct
Edge
{
float
w
=
0.0
;
float
w
=
0.0
f
;
int
a
=
0
;
int
a
=
0
;
int
b
=
0
;
int
b
=
0
;
// @brief: edge comparison
// @brief: edge comparison
...
...
modules/perception/common/i_lib/pc/i_ground.cc
浏览文件 @
d77b9001
...
@@ -298,8 +298,8 @@ int PlaneFitGroundDetector::CompareZ(const float *point_cloud,
...
@@ -298,8 +298,8 @@ int PlaneFitGroundDetector::CompareZ(const float *point_cloud,
unsigned
int
nr_z_comp_fail_threshold
=
unsigned
int
nr_z_comp_fail_threshold
=
IMin
(
param_
.
nr_z_comp_fail_threshold
,
(
unsigned
int
)(
nr_compares
>>
1
));
IMin
(
param_
.
nr_z_comp_fail_threshold
,
(
unsigned
int
)(
nr_compares
>>
1
));
const
float
*
ptr
=
nullptr
;
const
float
*
ptr
=
nullptr
;
float
z
=
0
;
float
z
=
0
.0
f
;
float
delta_z
=
0
;
float
delta_z
=
0
.0
f
;
std
::
vector
<
int
>::
const_iterator
iter
=
indices
.
cbegin
();
std
::
vector
<
int
>::
const_iterator
iter
=
indices
.
cbegin
();
while
(
iter
<
indices
.
cend
())
{
while
(
iter
<
indices
.
cend
())
{
nr_contradi
=
0
;
nr_contradi
=
0
;
...
@@ -340,13 +340,13 @@ int PlaneFitGroundDetector::CompareZ(const float *point_cloud,
...
@@ -340,13 +340,13 @@ int PlaneFitGroundDetector::CompareZ(const float *point_cloud,
void
PlaneFitGroundDetector
::
ComputeAdaptiveThreshold
()
{
void
PlaneFitGroundDetector
::
ComputeAdaptiveThreshold
()
{
unsigned
int
r
=
0
;
unsigned
int
r
=
0
;
unsigned
int
c
=
0
;
unsigned
int
c
=
0
;
float
dr
=
0
;
float
dr
=
0
.0
f
;
float
dc
=
0
;
float
dc
=
0
.0
f
;
float
k
=
0
;
float
k
=
0
.0
f
;
float
b
=
0
;
float
b
=
0
.0
f
;
float
min_dist
=
0
;
float
min_dist
=
0
.0
f
;
float
max_dist
=
0
;
float
max_dist
=
0
.0
f
;
float
thre
=
0
;
float
thre
=
0
.0
f
;
float
grid_rad
=
static_cast
<
float
>
(
param_
.
nr_grids_coarse
-
1
)
/
2
;
float
grid_rad
=
static_cast
<
float
>
(
param_
.
nr_grids_coarse
-
1
)
/
2
;
assert
(
pf_thresholds_
!=
nullptr
);
assert
(
pf_thresholds_
!=
nullptr
);
for
(
r
=
0
;
r
<
param_
.
nr_grids_coarse
;
++
r
)
{
for
(
r
=
0
;
r
<
param_
.
nr_grids_coarse
;
++
r
)
{
...
@@ -423,7 +423,7 @@ void PlaneFitGroundDetector::ComputeSignedGroundHeightLine(
...
@@ -423,7 +423,7 @@ void PlaneFitGroundDetector::ComputeSignedGroundHeightLine(
const
float
*
cptr
=
nullptr
;
const
float
*
cptr
=
nullptr
;
float
dist
[]
=
{
0
,
0
,
0
,
0
,
0
};
float
dist
[]
=
{
0
,
0
,
0
,
0
,
0
};
const
float
*
plane
[]
=
{
nullptr
,
nullptr
,
nullptr
,
nullptr
,
nullptr
};
const
float
*
plane
[]
=
{
nullptr
,
nullptr
,
nullptr
,
nullptr
,
nullptr
};
float
min_abs_dist
=
0
;
float
min_abs_dist
=
0
.0
f
;
unsigned
int
nm1
=
param_
.
nr_grids_coarse
-
1
;
unsigned
int
nm1
=
param_
.
nr_grids_coarse
-
1
;
assert
(
param_
.
nr_grids_coarse
>=
2
);
assert
(
param_
.
nr_grids_coarse
>=
2
);
plane
[
0
]
=
cn
[
0
].
IsValid
()
?
cn
[
0
].
params
:
nullptr
;
plane
[
0
]
=
cn
[
0
].
IsValid
()
?
cn
[
0
].
params
:
nullptr
;
...
@@ -627,8 +627,8 @@ int PlaneFitGroundDetector::FitGrid(const float *point_cloud,
...
@@ -627,8 +627,8 @@ int PlaneFitGroundDetector::FitGrid(const float *point_cloud,
return
(
0
);
return
(
0
);
}
}
GroundPlaneLiDAR
plane
;
GroundPlaneLiDAR
plane
;
float
ptp_dist
=
0
;
float
ptp_dist
=
0
.0
f
;
float
fit_cost
=
0
;
float
fit_cost
=
0
.0
f
;
float
fit_cost_best
=
dist_thre
;
float
fit_cost_best
=
dist_thre
;
int
nr_inliers
=
0
;
int
nr_inliers
=
0
;
int
nr_inliers_best
=
-
1
;
int
nr_inliers_best
=
-
1
;
...
@@ -833,7 +833,7 @@ int PlaneFitGroundDetector::FitGridWithNeighbors(
...
@@ -833,7 +833,7 @@ int PlaneFitGroundDetector::FitGridWithNeighbors(
int
kNr_iter
=
param_
.
nr_ransac_iter_threshold
+
int
kNr_iter
=
param_
.
nr_ransac_iter_threshold
+
static_cast
<
int
>
(
neighbors
.
size
());
static_cast
<
int
>
(
neighbors
.
size
());
GroundPlaneLiDAR
hypothesis
[
kNr_iter
];
GroundPlaneLiDAR
hypothesis
[
kNr_iter
];
float
ptp_dist
=
0
;
float
ptp_dist
=
0
.0
f
;
int
best
=
-
1
;
int
best
=
-
1
;
int
nr_inliers
=
0
;
int
nr_inliers
=
0
;
int
nr_inliers_best
=
-
1
;
int
nr_inliers_best
=
-
1
;
...
@@ -990,7 +990,7 @@ int PlaneFitGroundDetector::FitGridWithNeighbors(
...
@@ -990,7 +990,7 @@ int PlaneFitGroundDetector::FitGridWithNeighbors(
float
PlaneFitGroundDetector
::
CalculateAngleDist
(
float
PlaneFitGroundDetector
::
CalculateAngleDist
(
const
GroundPlaneLiDAR
&
plane
,
const
GroundPlaneLiDAR
&
plane
,
const
std
::
vector
<
std
::
pair
<
int
,
int
>
>
&
neighbors
)
{
const
std
::
vector
<
std
::
pair
<
int
,
int
>
>
&
neighbors
)
{
float
angle_dist
=
0
;
float
angle_dist
=
0
.0
f
;
int
count
=
0
;
int
count
=
0
;
unsigned
int
j
=
0
;
unsigned
int
j
=
0
;
int
r_n
=
0
;
int
r_n
=
0
;
...
...
modules/perception/common/image_processing/hough_transfer.h
浏览文件 @
d77b9001
...
@@ -27,9 +27,9 @@ namespace perception {
...
@@ -27,9 +27,9 @@ namespace perception {
namespace
common
{
namespace
common
{
struct
HoughLine
{
struct
HoughLine
{
float
r
=
0.0
;
float
r
=
0.0
f
;
float
theta
=
0.0
;
float
theta
=
0.0
f
;
float
length
=
0.0
;
float
length
=
0.0
f
;
int
vote_num
=
0
;
int
vote_num
=
0
;
std
::
vector
<
int
>
pts
;
std
::
vector
<
int
>
pts
;
};
};
...
...
modules/perception/common/io/io_util.cc
浏览文件 @
d77b9001
...
@@ -80,8 +80,8 @@ bool LoadBrownCameraIntrinsic(const std::string &yaml_file,
...
@@ -80,8 +80,8 @@ bool LoadBrownCameraIntrinsic(const std::string &yaml_file,
return
false
;
return
false
;
}
}
float
camera_width
=
0
;
float
camera_width
=
0
.0
f
;
float
camera_height
=
0
;
float
camera_height
=
0
.0
f
;
Eigen
::
VectorXf
params
(
9
+
5
);
Eigen
::
VectorXf
params
(
9
+
5
);
try
{
try
{
camera_width
=
node
[
"width"
].
as
<
float
>
();
camera_width
=
node
[
"width"
].
as
<
float
>
();
...
...
modules/perception/common/point_cloud_processing/downsampling_test.cc
浏览文件 @
d77b9001
...
@@ -118,7 +118,7 @@ TEST(PointCloudProcessingDownsamplingTest, downsampling_circular_org_all1) {
...
@@ -118,7 +118,7 @@ TEST(PointCloudProcessingDownsamplingTest, downsampling_circular_org_all1) {
center_pt
.
x
=
0.
f
;
center_pt
.
x
=
0.
f
;
center_pt
.
y
=
0.
f
;
center_pt
.
y
=
0.
f
;
center_pt
.
z
=
0.
f
;
center_pt
.
z
=
0.
f
;
for
(
float
i
=
1.
f
;
i
<=
128
;
i
++
)
{
for
(
float
i
=
1.
f
;
i
<=
128
.0
f
;
i
++
)
{
tmp_pt
.
x
=
i
;
tmp_pt
.
x
=
i
;
tmp_pt
.
y
=
i
;
tmp_pt
.
y
=
i
;
tmp_pt
.
z
=
i
;
tmp_pt
.
z
=
i
;
...
...
modules/perception/fusion/common/camera_util.cc
浏览文件 @
d77b9001
...
@@ -86,7 +86,7 @@ float ObjectInCameraView(SensorObjectConstPtr sensor_object,
...
@@ -86,7 +86,7 @@ float ObjectInCameraView(SensorObjectConstPtr sensor_object,
const
Eigen
::
Affine3d
&
camera_sensor2world_pose
,
const
Eigen
::
Affine3d
&
camera_sensor2world_pose
,
double
camera_ts
,
double
camera_max_dist
,
double
camera_ts
,
double
camera_max_dist
,
bool
motion_compensation
,
bool
all_in
)
{
bool
motion_compensation
,
bool
all_in
)
{
float
in_view_ratio
=
0.0
;
float
in_view_ratio
=
0.0
f
;
Eigen
::
Matrix4d
world2sensor_pose
=
Eigen
::
Matrix4d
world2sensor_pose
=
camera_sensor2world_pose
.
matrix
().
inverse
();
camera_sensor2world_pose
.
matrix
().
inverse
();
if
(
!
world2sensor_pose
.
allFinite
())
{
if
(
!
world2sensor_pose
.
allFinite
())
{
...
...
modules/perception/fusion/lib/data_association/hm_data_association/track_object_similarity.cc
浏览文件 @
d77b9001
...
@@ -42,7 +42,7 @@ double ComputePtsBoxLocationSimilarity(const ProjectionCachePtr& cache,
...
@@ -42,7 +42,7 @@ double ComputePtsBoxLocationSimilarity(const ProjectionCachePtr& cache,
double
x_std_dev
=
0.4
;
double
x_std_dev
=
0.4
;
double
y_std_dev
=
0.5
;
double
y_std_dev
=
0.5
;
size_t
check_augmented_iou_minimum_pts_num
=
20
;
size_t
check_augmented_iou_minimum_pts_num
=
20
;
float
augmented_buffer
=
25
;
float
augmented_buffer
=
25
.0
f
;
if
(
object
->
Empty
())
{
if
(
object
->
Empty
())
{
ADEBUG
<<
"cache object is empty!"
;
ADEBUG
<<
"cache object is empty!"
;
return
min_p
;
return
min_p
;
...
@@ -280,9 +280,9 @@ double ComputeRadarCameraVelocitySimilarity(
...
@@ -280,9 +280,9 @@ double ComputeRadarCameraVelocitySimilarity(
float
diff_velocity
=
(
radar_velocity
-
camera_velocity
).
norm
()
/
2
;
float
diff_velocity
=
(
radar_velocity
-
camera_velocity
).
norm
()
/
2
;
float
diff_velocity_ratio
=
float
diff_velocity_ratio
=
diff_velocity
/
std
::
max
(
scalar_camera_velocity
,
scalar_radar_velocity
);
diff_velocity
/
std
::
max
(
scalar_camera_velocity
,
scalar_radar_velocity
);
const
float
velocity_std
=
0.15
;
const
float
velocity_std
=
0.15
f
;
const
float
max_velocity_p
=
0.9
;
const
float
max_velocity_p
=
0.9
f
;
const
float
th_velocity_p
=
0.5
;
const
float
th_velocity_p
=
0.5
f
;
float
velocity_score
=
float
velocity_score
=
1
-
ChiSquaredCdf1TableFun
(
diff_velocity_ratio
*
diff_velocity_ratio
/
1
-
ChiSquaredCdf1TableFun
(
diff_velocity_ratio
*
diff_velocity_ratio
/
velocity_std
/
velocity_std
);
velocity_std
/
velocity_std
);
...
...
modules/perception/fusion/lib/data_fusion/shape_fusion/pbf_shape_fusion/pbf_shape_fusion.cc
浏览文件 @
d77b9001
...
@@ -20,7 +20,7 @@ namespace perception {
...
@@ -20,7 +20,7 @@ namespace perception {
namespace
fusion
{
namespace
fusion
{
bool
PbfShapeFusion
::
s_use_camera_3d_
=
true
;
bool
PbfShapeFusion
::
s_use_camera_3d_
=
true
;
float
PbfShapeFusion
::
s_camera_radar_time_diff_th_
=
0.3
;
float
PbfShapeFusion
::
s_camera_radar_time_diff_th_
=
0.3
f
;
bool
PbfShapeFusion
::
Init
()
{
return
true
;
}
bool
PbfShapeFusion
::
Init
()
{
return
true
;
}
...
...
modules/perception/inference/operators/roipooling_layer_test.cc
浏览文件 @
d77b9001
...
@@ -94,7 +94,7 @@ TEST(ROIPoolRoundTest, test) {
...
@@ -94,7 +94,7 @@ TEST(ROIPoolRoundTest, test) {
int
pooled_w
=
7
;
int
pooled_w
=
7
;
bool
use_floor
=
false
;
bool
use_floor
=
false
;
int
feat_channel
=
1
;
int
feat_channel
=
1
;
float
spatial_scale
=
16.0
;
float
spatial_scale
=
16.0
f
;
auto
roi_layer
=
new
apollo
::
perception
::
inference
::
ROIPoolingLayer
<
float
>
(
auto
roi_layer
=
new
apollo
::
perception
::
inference
::
ROIPoolingLayer
<
float
>
(
pooled_h
,
pooled_w
,
use_floor
,
spatial_scale
,
feat_channel
);
pooled_h
,
pooled_w
,
use_floor
,
spatial_scale
,
feat_channel
);
std
::
vector
<
int
>
feat_shape
{
2
,
feat_channel
,
30
,
30
};
std
::
vector
<
int
>
feat_shape
{
2
,
feat_channel
,
30
,
30
};
...
...
modules/perception/inference/test/inference_util_test.cc
浏览文件 @
d77b9001
...
@@ -97,7 +97,7 @@ TEST(UtilTest, NormTest) {
...
@@ -97,7 +97,7 @@ TEST(UtilTest, NormTest) {
norm
.
L2Norm
(
&
data
);
norm
.
L2Norm
(
&
data
);
const
float
*
result
=
data
.
cpu_data
();
const
float
*
result
=
data
.
cpu_data
();
for
(
int
i
=
0
;
i
<
num
;
++
i
)
{
for
(
int
i
=
0
;
i
<
num
;
++
i
)
{
float
sum
=
0
;
float
sum
=
0
.0
f
;
for
(
int
j
=
0
;
j
<
dim
;
++
j
)
{
for
(
int
j
=
0
;
j
<
dim
;
++
j
)
{
sum
+=
(
*
result
)
*
(
*
result
);
sum
+=
(
*
result
)
*
(
*
result
);
++
result
;
++
result
;
...
...
modules/perception/lidar/common/feature_descriptor.h
浏览文件 @
d77b9001
...
@@ -70,9 +70,9 @@ class FeatureDescriptor {
...
@@ -70,9 +70,9 @@ class FeatureDescriptor {
private:
private:
void
GetMinMaxCenter
()
{
void
GetMinMaxCenter
()
{
float
xsum
=
0.0
;
float
xsum
=
0.0
f
;
float
ysum
=
0.0
;
float
ysum
=
0.0
f
;
float
zsum
=
0.0
;
float
zsum
=
0.0
f
;
min_pt_
.
x
=
min_pt_
.
y
=
min_pt_
.
z
=
FLT_MAX
;
min_pt_
.
x
=
min_pt_
.
y
=
min_pt_
.
z
=
FLT_MAX
;
max_pt_
.
x
=
max_pt_
.
y
=
max_pt_
.
z
=
-
FLT_MAX
;
max_pt_
.
x
=
max_pt_
.
y
=
max_pt_
.
z
=
-
FLT_MAX
;
...
...
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector.cc
浏览文件 @
d77b9001
...
@@ -98,7 +98,7 @@ bool SpatioTemporalGroundDetector::Detect(const GroundDetectorOptions& options,
...
@@ -98,7 +98,7 @@ bool SpatioTemporalGroundDetector::Detect(const GroundDetectorOptions& options,
size_t
num_points_all
=
0
;
size_t
num_points_all
=
0
;
int
index
=
0
;
int
index
=
0
;
unsigned
int
nr_points_element
=
3
;
unsigned
int
nr_points_element
=
3
;
float
z_distance
=
0.0
;
float
z_distance
=
0.0
f
;
cloud_center_
(
0
)
=
frame
->
lidar2world_pose
(
0
,
3
);
cloud_center_
(
0
)
=
frame
->
lidar2world_pose
(
0
,
3
);
cloud_center_
(
1
)
=
frame
->
lidar2world_pose
(
1
,
3
);
cloud_center_
(
1
)
=
frame
->
lidar2world_pose
(
1
,
3
);
...
...
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector.h
浏览文件 @
d77b9001
...
@@ -58,7 +58,7 @@ class SpatioTemporalGroundDetector : public BaseGroundDetector {
...
@@ -58,7 +58,7 @@ class SpatioTemporalGroundDetector : public BaseGroundDetector {
bool
use_roi_
=
true
;
bool
use_roi_
=
true
;
bool
use_ground_service_
=
false
;
bool
use_ground_service_
=
false
;
float
ground_thres_
=
0.25
;
float
ground_thres_
=
0.25
f
;
size_t
default_point_size_
=
320000
;
size_t
default_point_size_
=
320000
;
Eigen
::
Vector3d
cloud_center_
=
Eigen
::
Vector3d
(
0.0
,
0.0
,
0.0
);
Eigen
::
Vector3d
cloud_center_
=
Eigen
::
Vector3d
(
0.0
,
0.0
,
0.0
);
GroundServiceContent
ground_service_content_
;
GroundServiceContent
ground_service_content_
;
...
...
modules/perception/lidar/lib/ground_detector/spatio_temporal_ground_detector/spatio_temporal_ground_detector_test.cc
浏览文件 @
d77b9001
...
@@ -125,8 +125,8 @@ TEST(SpatioTemporalGroundDetectorTest, test_spatio_temporal_ground_detector) {
...
@@ -125,8 +125,8 @@ TEST(SpatioTemporalGroundDetectorTest, test_spatio_temporal_ground_detector) {
// std::dynamic_pointer_cast<GroundService>(ground_service);
// std::dynamic_pointer_cast<GroundService>(ground_service);
// Eigen::Vector3d world_point(0.0, 0.0, 0.0);
// Eigen::Vector3d world_point(0.0, 0.0, 0.0);
// float out_query = 0.0;
// float out_query = 0.0
f
;
// float out_detected = 0.0;
// float out_detected = 0.0
f
;
// for (size_t i = 0; i < 10; ++i) {
// for (size_t i = 0; i < 10; ++i) {
// const auto& index = frame_data->non_ground_indices.indices[i];
// const auto& index = frame_data->non_ground_indices.indices[i];
// const auto& pt = frame_data->world_cloud->at(index);
// const auto& pt = frame_data->world_cloud->at(index);
...
...
modules/perception/lidar/lib/interface/base_bipartite_graph_matcher.h
浏览文件 @
d77b9001
...
@@ -32,8 +32,8 @@ namespace lidar {
...
@@ -32,8 +32,8 @@ namespace lidar {
struct
BipartiteGraphMatcherInitOptions
{};
struct
BipartiteGraphMatcherInitOptions
{};
struct
BipartiteGraphMatcherOptions
{
struct
BipartiteGraphMatcherOptions
{
float
cost_thresh
=
4.0
;
float
cost_thresh
=
4.0
f
;
float
bound_value
=
100.0
;
float
bound_value
=
100.0
f
;
};
};
class
BaseBipartiteGraphMatcher
{
class
BaseBipartiteGraphMatcher
{
...
...
modules/perception/lidar/lib/pointcloud_preprocessor/pointcloud_preprocessor.h
浏览文件 @
d77b9001
...
@@ -67,12 +67,12 @@ class PointCloudPreprocessor {
...
@@ -67,12 +67,12 @@ class PointCloudPreprocessor {
// params
// params
bool
filter_naninf_points_
=
true
;
bool
filter_naninf_points_
=
true
;
bool
filter_nearby_box_points_
=
true
;
bool
filter_nearby_box_points_
=
true
;
float
box_forward_x_
=
0.0
;
float
box_forward_x_
=
0.0
f
;
float
box_backward_x_
=
0.0
;
float
box_backward_x_
=
0.0
f
;
float
box_forward_y_
=
0.0
;
float
box_forward_y_
=
0.0
f
;
float
box_backward_y_
=
0.0
;
float
box_backward_y_
=
0.0
f
;
bool
filter_high_z_points_
=
true
;
bool
filter_high_z_points_
=
true
;
float
z_threshold_
=
5.0
;
float
z_threshold_
=
5.0
f
;
static
const
float
kPointInfThreshold
;
static
const
float
kPointInfThreshold
;
};
// class PointCloudPreprocessor
};
// class PointCloudPreprocessor
...
...
modules/perception/lidar/lib/segmentation/cnnseg/feature_generator.cc
浏览文件 @
d77b9001
...
@@ -137,7 +137,7 @@ void FeatureGenerator::GenerateCPU(const base::PointFCloudPtr& pc_ptr,
...
@@ -137,7 +137,7 @@ void FeatureGenerator::GenerateCPU(const base::PointFCloudPtr& pc_ptr,
}
}
const
auto
&
pt
=
pc_ptr
->
at
(
i
);
const
auto
&
pt
=
pc_ptr
->
at
(
i
);
float
pz
=
pt
.
z
;
float
pz
=
pt
.
z
;
float
pi
=
pt
.
intensity
/
255.0
;
float
pi
=
pt
.
intensity
/
255.0
f
;
if
(
max_height_data_
[
idx
]
<
pz
)
{
if
(
max_height_data_
[
idx
]
<
pz
)
{
max_height_data_
[
idx
]
=
pz
;
max_height_data_
[
idx
]
=
pz
;
if
(
use_intensity_feature_
)
{
if
(
use_intensity_feature_
)
{
...
...
modules/perception/lidar/lib/segmentation/cnnseg/feature_generator.h
浏览文件 @
d77b9001
...
@@ -87,9 +87,9 @@ class FeatureGenerator {
...
@@ -87,9 +87,9 @@ class FeatureGenerator {
// feature param
// feature param
int
width_
=
0
;
int
width_
=
0
;
int
height_
=
0
;
int
height_
=
0
;
float
range_
=
0.0
;
float
range_
=
0.0
f
;
float
min_height_
=
0.0
;
float
min_height_
=
0.0
f
;
float
max_height_
=
0.0
;
float
max_height_
=
0.0
f
;
bool
use_intensity_feature_
=
false
;
bool
use_intensity_feature_
=
false
;
bool
use_constant_feature_
=
false
;
bool
use_constant_feature_
=
false
;
...
...
modules/perception/lidar/lib/segmentation/cnnseg/spp_engine/spp_struct.h
浏览文件 @
d77b9001
...
@@ -51,7 +51,7 @@ struct SppData {
...
@@ -51,7 +51,7 @@ struct SppData {
size_t
data_width
=
0
;
size_t
data_width
=
0
;
size_t
data_height
=
0
;
size_t
data_height
=
0
;
size_t
data_size
=
0
;
size_t
data_size
=
0
;
float
data_range
=
0
;
float
data_range
=
0
.0
f
;
void
MakeReference
(
size_t
width
,
size_t
height
,
float
range
);
void
MakeReference
(
size_t
width
,
size_t
height
,
float
range
);
...
...
modules/perception/lidar/lib/tracker/association/distance_collection.cc
浏览文件 @
d77b9001
...
@@ -109,7 +109,7 @@ float BboxSizeDistance(
...
@@ -109,7 +109,7 @@ float BboxSizeDistance(
Eigen
::
Vector3f
old_bbox_size
=
last_object
->
output_size
.
cast
<
float
>
();
Eigen
::
Vector3f
old_bbox_size
=
last_object
->
output_size
.
cast
<
float
>
();
Eigen
::
Vector3f
new_bbox_size
=
new_object
->
size
.
cast
<
float
>
();
Eigen
::
Vector3f
new_bbox_size
=
new_object
->
size
.
cast
<
float
>
();
float
size_dist
=
0.0
;
float
size_dist
=
0.0
f
;
double
dot_val_00
=
fabs
(
old_bbox_dir
(
0
)
*
new_bbox_dir
(
0
)
+
double
dot_val_00
=
fabs
(
old_bbox_dir
(
0
)
*
new_bbox_dir
(
0
)
+
old_bbox_dir
(
1
)
*
new_bbox_dir
(
1
));
old_bbox_dir
(
1
)
*
new_bbox_dir
(
1
));
double
dot_val_01
=
fabs
(
old_bbox_dir
(
0
)
*
new_bbox_dir
(
1
)
-
double
dot_val_01
=
fabs
(
old_bbox_dir
(
0
)
*
new_bbox_dir
(
1
)
-
...
@@ -177,7 +177,7 @@ float HistogramDistance(
...
@@ -177,7 +177,7 @@ float HistogramDistance(
return
100
;
return
100
;
}
}
float
histogram_dist
=
0.0
;
float
histogram_dist
=
0.0
f
;
for
(
size_t
i
=
0
;
i
<
old_object_shape_features
.
size
();
++
i
)
{
for
(
size_t
i
=
0
;
i
<
old_object_shape_features
.
size
();
++
i
)
{
histogram_dist
+=
std
::
fabs
(
old_object_shape_features
[
i
]
-
histogram_dist
+=
std
::
fabs
(
old_object_shape_features
[
i
]
-
new_object_shape_features
[
i
]);
new_object_shape_features
[
i
]);
...
...
modules/perception/lidar/lib/tracker/common/tracked_object.h
浏览文件 @
d77b9001
...
@@ -111,7 +111,7 @@ struct TrackedObject {
...
@@ -111,7 +111,7 @@ struct TrackedObject {
int
boostup_need_history_size
=
0
;
int
boostup_need_history_size
=
0
;
bool
valid
=
false
;
bool
valid
=
false
;
bool
converged
=
true
;
bool
converged
=
true
;
float
convergence_confidence
=
0.0
;
float
convergence_confidence
=
0.0
f
;
double
update_quality
=
0.0
;
double
update_quality
=
0.0
;
Eigen
::
Vector3d
selected_measured_velocity
;
Eigen
::
Vector3d
selected_measured_velocity
;
Eigen
::
Vector3d
selected_measured_acceleration
;
Eigen
::
Vector3d
selected_measured_acceleration
;
...
...
modules/perception/lidar/lib/tracker/multi_lidar_fusion/mlf_motion_measurement.cc
浏览文件 @
d77b9001
...
@@ -56,7 +56,7 @@ void MlfMotionMeasurement::MeasurementSelection(
...
@@ -56,7 +56,7 @@ void MlfMotionMeasurement::MeasurementSelection(
const
TrackedObjectConstPtr
&
latest_object
,
TrackedObjectPtr
new_object
)
{
const
TrackedObjectConstPtr
&
latest_object
,
TrackedObjectPtr
new_object
)
{
// Select measured velocity among candidates according motion consistency
// Select measured velocity among candidates according motion consistency
int
corner_index
=
0
;
int
corner_index
=
0
;
float
corner_velocity_gain
=
0
;
float
corner_velocity_gain
=
0
.0
f
;
std
::
vector
<
float
>
corner_velocity_gain_norms
(
4
);
std
::
vector
<
float
>
corner_velocity_gain_norms
(
4
);
for
(
int
i
=
0
;
i
<
4
;
++
i
)
{
for
(
int
i
=
0
;
i
<
4
;
++
i
)
{
corner_velocity_gain_norms
[
i
]
=
(
new_object
->
measured_corners_velocity
[
i
]
-
corner_velocity_gain_norms
[
i
]
=
(
new_object
->
measured_corners_velocity
[
i
]
-
...
...
modules/perception/onboard/component/fusion_camera_detection_component.cc
浏览文件 @
d77b9001
...
@@ -65,7 +65,7 @@ bool SetCameraHeight(const std::string &sensor_name,
...
@@ -65,7 +65,7 @@ bool SetCameraHeight(const std::string &sensor_name,
const
std
::
string
&
params_dir
,
float
default_camera_height
,
const
std
::
string
&
params_dir
,
float
default_camera_height
,
float
*
camera_height
)
{
float
*
camera_height
)
{
float
base_h
=
default_camera_height
;
float
base_h
=
default_camera_height
;
float
camera_offset
=
0
;
float
camera_offset
=
0
.0
f
;
try
{
try
{
YAML
::
Node
lidar_height
=
YAML
::
Node
lidar_height
=
YAML
::
LoadFile
(
params_dir
+
"/"
+
"velodyne64_height.yaml"
);
YAML
::
LoadFile
(
params_dir
+
"/"
+
"velodyne64_height.yaml"
);
...
@@ -478,7 +478,7 @@ int FusionCameraDetectionComponent::InitCameraFrames() {
...
@@ -478,7 +478,7 @@ int FusionCameraDetectionComponent::InitCameraFrames() {
// Init camera height
// Init camera height
for
(
const
auto
&
camera_name
:
camera_names_
)
{
for
(
const
auto
&
camera_name
:
camera_names_
)
{
float
height
=
0.0
;
float
height
=
0.0
f
;
SetCameraHeight
(
camera_name
,
FLAGS_obs_sensor_intrinsic_path
,
SetCameraHeight
(
camera_name
,
FLAGS_obs_sensor_intrinsic_path
,
default_camera_height_
,
&
height
);
default_camera_height_
,
&
height
);
camera_height_map_
[
camera_name
]
=
height
;
camera_height_map_
[
camera_name
]
=
height
;
...
...
modules/perception/onboard/component/segmentation_component.h
浏览文件 @
d77b9001
...
@@ -51,7 +51,7 @@ class SegmentationComponent : public cyber::Component<drivers::PointCloud> {
...
@@ -51,7 +51,7 @@ class SegmentationComponent : public cyber::Component<drivers::PointCloud> {
static
uint32_t
s_seq_num_
;
static
uint32_t
s_seq_num_
;
std
::
string
sensor_name_
;
std
::
string
sensor_name_
;
bool
enable_hdmap_
=
true
;
bool
enable_hdmap_
=
true
;
float
lidar_query_tf_offset_
=
20.0
;
float
lidar_query_tf_offset_
=
20.0
f
;
std
::
string
lidar2novatel_tf2_child_frame_id_
;
std
::
string
lidar2novatel_tf2_child_frame_id_
;
std
::
string
output_channel_name_
;
std
::
string
output_channel_name_
;
base
::
SensorInfo
sensor_info_
;
base
::
SensorInfo
sensor_info_
;
...
...
modules/perception/radar/lib/preprocessor/conti_ars_preprocessor/conti_ars_preprocessor.h
浏览文件 @
d77b9001
...
@@ -50,7 +50,7 @@ class ContiArsPreprocessor : public BasePreprocessor {
...
@@ -50,7 +50,7 @@ class ContiArsPreprocessor : public BasePreprocessor {
void
CorrectTime
(
drivers
::
ContiRadar
*
corrected_obstacles
);
void
CorrectTime
(
drivers
::
ContiRadar
*
corrected_obstacles
);
int
GetNextId
();
int
GetNextId
();
float
delay_time_
=
0.0
;
float
delay_time_
=
0.0
f
;
static
int
current_idx_
;
static
int
current_idx_
;
static
int
local2global_
[
ORIGIN_CONTI_MAX_ID_NUM
];
static
int
local2global_
[
ORIGIN_CONTI_MAX_ID_NUM
];
...
...
modules/planning/common/reference_line_info.cc
浏览文件 @
d77b9001
...
@@ -234,7 +234,7 @@ bool ReferenceLineInfo::CheckChangeLane() const {
...
@@ -234,7 +234,7 @@ bool ReferenceLineInfo::CheckChangeLane() const {
for
(
const
auto
*
obstacle
:
path_decision_
.
obstacles
().
Items
())
{
for
(
const
auto
*
obstacle
:
path_decision_
.
obstacles
().
Items
())
{
const
auto
&
sl_boundary
=
obstacle
->
PerceptionSLBoundary
();
const
auto
&
sl_boundary
=
obstacle
->
PerceptionSLBoundary
();
constexpr
float
kLateralShift
=
2.5
;
constexpr
float
kLateralShift
=
2.5
f
;
if
(
sl_boundary
.
start_l
()
<
-
kLateralShift
||
if
(
sl_boundary
.
start_l
()
<
-
kLateralShift
||
sl_boundary
.
end_l
()
>
kLateralShift
)
{
sl_boundary
.
end_l
()
>
kLateralShift
)
{
continue
;
continue
;
...
@@ -247,9 +247,9 @@ bool ReferenceLineInfo::CheckChangeLane() const {
...
@@ -247,9 +247,9 @@ bool ReferenceLineInfo::CheckChangeLane() const {
return
false
;
return
false
;
}
}
constexpr
float
kSafeTime
=
3.0
;
constexpr
float
kSafeTime
=
3.0
f
;
constexpr
float
kForwardMinSafeDistance
=
6.0
;
constexpr
float
kForwardMinSafeDistance
=
6.0
f
;
constexpr
float
kBackwardMinSafeDistance
=
8.0
;
constexpr
float
kBackwardMinSafeDistance
=
8.0
f
;
const
float
kForwardSafeDistance
=
std
::
max
(
const
float
kForwardSafeDistance
=
std
::
max
(
kForwardMinSafeDistance
,
kForwardMinSafeDistance
,
...
...
modules/planning/open_space/distance_approach_problem_test.cc
浏览文件 @
d77b9001
...
@@ -42,7 +42,7 @@ class DistanceApproachProblemTest : public ::testing::Test {
...
@@ -42,7 +42,7 @@ class DistanceApproachProblemTest : public ::testing::Test {
int
num_of_variables_
=
160
;
int
num_of_variables_
=
160
;
int
num_of_constraints_
=
200
;
int
num_of_constraints_
=
200
;
std
::
size_t
horizon_
=
20
;
std
::
size_t
horizon_
=
20
;
float
ts_
=
0.01
;
float
ts_
=
0.01
f
;
Eigen
::
MatrixXd
ego_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
ego_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
x0_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
x0_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
xf_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
xf_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
...
...
modules/planning/open_space/dual_variable_warm_start_ipopt_interface_test.cc
浏览文件 @
d77b9001
...
@@ -48,7 +48,7 @@ class DualVariableWarmStartIPOPTInterfaceTest : public ::testing::Test {
...
@@ -48,7 +48,7 @@ class DualVariableWarmStartIPOPTInterfaceTest : public ::testing::Test {
protected:
protected:
std
::
size_t
horizon_
=
5
;
std
::
size_t
horizon_
=
5
;
std
::
size_t
obstacles_num_
=
10
;
std
::
size_t
obstacles_num_
=
10
;
float
ts_
=
0.01
;
float
ts_
=
0.01
f
;
Eigen
::
MatrixXd
ego_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
ego_
=
Eigen
::
MatrixXd
::
Ones
(
4
,
1
);
Eigen
::
MatrixXd
last_time_u_
=
Eigen
::
MatrixXd
::
Zero
(
2
,
1
);
Eigen
::
MatrixXd
last_time_u_
=
Eigen
::
MatrixXd
::
Zero
(
2
,
1
);
Eigen
::
MatrixXi
obstacles_edges_num_
;
Eigen
::
MatrixXi
obstacles_edges_num_
;
...
...
modules/prediction/evaluator/vehicle/rnn_evaluator.cc
浏览文件 @
d77b9001
...
@@ -168,12 +168,12 @@ int RNNEvaluator::SetupObstacleFeature(
...
@@ -168,12 +168,12 @@ int RNNEvaluator::SetupObstacleFeature(
feature_values
->
clear
();
feature_values
->
clear
();
feature_values
->
reserve
(
DIM_OBSTACLE_FEATURE
);
feature_values
->
reserve
(
DIM_OBSTACLE_FEATURE
);
float
heading
=
0.0
;
float
heading
=
0.0
f
;
float
speed
=
0.0
;
float
speed
=
0.0
f
;
float
lane_l
=
0.0
;
float
lane_l
=
0.0
f
;
float
theta
=
0.0
;
float
theta
=
0.0
f
;
float
dist_lb
=
1.0
;
float
dist_lb
=
1.0
f
;
float
dist_rb
=
1.0
;
float
dist_rb
=
1.0
f
;
if
(
obstacle
->
history_size
()
<
1
)
{
if
(
obstacle
->
history_size
()
<
1
)
{
AWARN
<<
"Size of feature less than 1!"
;
AWARN
<<
"Size of feature less than 1!"
;
return
-
1
;
return
-
1
;
...
...
modules/prediction/network/net_layer.cc
浏览文件 @
d77b9001
...
@@ -144,7 +144,7 @@ void Conv1d::Run(const std::vector<Eigen::MatrixXf>& inputs,
...
@@ -144,7 +144,7 @@ void Conv1d::Run(const std::vector<Eigen::MatrixXf>& inputs,
output
->
resize
(
output_num_row
,
output_num_col
);
output
->
resize
(
output_num_row
,
output_num_col
);
for
(
int
i
=
0
;
i
<
output_num_row
;
++
i
)
{
for
(
int
i
=
0
;
i
<
output_num_row
;
++
i
)
{
for
(
int
j
=
0
;
j
<
output_num_col
;
++
j
)
{
for
(
int
j
=
0
;
j
<
output_num_col
;
++
j
)
{
float
output_i_j_unbiased
=
0.0
;
float
output_i_j_unbiased
=
0.0
f
;
for
(
int
p
=
0
;
p
<
inputs
[
0
].
rows
();
++
p
)
{
for
(
int
p
=
0
;
p
<
inputs
[
0
].
rows
();
++
p
)
{
for
(
int
q
=
j
*
stride_
;
q
<
j
*
stride_
+
kernel_size
;
++
q
)
{
for
(
int
q
=
j
*
stride_
;
q
<
j
*
stride_
+
kernel_size
;
++
q
)
{
output_i_j_unbiased
+=
output_i_j_unbiased
+=
...
@@ -233,7 +233,7 @@ void AvgPool1d::Run(const std::vector<Eigen::MatrixXf>& inputs,
...
@@ -233,7 +233,7 @@ void AvgPool1d::Run(const std::vector<Eigen::MatrixXf>& inputs,
for
(
int
j
=
0
;
j
<
output_num_col
;
++
j
)
{
for
(
int
j
=
0
;
j
<
output_num_col
;
++
j
)
{
CHECK_LE
(
input_index
+
kernel_size_
,
inputs
[
0
].
cols
());
CHECK_LE
(
input_index
+
kernel_size_
,
inputs
[
0
].
cols
());
for
(
int
i
=
0
;
i
<
output_num_row
;
++
i
)
{
for
(
int
i
=
0
;
i
<
output_num_row
;
++
i
)
{
float
output_i_j_sum
=
0.0
;
float
output_i_j_sum
=
0.0
f
;
for
(
int
k
=
input_index
;
k
<
input_index
+
kernel_size_
;
++
k
)
{
for
(
int
k
=
input_index
;
k
<
input_index
+
kernel_size_
;
++
k
)
{
output_i_j_sum
+=
inputs
[
0
](
i
,
k
);
output_i_j_sum
+=
inputs
[
0
](
i
,
k
);
}
}
...
...
modules/prediction/network/net_layer.h
浏览文件 @
d77b9001
...
@@ -311,8 +311,8 @@ class BatchNormalization : public Layer {
...
@@ -311,8 +311,8 @@ class BatchNormalization : public Layer {
Eigen
::
VectorXf
sigma_
;
Eigen
::
VectorXf
sigma_
;
Eigen
::
VectorXf
gamma_
;
Eigen
::
VectorXf
gamma_
;
Eigen
::
VectorXf
beta_
;
Eigen
::
VectorXf
beta_
;
float
epsilon_
=
0.0
;
float
epsilon_
=
0.0
f
;
float
momentum_
=
0.0
;
float
momentum_
=
0.0
f
;
int
axis_
=
0
;
int
axis_
=
0
;
bool
center_
=
false
;
bool
center_
=
false
;
bool
scale_
=
false
;
bool
scale_
=
false
;
...
...
modules/transform/buffer_interface.h
浏览文件 @
d77b9001
...
@@ -46,7 +46,7 @@ class BufferInterface {
...
@@ -46,7 +46,7 @@ class BufferInterface {
*/
*/
virtual
apollo
::
transform
::
TransformStamped
lookupTransform
(
virtual
apollo
::
transform
::
TransformStamped
lookupTransform
(
const
std
::
string
&
target_frame
,
const
std
::
string
&
source_frame
,
const
std
::
string
&
target_frame
,
const
std
::
string
&
source_frame
,
const
cyber
::
Time
&
time
,
const
float
timeout_second
=
0.01
)
const
=
0
;
const
cyber
::
Time
&
time
,
const
float
timeout_second
=
0.01
f
)
const
=
0
;
/** \brief Get the transform between two frames by frame ID assuming fixed
/** \brief Get the transform between two frames by frame ID assuming fixed
*frame.
*frame.
...
@@ -68,7 +68,7 @@ class BufferInterface {
...
@@ -68,7 +68,7 @@ class BufferInterface {
const
std
::
string
&
target_frame
,
const
cyber
::
Time
&
target_time
,
const
std
::
string
&
target_frame
,
const
cyber
::
Time
&
target_time
,
const
std
::
string
&
source_frame
,
const
cyber
::
Time
&
source_time
,
const
std
::
string
&
source_frame
,
const
cyber
::
Time
&
source_time
,
const
std
::
string
&
fixed_frame
,
const
std
::
string
&
fixed_frame
,
const
float
timeout_second
=
0.01
)
const
=
0
;
const
float
timeout_second
=
0.01
f
)
const
=
0
;
/** \brief Test if a transform is possible
/** \brief Test if a transform is possible
* \param target_frame The frame into which to transform
* \param target_frame The frame into which to transform
...
...
编辑
预览
Markdown
is supported
0%
请重试
或
添加新附件
.
添加附件
取消
You are about to add
0
people
to the discussion. Proceed with caution.
先完成此消息的编辑!
取消
想要评论请
注册
或
登录