Commit 55af11a8 authored by haoshuang's avatar haoshuang

fix bug of utm

parent 6e9f055c
......@@ -127,7 +127,7 @@ void CalculateUTMPos(jfx_common_msgs::det_tracking &obj, std::vector<double> &wg
jfx::UVUTMLLA * UVUTMLLAPtr = new jfx::UVUTMLLA;
int ret = UVUTMLLAPtr->Init_set_zone(UTM_station[1]);
int ret = UVUTMLLAPtr->Init_set_zone(wgs84_station[0]);
if (0 != ret)
{
std::cout << "UTM Init Error" << std::endl;
......@@ -529,7 +529,7 @@ void TrackingRos::ThreadTrackingProcess()
obj.obj_id = iter.first;
#ifdef _ABUZHABI_
double lon = 0.0f;
double lon = 0.0f;
double lat = 0.0f;
// CalculateGuassPos(obj, m_trans, m_kitti2origin, gx, gy);
CalculateUTMPos(obj, m_wgs84_station,m_UTM_station, m_trans2station,m_kitti2origin, lon, lat);
......@@ -792,4 +792,4 @@ void TrackingRos::ThreadTrackingProcess()
}
}
}
\ No newline at end of file
}
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