Skip to content

J
jfx_kalman_filter_src
Commit 49405367 authored by oscar's avatar oscar
Browse files
Options

提交更新

parent 5a147a0f
Hide whitespace changes
Inline Side-by-side
Showing with 6 additions and 2 deletions
TrackingRosEx.cpp
View file @ 49405367
......@@ -414,7 +414,7 @@ void TrackingRos::TrackingCameraCallBackFunc(const jfx_common_msgs::InferResesCo
if (cloudPtr)
{
objsPtr->cloud = cloudPtr->cloud;
SDK_LOG(SDK_INFO, "cloudPtr array size = %d", cloudPtr->array.size());
//SDK_LOG(SDK_INFO, "cloudPtr array size = %d", cloudPtr->array.size());
for (auto& obj : cloudPtr->array)
{
if (obj.x <= 70)
......@@ -463,6 +463,10 @@ void TrackingRos::TrackingCameraCallBackFunc(const jfx_common_msgs::InferResesCo
{
get_camera_left_tolidar_loc(bottom_center_x, bottom_center_y, x, y);
}
if (i == 1 || i == 2)
{
SDK_LOG(SDK_INFO, "camera obj i = %d, x = %f,y = %f",i, x, y);
}
jfx_common_msgs::det_tracking objMsg = {};
objMsg.frame = int(timestamp);
objMsg.x = x;
......@@ -537,7 +541,7 @@ void TrackingRos::TrackingCameraCallBackFunc(const jfx_common_msgs::InferResesCo
}
}
SDK_LOG(SDK_INFO, "m_objsQueue push size = %d", objsPtr->array.size());
//SDK_LOG(SDK_INFO, "m_objsQueue push size = %d", objsPtr->array.size());
m_objsQueue.push(objsPtr);
//if(cloudPtr)
// m_pubCloud.publish(cloudPtr->cloud);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment