Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-20 00:51:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

[wpimath] Add distance/angle constructor to Translation2d (#2791)

Browse Source
This commit is contained in:
Prateek Machiraju
2020-10-21 00:22:41 -04:00
committed by GitHub
parent b66fcdb3f7
commit 17698af5e3
5 changed files with 47 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
wpimath/src/main/native/cpp/geometry/Translation2d.cpp
View File

@@ -16,6 +16,9 @@ using namespace frc;
Translation2d::Translation2d(units::meter_t x, units::meter_t y)
: m_x(x), m_y(y) {}
Translation2d::Translation2d(units::meter_t distance, const Rotation2d& angle)
: m_x(distance * angle.Cos()), m_y(distance * angle.Sin()) {}
units::meter_t Translation2d::Distance(const Translation2d& other) const {
return units::math::hypot(other.m_x - m_x, other.m_y - m_y);
}