RogiStandard-hal
STM32 向けサークル共通ライブラリ
読み取り中…
検索中…
一致する文字列を見つけられません
Pose2d.hpp
[詳解]
1#pragma once
2
3#include <units/angle.h>
4#include <units/length.h>
5
6using meters = units::meters<float>;
7using radians = units::radians<float>;
8
9class Pose2D {
10 public:
14
15 Pose2D() = default;
17
18 inline Pose2D& operator+=(const Pose2D& rhs) {
19 x += rhs.x;
20 y += rhs.y;
21 theta += rhs.theta;
22 return *this;
23 }
24
25 inline Pose2D& operator-=(const Pose2D& rhs) {
26 x -= rhs.x;
27 y -= rhs.y;
28 theta -= rhs.theta;
29 return *this;
30 }
31
32 inline Pose2D& operator*=(const float& rhs) {
33 x *= rhs;
34 y *= rhs;
35 theta *= rhs;
36 return *this;
37 }
38
39 inline Pose2D& operator/=(const float& rhs) {
40 x /= rhs;
41 y /= rhs;
42 theta /= rhs;
43 return *this;
44 }
45};
46
47inline Pose2D operator+(const Pose2D& lhs, const Pose2D& rhs) {
48 return Pose2D(lhs.x + rhs.x, lhs.y + rhs.y, lhs.theta + rhs.theta);
49}
50inline Pose2D operator-(const Pose2D& lhs, const Pose2D& rhs) {
51 return Pose2D(lhs.x - rhs.x, lhs.y - rhs.y, lhs.theta - rhs.theta);
52}
53inline Pose2D operator*(const Pose2D& lhs, const float& rhs) {
54 return Pose2D(lhs.x * rhs, lhs.y * rhs, lhs.theta * rhs);
55}
56inline Pose2D operator*(const float& lhs, const Pose2D& rhs) {
57 return Pose2D(lhs * rhs.x, lhs * rhs.y, lhs * rhs.theta);
58}
59inline Pose2D operator/(const Pose2D& lhs, const float& rhs) {
60 return Pose2D(lhs.x / rhs, lhs.y / rhs, lhs.theta / rhs);
61}
62constexpr bool operator==(const Pose2D& lhs, const Pose2D& rhs) {
63 return lhs.x == rhs.x && lhs.y == rhs.y && lhs.theta == rhs.theta;
64}
65constexpr bool operator!=(const Pose2D& lhs, const Pose2D& rhs) {
66 return lhs.x != rhs.x || lhs.y != rhs.y || lhs.theta != rhs.theta;
67}
Pose2D & operator/=(const float &rhs)
Definition Pose2d.hpp:39
meters y
Definition Pose2d.hpp:12
Pose2D & operator-=(const Pose2D &rhs)
Definition Pose2d.hpp:25
Pose2D & operator*=(const float &rhs)
Definition Pose2d.hpp:32
meters x
Definition Pose2d.hpp:11
radians theta
Definition Pose2d.hpp:13
Pose2D()=default
Pose2D & operator+=(const Pose2D &rhs)
Definition Pose2d.hpp:18
Pose2D(meters x, meters y, radians theta)
Definition Pose2d.hpp:16
units::radians< float > radians
Definition Pose2d.hpp:7
Pose2D operator-(const Pose2D &lhs, const Pose2D &rhs)
Definition Pose2d.hpp:50
constexpr bool operator!=(const Pose2D &lhs, const Pose2D &rhs)
Definition Pose2d.hpp:65
Pose2D operator*(const Pose2D &lhs, const float &rhs)
Definition Pose2d.hpp:53
Pose2D operator/(const Pose2D &lhs, const float &rhs)
Definition Pose2d.hpp:59
Pose2D operator+(const Pose2D &lhs, const Pose2D &rhs)
Definition Pose2d.hpp:47
units::meters< float > meters
Definition Pose2d.hpp:6
constexpr bool operator==(const Pose2D &lhs, const Pose2D &rhs)
Definition Pose2d.hpp:62
Eigen::Matrix< float, N, 3 > getWheelMatrix(const std::array< WheelPositions, static_cast< std::size_t >(N)> &wheel_positions)