mirs_esp_pio
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
DiffMotors.cpp
[詳解]
1
#include "
DiffMotors.hpp
"
2
3
DiffMotors::DiffMotors
(
MotorDriver
&left,
MotorDriver
&right,
4
bool
left_reversed,
bool
right_reversed)
5
: left_(left)
6
, right_(right)
7
, left_reversed_(left_reversed)
8
, right_reversed_(right_reversed)
9
{
10
}
11
12
void
DiffMotors::begin
(uint32_t pwm_freq, uint8_t pwm_resolution) {
13
left_.begin(pwm_freq, pwm_resolution);
14
right_.begin(pwm_freq, pwm_resolution);
15
}
16
17
void
DiffMotors::setReversed
(
bool
left_reversed,
bool
right_reversed) {
18
left_reversed_ = left_reversed;
19
right_reversed_ = right_reversed;
20
}
21
22
namespace
{
23
// 四捨五入(切捨てでは微小dutyが消失する。MotorDriver側で±255にclampされる)
24
int
roundDuty(
double
duty) {
25
const
int
truncated =
static_cast<
int
>
(duty);
26
const
double
frac = duty - truncated;
27
if
(frac >= 0.5) {
28
return
truncated + 1;
29
}
30
if
(frac <= -0.5) {
31
return
truncated - 1;
32
}
33
return
truncated;
34
}
35
}
// namespace
36
37
void
DiffMotors::setLeft
(
double
duty) {
38
left_.setDuty(roundDuty(left_reversed_ ? -duty : duty));
39
}
40
41
void
DiffMotors::setRight
(
double
duty) {
42
right_.setDuty(roundDuty(right_reversed_ ? -duty : duty));
43
}
44
45
void
DiffMotors::setBoth
(
double
duty_left,
double
duty_right) {
46
setLeft
(duty_left);
47
setRight
(duty_right);
48
}
49
50
void
DiffMotors::stop
() {
51
left_.stop();
52
right_.stop();
53
}
DiffMotors.hpp
左右モータの出力をまとめて設定し、配線に応じて回転方向の符号を合わせる。
DiffMotors::begin
void begin(uint32_t pwm_freq=20000, uint8_t pwm_resolution=8)
定義
DiffMotors.cpp:12
DiffMotors::stop
void stop()
定義
DiffMotors.cpp:50
DiffMotors::setBoth
void setBoth(double duty_left, double duty_right)
定義
DiffMotors.cpp:45
DiffMotors::setLeft
void setLeft(double duty)
定義
DiffMotors.cpp:37
DiffMotors::DiffMotors
DiffMotors(MotorDriver &left, MotorDriver &right, bool left_reversed=false, bool right_reversed=true)
定義
DiffMotors.cpp:3
DiffMotors::setRight
void setRight(double duty)
定義
DiffMotors.cpp:41
DiffMotors::setReversed
void setReversed(bool left_reversed, bool right_reversed)
定義
DiffMotors.cpp:17
MotorDriver
単一MD10Cチャンネルのデバイス抽象。duty出力のみ。
定義
MotorDriver.hpp:6
lib
DiffMotors
DiffMotors.cpp
構築:
1.18.0