Skip to content
Snippets Groups Projects
Commit 51cfdfab authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Format

parent 62eb85df
No related branches found
No related tags found
1 merge request!248Feature/proc motion
...@@ -44,15 +44,22 @@ void ProcessorDiffDrive::computeCurrentDelta(const Eigen::VectorXs& _data, ...@@ -44,15 +44,22 @@ void ProcessorDiffDrive::computeCurrentDelta(const Eigen::VectorXs& _data,
case DiffDriveModel::Two_Factor_Model: case DiffDriveModel::Two_Factor_Model:
std::tie(vel, J_vel_data, J_vel_calib) = std::tie(vel, J_vel_data, J_vel_calib) =
wheelPositionIncrementToVelocity<DiffDriveModel::Two_Factor_Model>( wheelPositionIncrementToVelocity<DiffDriveModel::Two_Factor_Model>(
_data, _data_cov, _data,
intrinsics.left_radius_, intrinsics.right_radius_, intrinsics.separation_, _data_cov,
_calib, _dt); intrinsics.left_radius_,
intrinsics.right_radius_,
intrinsics.separation_,
_calib,
_dt);
break; break;
case DiffDriveModel::Three_Factor_Model: case DiffDriveModel::Three_Factor_Model:
std::tie(vel, J_vel_data, J_vel_calib) = std::tie(vel, J_vel_data, J_vel_calib) =
wheelPositionIncrementToVelocity<DiffDriveModel::Three_Factor_Model>( wheelPositionIncrementToVelocity<DiffDriveModel::Three_Factor_Model>(
_data, _data_cov, _data,
intrinsics.left_radius_, intrinsics.right_radius_, intrinsics.separation_, _data_cov,
intrinsics.left_radius_,
intrinsics.right_radius_,
intrinsics.separation_,
_calib, _dt); _calib, _dt);
break; break;
case DiffDriveModel::Five_Factor_Model: case DiffDriveModel::Five_Factor_Model:
......
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