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

Small formatting

parent 3c10aacf
No related branches found
No related tags found
1 merge request!318CaptureMotion: replace origin_frame_ptr_ by capture_origin_ptr_.
Pipeline #4268 passed
This commit is part of merge request !318. Comments created here will be created in the context of that merge request.
...@@ -53,15 +53,20 @@ class SensorDiffDrive : public SensorBase ...@@ -53,15 +53,20 @@ class SensorDiffDrive : public SensorBase
{ {
public: public:
SensorDiffDrive(const Eigen::VectorXs& _extrinsics, SensorDiffDrive(const Eigen::VectorXs& _extrinsics,
const IntrinsicsDiffDrivePtr& _intrinsics); const IntrinsicsDiffDrivePtr& _intrinsics);
WOLF_SENSOR_CREATE(SensorDiffDrive, IntrinsicsDiffDrive, 3); WOLF_SENSOR_CREATE(SensorDiffDrive, IntrinsicsDiffDrive, 3);
virtual ~SensorDiffDrive(); virtual ~SensorDiffDrive();
IntrinsicsDiffDriveConstPtr getParams() const {return params_diff_drive_;} IntrinsicsDiffDriveConstPtr getParams() const;
protected: private:
IntrinsicsDiffDrivePtr params_diff_drive_; IntrinsicsDiffDrivePtr params_diff_drive_;
}; };
inline wolf::IntrinsicsDiffDriveConstPtr SensorDiffDrive::getParams() const
{
return params_diff_drive_;
}
} /* namespace wolf */ } /* namespace wolf */
#endif /* SENSOR_SENSOR_DIFF_DRIVE_H_ */ #endif /* SENSOR_SENSOR_DIFF_DRIVE_H_ */
...@@ -12,13 +12,13 @@ namespace wolf ...@@ -12,13 +12,13 @@ namespace wolf
{ {
SensorDiffDrive::SensorDiffDrive(const Eigen::VectorXs& _extrinsics, SensorDiffDrive::SensorDiffDrive(const Eigen::VectorXs& _extrinsics,
const IntrinsicsDiffDrivePtr& _intrinsics) : const IntrinsicsDiffDrivePtr& _intrinsics) :
SensorBase("DIFF DRIVE", SensorBase("DIFF DRIVE",
std::make_shared<StateBlock>(_extrinsics.head(2), true), std::make_shared<StateBlock>(_extrinsics.head(2), true),
std::make_shared<StateAngle>(_extrinsics(2), true), std::make_shared<StateAngle>(_extrinsics(2), true),
std::make_shared<StateBlock>(3, false), std::make_shared<StateBlock>(3, false),
2), 2),
params_diff_drive_(_intrinsics) params_diff_drive_(_intrinsics)
{ {
params_diff_drive_->radians_per_tick = 2.0*M_PI / params_diff_drive_->ticks_per_wheel_revolution; params_diff_drive_->radians_per_tick = 2.0*M_PI / params_diff_drive_->ticks_per_wheel_revolution;
getIntrinsic()->setState(Eigen::Vector3s(_intrinsics->radius_left,_intrinsics->radius_right,_intrinsics->wheel_separation)); getIntrinsic()->setState(Eigen::Vector3s(_intrinsics->radius_left,_intrinsics->radius_right,_intrinsics->wheel_separation));
......
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