Skip to content
Snippets Groups Projects
Commit 3f651b3d authored by Pier Tirindelli's avatar Pier Tirindelli
Browse files

deleted test_gps_wolf

Unused classes? #25
parent c12d7fff
No related branches found
No related tags found
No related merge requests found
...@@ -214,18 +214,15 @@ inline bool ConstraintGPSPseudorange2D::operator ()(const T* const _vehicle_p, c ...@@ -214,18 +214,15 @@ inline bool ConstraintGPSPseudorange2D::operator ()(const T* const _vehicle_p, c
*/ */
T square_sum = T(0); T square_sum = T(0);
for (int i = 0; i < 3; ++i) for (int i = 0; i < 3; ++i)
{
square_sum += (sensor_p_ecef[i] - T(sat_position_[i]))*(sensor_p_ecef[i] - T(sat_position_[i])); square_sum += (sensor_p_ecef[i] - T(sat_position_[i]))*(sensor_p_ecef[i] - T(sat_position_[i]));
}
T distance = (square_sum != T(0)) ? sqrt(square_sum) : T(0); T distance = (square_sum != T(0)) ? sqrt(square_sum) : T(0);
// error = (expected measurement) - (actual measurement) // error = (expected measurement) - (actual measurement)
_residual[0] = (distance + _bias[0] * T(LIGHT_SPEED)) - (pseudorange_); _residual[0] = (distance + _bias[0] * T(LIGHT_SPEED)) - (pseudorange_);
if (verbose_level_ >= 2) if (verbose_level_ >= 2)
{
std::cout << "!!! Residual: " << _residual[0] << "\n"; std::cout << "!!! Residual: " << _residual[0] << "\n";
}
// normalizing by the covariance // normalizing by the covariance
_residual[0] = _residual[0] / T(getMeasurementCovariance()(0, 0));//T(sqrt(getMeasurementCovariance()(0, 0))); _residual[0] = _residual[0] / T(getMeasurementCovariance()(0, 0));//T(sqrt(getMeasurementCovariance()(0, 0)));
......
...@@ -96,10 +96,3 @@ IF(faramotics_FOUND) ...@@ -96,10 +96,3 @@ IF(faramotics_FOUND)
ENDIF (laser_scan_utils_FOUND) ENDIF (laser_scan_utils_FOUND)
ENDIF(faramotics_FOUND) ENDIF(faramotics_FOUND)
# Testing GPS stuff
IF(raw_gps_utils_FOUND)
ADD_EXECUTABLE(test_gps_wolf test_gps_wolf.cpp)
TARGET_LINK_LIBRARIES(test_gps_wolf ${raw_gps_utils_LIBRARY} ${PROJECT_NAME})
ENDIF(raw_gps_utils_FOUND)
This diff is collapsed.
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment